xref: /linux-6.15/kernel/trace/ftrace.c (revision e1effa01)
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>
215072c59fSSteven Rostedt #include <linux/debugfs.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 
654104d326SSteven Rostedt (Red Hat) #define FL_GLOBAL_CONTROL_MASK (FTRACE_OPS_FL_CONTROL)
66e248491aSJiri Olsa 
67f04f24fbSMasami Hiramatsu #ifdef CONFIG_DYNAMIC_FTRACE
6833b7f99cSSteven Rostedt (Red Hat) #define INIT_OPS_HASH(opsname)	\
6933b7f99cSSteven Rostedt (Red Hat) 	.func_hash		= &opsname.local_hash,			\
7033b7f99cSSteven Rostedt (Red Hat) 	.local_hash.regex_lock	= __MUTEX_INITIALIZER(opsname.local_hash.regex_lock),
715f151b24SSteven Rostedt (Red Hat) #define ASSIGN_OPS_HASH(opsname, val) \
725f151b24SSteven Rostedt (Red Hat) 	.func_hash		= val, \
735f151b24SSteven Rostedt (Red Hat) 	.local_hash.regex_lock	= __MUTEX_INITIALIZER(opsname.local_hash.regex_lock),
74f04f24fbSMasami Hiramatsu #else
7533b7f99cSSteven Rostedt (Red Hat) #define INIT_OPS_HASH(opsname)
765f151b24SSteven Rostedt (Red Hat) #define ASSIGN_OPS_HASH(opsname, val)
77f04f24fbSMasami Hiramatsu #endif
78f04f24fbSMasami Hiramatsu 
792f5f6ad9SSteven Rostedt static struct ftrace_ops ftrace_list_end __read_mostly = {
802f5f6ad9SSteven Rostedt 	.func		= ftrace_stub,
81395b97a3SSteven Rostedt (Red Hat) 	.flags		= FTRACE_OPS_FL_RECURSION_SAFE | FTRACE_OPS_FL_STUB,
8233b7f99cSSteven Rostedt (Red Hat) 	INIT_OPS_HASH(ftrace_list_end)
832f5f6ad9SSteven Rostedt };
842f5f6ad9SSteven Rostedt 
854eebcc81SSteven Rostedt /* ftrace_enabled is a method to turn ftrace on or off */
864eebcc81SSteven Rostedt int ftrace_enabled __read_mostly;
87d61f82d0SSteven Rostedt static int last_ftrace_enabled;
88b0fc494fSSteven Rostedt 
892f5f6ad9SSteven Rostedt /* Current function tracing op */
902f5f6ad9SSteven Rostedt struct ftrace_ops *function_trace_op __read_mostly = &ftrace_list_end;
91405e1d83SSteven Rostedt (Red Hat) /* What to set function_trace_op to */
92405e1d83SSteven Rostedt (Red Hat) static struct ftrace_ops *set_function_trace_op;
9360a7ecf4SSteven Rostedt 
94756d17eeS[email protected] /* List for set_ftrace_pid's pids. */
95756d17eeS[email protected] LIST_HEAD(ftrace_pids);
96756d17eeS[email protected] struct ftrace_pid {
97756d17eeS[email protected] 	struct list_head list;
98756d17eeS[email protected] 	struct pid *pid;
99756d17eeS[email protected] };
100756d17eeS[email protected] 
1014eebcc81SSteven Rostedt /*
1024eebcc81SSteven Rostedt  * ftrace_disabled is set when an anomaly is discovered.
1034eebcc81SSteven Rostedt  * ftrace_disabled is much stronger than ftrace_enabled.
1044eebcc81SSteven Rostedt  */
1054eebcc81SSteven Rostedt static int ftrace_disabled __read_mostly;
1064eebcc81SSteven Rostedt 
10752baf119SSteven Rostedt static DEFINE_MUTEX(ftrace_lock);
108b0fc494fSSteven Rostedt 
109e248491aSJiri Olsa static struct ftrace_ops *ftrace_control_list __read_mostly = &ftrace_list_end;
110b848914cSSteven Rostedt static struct ftrace_ops *ftrace_ops_list __read_mostly = &ftrace_list_end;
11116444a8aSArnaldo Carvalho de Melo ftrace_func_t ftrace_trace_function __read_mostly = ftrace_stub;
112df4fc315SSteven Rostedt ftrace_func_t ftrace_pid_function __read_mostly = ftrace_stub;
1132b499381SSteven Rostedt static struct ftrace_ops global_ops;
114e248491aSJiri Olsa static struct ftrace_ops control_ops;
11516444a8aSArnaldo Carvalho de Melo 
116f1ff6348SSteven Rostedt (Red Hat) static void ftrace_ops_recurs_func(unsigned long ip, unsigned long parent_ip,
117f1ff6348SSteven Rostedt (Red Hat) 				   struct ftrace_ops *op, struct pt_regs *regs);
118f1ff6348SSteven Rostedt (Red Hat) 
1192f5f6ad9SSteven Rostedt #if ARCH_SUPPORTS_FTRACE_OPS
1202f5f6ad9SSteven Rostedt static void ftrace_ops_list_func(unsigned long ip, unsigned long parent_ip,
121a1e2e31dSSteven Rostedt 				 struct ftrace_ops *op, struct pt_regs *regs);
1222f5f6ad9SSteven Rostedt #else
1232f5f6ad9SSteven Rostedt /* See comment below, where ftrace_ops_list_func is defined */
1242f5f6ad9SSteven Rostedt static void ftrace_ops_no_ops(unsigned long ip, unsigned long parent_ip);
1252f5f6ad9SSteven Rostedt #define ftrace_ops_list_func ((ftrace_func_t)ftrace_ops_no_ops)
1262f5f6ad9SSteven Rostedt #endif
127b848914cSSteven Rostedt 
1280a016409SSteven Rostedt /*
1290a016409SSteven Rostedt  * Traverse the ftrace_global_list, invoking all entries.  The reason that we
1301bb539caSSteven Rostedt  * can use rcu_dereference_raw_notrace() is that elements removed from this list
1310a016409SSteven Rostedt  * are simply leaked, so there is no need to interact with a grace-period
1321bb539caSSteven Rostedt  * mechanism.  The rcu_dereference_raw_notrace() calls are needed to handle
1330a016409SSteven Rostedt  * concurrent insertions into the ftrace_global_list.
1340a016409SSteven Rostedt  *
1350a016409SSteven Rostedt  * Silly Alpha and silly pointer-speculation compiler optimizations!
1360a016409SSteven Rostedt  */
1370a016409SSteven Rostedt #define do_for_each_ftrace_op(op, list)			\
1381bb539caSSteven Rostedt 	op = rcu_dereference_raw_notrace(list);			\
1390a016409SSteven Rostedt 	do
1400a016409SSteven Rostedt 
1410a016409SSteven Rostedt /*
1420a016409SSteven Rostedt  * Optimized for just a single item in the list (as that is the normal case).
1430a016409SSteven Rostedt  */
1440a016409SSteven Rostedt #define while_for_each_ftrace_op(op)				\
1451bb539caSSteven Rostedt 	while (likely(op = rcu_dereference_raw_notrace((op)->next)) &&	\
1460a016409SSteven Rostedt 	       unlikely((op) != &ftrace_list_end))
1470a016409SSteven Rostedt 
148f04f24fbSMasami Hiramatsu static inline void ftrace_ops_init(struct ftrace_ops *ops)
149f04f24fbSMasami Hiramatsu {
150f04f24fbSMasami Hiramatsu #ifdef CONFIG_DYNAMIC_FTRACE
151f04f24fbSMasami Hiramatsu 	if (!(ops->flags & FTRACE_OPS_FL_INITIALIZED)) {
15233b7f99cSSteven Rostedt (Red Hat) 		mutex_init(&ops->local_hash.regex_lock);
15333b7f99cSSteven Rostedt (Red Hat) 		ops->func_hash = &ops->local_hash;
154f04f24fbSMasami Hiramatsu 		ops->flags |= FTRACE_OPS_FL_INITIALIZED;
155f04f24fbSMasami Hiramatsu 	}
156f04f24fbSMasami Hiramatsu #endif
157f04f24fbSMasami Hiramatsu }
158f04f24fbSMasami Hiramatsu 
159ea701f11SSteven Rostedt /**
160ea701f11SSteven Rostedt  * ftrace_nr_registered_ops - return number of ops registered
161ea701f11SSteven Rostedt  *
162ea701f11SSteven Rostedt  * Returns the number of ftrace_ops registered and tracing functions
163ea701f11SSteven Rostedt  */
164ea701f11SSteven Rostedt int ftrace_nr_registered_ops(void)
165ea701f11SSteven Rostedt {
166ea701f11SSteven Rostedt 	struct ftrace_ops *ops;
167ea701f11SSteven Rostedt 	int cnt = 0;
168ea701f11SSteven Rostedt 
169ea701f11SSteven Rostedt 	mutex_lock(&ftrace_lock);
170ea701f11SSteven Rostedt 
171ea701f11SSteven Rostedt 	for (ops = ftrace_ops_list;
172ea701f11SSteven Rostedt 	     ops != &ftrace_list_end; ops = ops->next)
173ea701f11SSteven Rostedt 		cnt++;
174ea701f11SSteven Rostedt 
175ea701f11SSteven Rostedt 	mutex_unlock(&ftrace_lock);
176ea701f11SSteven Rostedt 
177ea701f11SSteven Rostedt 	return cnt;
178ea701f11SSteven Rostedt }
179ea701f11SSteven Rostedt 
1802f5f6ad9SSteven Rostedt static void ftrace_pid_func(unsigned long ip, unsigned long parent_ip,
181a1e2e31dSSteven Rostedt 			    struct ftrace_ops *op, struct pt_regs *regs)
182df4fc315SSteven Rostedt {
1830ef8cde5SSteven Rostedt 	if (!test_tsk_trace_trace(current))
184df4fc315SSteven Rostedt 		return;
185df4fc315SSteven Rostedt 
186a1e2e31dSSteven Rostedt 	ftrace_pid_function(ip, parent_ip, op, regs);
187df4fc315SSteven Rostedt }
188df4fc315SSteven Rostedt 
189df4fc315SSteven Rostedt static void set_ftrace_pid_function(ftrace_func_t func)
190df4fc315SSteven Rostedt {
191df4fc315SSteven Rostedt 	/* do not set ftrace_pid_function to itself! */
192df4fc315SSteven Rostedt 	if (func != ftrace_pid_func)
193df4fc315SSteven Rostedt 		ftrace_pid_function = func;
194df4fc315SSteven Rostedt }
195df4fc315SSteven Rostedt 
19616444a8aSArnaldo Carvalho de Melo /**
1973d083395SSteven Rostedt  * clear_ftrace_function - reset the ftrace function
19816444a8aSArnaldo Carvalho de Melo  *
1993d083395SSteven Rostedt  * This NULLs the ftrace function and in essence stops
2003d083395SSteven Rostedt  * tracing.  There may be lag
20116444a8aSArnaldo Carvalho de Melo  */
2023d083395SSteven Rostedt void clear_ftrace_function(void)
20316444a8aSArnaldo Carvalho de Melo {
2043d083395SSteven Rostedt 	ftrace_trace_function = ftrace_stub;
205df4fc315SSteven Rostedt 	ftrace_pid_function = ftrace_stub;
2063d083395SSteven Rostedt }
20716444a8aSArnaldo Carvalho de Melo 
208e248491aSJiri Olsa static void control_ops_disable_all(struct ftrace_ops *ops)
209e248491aSJiri Olsa {
210e248491aSJiri Olsa 	int cpu;
211e248491aSJiri Olsa 
212e248491aSJiri Olsa 	for_each_possible_cpu(cpu)
213e248491aSJiri Olsa 		*per_cpu_ptr(ops->disabled, cpu) = 1;
214e248491aSJiri Olsa }
215e248491aSJiri Olsa 
216e248491aSJiri Olsa static int control_ops_alloc(struct ftrace_ops *ops)
217e248491aSJiri Olsa {
218e248491aSJiri Olsa 	int __percpu *disabled;
219e248491aSJiri Olsa 
220e248491aSJiri Olsa 	disabled = alloc_percpu(int);
221e248491aSJiri Olsa 	if (!disabled)
222e248491aSJiri Olsa 		return -ENOMEM;
223e248491aSJiri Olsa 
224e248491aSJiri Olsa 	ops->disabled = disabled;
225e248491aSJiri Olsa 	control_ops_disable_all(ops);
226e248491aSJiri Olsa 	return 0;
227e248491aSJiri Olsa }
228e248491aSJiri Olsa 
229405e1d83SSteven Rostedt (Red Hat) static void ftrace_sync(struct work_struct *work)
230405e1d83SSteven Rostedt (Red Hat) {
231405e1d83SSteven Rostedt (Red Hat) 	/*
232405e1d83SSteven Rostedt (Red Hat) 	 * This function is just a stub to implement a hard force
233405e1d83SSteven Rostedt (Red Hat) 	 * of synchronize_sched(). This requires synchronizing
234405e1d83SSteven Rostedt (Red Hat) 	 * tasks even in userspace and idle.
235405e1d83SSteven Rostedt (Red Hat) 	 *
236405e1d83SSteven Rostedt (Red Hat) 	 * Yes, function tracing is rude.
237405e1d83SSteven Rostedt (Red Hat) 	 */
238405e1d83SSteven Rostedt (Red Hat) }
239405e1d83SSteven Rostedt (Red Hat) 
240405e1d83SSteven Rostedt (Red Hat) static void ftrace_sync_ipi(void *data)
241405e1d83SSteven Rostedt (Red Hat) {
242405e1d83SSteven Rostedt (Red Hat) 	/* Probably not needed, but do it anyway */
243405e1d83SSteven Rostedt (Red Hat) 	smp_rmb();
244405e1d83SSteven Rostedt (Red Hat) }
245405e1d83SSteven Rostedt (Red Hat) 
24623a8e844SSteven Rostedt (Red Hat) #ifdef CONFIG_FUNCTION_GRAPH_TRACER
24723a8e844SSteven Rostedt (Red Hat) static void update_function_graph_func(void);
24823a8e844SSteven Rostedt (Red Hat) #else
24923a8e844SSteven Rostedt (Red Hat) static inline void update_function_graph_func(void) { }
25023a8e844SSteven Rostedt (Red Hat) #endif
25123a8e844SSteven Rostedt (Red Hat) 
2522b499381SSteven Rostedt static void update_ftrace_function(void)
2532b499381SSteven Rostedt {
2542b499381SSteven Rostedt 	ftrace_func_t func;
2552b499381SSteven Rostedt 
256cdbe61bfSSteven Rostedt 	/*
257f7aad4e1SSteven Rostedt (Red Hat) 	 * Prepare the ftrace_ops that the arch callback will use.
258f7aad4e1SSteven Rostedt (Red Hat) 	 * If there's only one ftrace_ops registered, the ftrace_ops_list
259f7aad4e1SSteven Rostedt (Red Hat) 	 * will point to the ops we want.
260f7aad4e1SSteven Rostedt (Red Hat) 	 */
261f7aad4e1SSteven Rostedt (Red Hat) 	set_function_trace_op = ftrace_ops_list;
262f7aad4e1SSteven Rostedt (Red Hat) 
263f7aad4e1SSteven Rostedt (Red Hat) 	/* If there's no ftrace_ops registered, just call the stub function */
264f7aad4e1SSteven Rostedt (Red Hat) 	if (ftrace_ops_list == &ftrace_list_end) {
265f7aad4e1SSteven Rostedt (Red Hat) 		func = ftrace_stub;
266f7aad4e1SSteven Rostedt (Red Hat) 
267f7aad4e1SSteven Rostedt (Red Hat) 	/*
268cdbe61bfSSteven Rostedt 	 * If we are at the end of the list and this ops is
2694740974aSSteven Rostedt 	 * recursion safe and not dynamic and the arch supports passing ops,
2704740974aSSteven Rostedt 	 * then have the mcount trampoline call the function directly.
271cdbe61bfSSteven Rostedt 	 */
272f7aad4e1SSteven Rostedt (Red Hat) 	} else if (ftrace_ops_list->next == &ftrace_list_end) {
27387354059SSteven Rostedt (Red Hat) 		func = ftrace_ops_get_func(ftrace_ops_list);
274f7aad4e1SSteven Rostedt (Red Hat) 
2752f5f6ad9SSteven Rostedt 	} else {
2762f5f6ad9SSteven Rostedt 		/* Just use the default ftrace_ops */
277405e1d83SSteven Rostedt (Red Hat) 		set_function_trace_op = &ftrace_list_end;
278b848914cSSteven Rostedt 		func = ftrace_ops_list_func;
2792f5f6ad9SSteven Rostedt 	}
2802b499381SSteven Rostedt 
2815f8bf2d2SSteven Rostedt (Red Hat) 	update_function_graph_func();
2825f8bf2d2SSteven Rostedt (Red Hat) 
283405e1d83SSteven Rostedt (Red Hat) 	/* If there's no change, then do nothing more here */
284405e1d83SSteven Rostedt (Red Hat) 	if (ftrace_trace_function == func)
285405e1d83SSteven Rostedt (Red Hat) 		return;
286405e1d83SSteven Rostedt (Red Hat) 
287405e1d83SSteven Rostedt (Red Hat) 	/*
288405e1d83SSteven Rostedt (Red Hat) 	 * If we are using the list function, it doesn't care
289405e1d83SSteven Rostedt (Red Hat) 	 * about the function_trace_ops.
290405e1d83SSteven Rostedt (Red Hat) 	 */
291405e1d83SSteven Rostedt (Red Hat) 	if (func == ftrace_ops_list_func) {
292405e1d83SSteven Rostedt (Red Hat) 		ftrace_trace_function = func;
293405e1d83SSteven Rostedt (Red Hat) 		/*
294405e1d83SSteven Rostedt (Red Hat) 		 * Don't even bother setting function_trace_ops,
295405e1d83SSteven Rostedt (Red Hat) 		 * it would be racy to do so anyway.
296405e1d83SSteven Rostedt (Red Hat) 		 */
297405e1d83SSteven Rostedt (Red Hat) 		return;
298405e1d83SSteven Rostedt (Red Hat) 	}
299405e1d83SSteven Rostedt (Red Hat) 
300405e1d83SSteven Rostedt (Red Hat) #ifndef CONFIG_DYNAMIC_FTRACE
301405e1d83SSteven Rostedt (Red Hat) 	/*
302405e1d83SSteven Rostedt (Red Hat) 	 * For static tracing, we need to be a bit more careful.
303405e1d83SSteven Rostedt (Red Hat) 	 * The function change takes affect immediately. Thus,
304405e1d83SSteven Rostedt (Red Hat) 	 * we need to coorditate the setting of the function_trace_ops
305405e1d83SSteven Rostedt (Red Hat) 	 * with the setting of the ftrace_trace_function.
306405e1d83SSteven Rostedt (Red Hat) 	 *
307405e1d83SSteven Rostedt (Red Hat) 	 * Set the function to the list ops, which will call the
308405e1d83SSteven Rostedt (Red Hat) 	 * function we want, albeit indirectly, but it handles the
309405e1d83SSteven Rostedt (Red Hat) 	 * ftrace_ops and doesn't depend on function_trace_op.
310405e1d83SSteven Rostedt (Red Hat) 	 */
311405e1d83SSteven Rostedt (Red Hat) 	ftrace_trace_function = ftrace_ops_list_func;
312405e1d83SSteven Rostedt (Red Hat) 	/*
313405e1d83SSteven Rostedt (Red Hat) 	 * Make sure all CPUs see this. Yes this is slow, but static
314405e1d83SSteven Rostedt (Red Hat) 	 * tracing is slow and nasty to have enabled.
315405e1d83SSteven Rostedt (Red Hat) 	 */
316405e1d83SSteven Rostedt (Red Hat) 	schedule_on_each_cpu(ftrace_sync);
317405e1d83SSteven Rostedt (Red Hat) 	/* Now all cpus are using the list ops. */
318405e1d83SSteven Rostedt (Red Hat) 	function_trace_op = set_function_trace_op;
319405e1d83SSteven Rostedt (Red Hat) 	/* Make sure the function_trace_op is visible on all CPUs */
320405e1d83SSteven Rostedt (Red Hat) 	smp_wmb();
321405e1d83SSteven Rostedt (Red Hat) 	/* Nasty way to force a rmb on all cpus */
322405e1d83SSteven Rostedt (Red Hat) 	smp_call_function(ftrace_sync_ipi, NULL, 1);
323405e1d83SSteven Rostedt (Red Hat) 	/* OK, we are all set to update the ftrace_trace_function now! */
324405e1d83SSteven Rostedt (Red Hat) #endif /* !CONFIG_DYNAMIC_FTRACE */
325405e1d83SSteven Rostedt (Red Hat) 
326491d0dcfSSteven Rostedt 	ftrace_trace_function = func;
327491d0dcfSSteven Rostedt }
328491d0dcfSSteven Rostedt 
3297eea4fceSJiaxing Wang int using_ftrace_ops_list_func(void)
3307eea4fceSJiaxing Wang {
3317eea4fceSJiaxing Wang 	return ftrace_trace_function == ftrace_ops_list_func;
3327eea4fceSJiaxing Wang }
3337eea4fceSJiaxing Wang 
3342b499381SSteven Rostedt static void add_ftrace_ops(struct ftrace_ops **list, struct ftrace_ops *ops)
3353d083395SSteven Rostedt {
3362b499381SSteven Rostedt 	ops->next = *list;
33716444a8aSArnaldo Carvalho de Melo 	/*
338b848914cSSteven Rostedt 	 * We are entering ops into the list but another
33916444a8aSArnaldo Carvalho de Melo 	 * CPU might be walking that list. We need to make sure
34016444a8aSArnaldo Carvalho de Melo 	 * the ops->next pointer is valid before another CPU sees
341b848914cSSteven Rostedt 	 * the ops pointer included into the list.
34216444a8aSArnaldo Carvalho de Melo 	 */
3432b499381SSteven Rostedt 	rcu_assign_pointer(*list, ops);
3442b499381SSteven Rostedt }
3453d083395SSteven Rostedt 
3462b499381SSteven Rostedt static int remove_ftrace_ops(struct ftrace_ops **list, struct ftrace_ops *ops)
3472b499381SSteven Rostedt {
3482b499381SSteven Rostedt 	struct ftrace_ops **p;
3492b499381SSteven Rostedt 
3502b499381SSteven Rostedt 	/*
3512b499381SSteven Rostedt 	 * If we are removing the last function, then simply point
3522b499381SSteven Rostedt 	 * to the ftrace_stub.
3532b499381SSteven Rostedt 	 */
3542b499381SSteven Rostedt 	if (*list == ops && ops->next == &ftrace_list_end) {
3552b499381SSteven Rostedt 		*list = &ftrace_list_end;
3562b499381SSteven Rostedt 		return 0;
3572b499381SSteven Rostedt 	}
3582b499381SSteven Rostedt 
3592b499381SSteven Rostedt 	for (p = list; *p != &ftrace_list_end; p = &(*p)->next)
3602b499381SSteven Rostedt 		if (*p == ops)
3612b499381SSteven Rostedt 			break;
3622b499381SSteven Rostedt 
3632b499381SSteven Rostedt 	if (*p != ops)
3642b499381SSteven Rostedt 		return -1;
3652b499381SSteven Rostedt 
3662b499381SSteven Rostedt 	*p = (*p)->next;
3672b499381SSteven Rostedt 	return 0;
3682b499381SSteven Rostedt }
3692b499381SSteven Rostedt 
370e248491aSJiri Olsa static void add_ftrace_list_ops(struct ftrace_ops **list,
371e248491aSJiri Olsa 				struct ftrace_ops *main_ops,
372e248491aSJiri Olsa 				struct ftrace_ops *ops)
373e248491aSJiri Olsa {
374e248491aSJiri Olsa 	int first = *list == &ftrace_list_end;
375e248491aSJiri Olsa 	add_ftrace_ops(list, ops);
376e248491aSJiri Olsa 	if (first)
377e248491aSJiri Olsa 		add_ftrace_ops(&ftrace_ops_list, main_ops);
378e248491aSJiri Olsa }
379e248491aSJiri Olsa 
380e248491aSJiri Olsa static int remove_ftrace_list_ops(struct ftrace_ops **list,
381e248491aSJiri Olsa 				  struct ftrace_ops *main_ops,
382e248491aSJiri Olsa 				  struct ftrace_ops *ops)
383e248491aSJiri Olsa {
384e248491aSJiri Olsa 	int ret = remove_ftrace_ops(list, ops);
385e248491aSJiri Olsa 	if (!ret && *list == &ftrace_list_end)
386e248491aSJiri Olsa 		ret = remove_ftrace_ops(&ftrace_ops_list, main_ops);
387e248491aSJiri Olsa 	return ret;
388e248491aSJiri Olsa }
389e248491aSJiri Olsa 
3902b499381SSteven Rostedt static int __register_ftrace_function(struct ftrace_ops *ops)
3912b499381SSteven Rostedt {
392591dffdaSSteven Rostedt (Red Hat) 	if (ops->flags & FTRACE_OPS_FL_DELETED)
393591dffdaSSteven Rostedt (Red Hat) 		return -EINVAL;
394591dffdaSSteven Rostedt (Red Hat) 
395b848914cSSteven Rostedt 	if (WARN_ON(ops->flags & FTRACE_OPS_FL_ENABLED))
396b848914cSSteven Rostedt 		return -EBUSY;
397b848914cSSteven Rostedt 
39806aeaaeaSMasami Hiramatsu #ifndef CONFIG_DYNAMIC_FTRACE_WITH_REGS
39908f6fba5SSteven Rostedt 	/*
40008f6fba5SSteven Rostedt 	 * If the ftrace_ops specifies SAVE_REGS, then it only can be used
40108f6fba5SSteven Rostedt 	 * if the arch supports it, or SAVE_REGS_IF_SUPPORTED is also set.
40208f6fba5SSteven Rostedt 	 * Setting SAVE_REGS_IF_SUPPORTED makes SAVE_REGS irrelevant.
40308f6fba5SSteven Rostedt 	 */
40408f6fba5SSteven Rostedt 	if (ops->flags & FTRACE_OPS_FL_SAVE_REGS &&
40508f6fba5SSteven Rostedt 	    !(ops->flags & FTRACE_OPS_FL_SAVE_REGS_IF_SUPPORTED))
40608f6fba5SSteven Rostedt 		return -EINVAL;
40708f6fba5SSteven Rostedt 
40808f6fba5SSteven Rostedt 	if (ops->flags & FTRACE_OPS_FL_SAVE_REGS_IF_SUPPORTED)
40908f6fba5SSteven Rostedt 		ops->flags |= FTRACE_OPS_FL_SAVE_REGS;
41008f6fba5SSteven Rostedt #endif
41108f6fba5SSteven Rostedt 
412cdbe61bfSSteven Rostedt 	if (!core_kernel_data((unsigned long)ops))
413cdbe61bfSSteven Rostedt 		ops->flags |= FTRACE_OPS_FL_DYNAMIC;
414cdbe61bfSSteven Rostedt 
4154104d326SSteven Rostedt (Red Hat) 	if (ops->flags & FTRACE_OPS_FL_CONTROL) {
416e248491aSJiri Olsa 		if (control_ops_alloc(ops))
417e248491aSJiri Olsa 			return -ENOMEM;
418e248491aSJiri Olsa 		add_ftrace_list_ops(&ftrace_control_list, &control_ops, ops);
419b848914cSSteven Rostedt 	} else
420b848914cSSteven Rostedt 		add_ftrace_ops(&ftrace_ops_list, ops);
421b848914cSSteven Rostedt 
422491d0dcfSSteven Rostedt 	if (ftrace_enabled)
423491d0dcfSSteven Rostedt 		update_ftrace_function();
4243d083395SSteven Rostedt 
42516444a8aSArnaldo Carvalho de Melo 	return 0;
42616444a8aSArnaldo Carvalho de Melo }
42716444a8aSArnaldo Carvalho de Melo 
428e309b41dSIngo Molnar static int __unregister_ftrace_function(struct ftrace_ops *ops)
42916444a8aSArnaldo Carvalho de Melo {
4302b499381SSteven Rostedt 	int ret;
43116444a8aSArnaldo Carvalho de Melo 
432b848914cSSteven Rostedt 	if (WARN_ON(!(ops->flags & FTRACE_OPS_FL_ENABLED)))
433b848914cSSteven Rostedt 		return -EBUSY;
434b848914cSSteven Rostedt 
4354104d326SSteven Rostedt (Red Hat) 	if (ops->flags & FTRACE_OPS_FL_CONTROL) {
436e248491aSJiri Olsa 		ret = remove_ftrace_list_ops(&ftrace_control_list,
437e248491aSJiri Olsa 					     &control_ops, ops);
438b848914cSSteven Rostedt 	} else
439b848914cSSteven Rostedt 		ret = remove_ftrace_ops(&ftrace_ops_list, ops);
440b848914cSSteven Rostedt 
4412b499381SSteven Rostedt 	if (ret < 0)
4422b499381SSteven Rostedt 		return ret;
443b848914cSSteven Rostedt 
444491d0dcfSSteven Rostedt 	if (ftrace_enabled)
445491d0dcfSSteven Rostedt 		update_ftrace_function();
44616444a8aSArnaldo Carvalho de Melo 
447e6ea44e9SSteven Rostedt 	return 0;
4483d083395SSteven Rostedt }
4493d083395SSteven Rostedt 
450df4fc315SSteven Rostedt static void ftrace_update_pid_func(void)
451df4fc315SSteven Rostedt {
452491d0dcfSSteven Rostedt 	/* Only do something if we are tracing something */
453df4fc315SSteven Rostedt 	if (ftrace_trace_function == ftrace_stub)
45410dd3ebeSKOSAKI Motohiro 		return;
455df4fc315SSteven Rostedt 
456491d0dcfSSteven Rostedt 	update_ftrace_function();
457df4fc315SSteven Rostedt }
458df4fc315SSteven Rostedt 
459493762fcSSteven Rostedt #ifdef CONFIG_FUNCTION_PROFILER
460493762fcSSteven Rostedt struct ftrace_profile {
461493762fcSSteven Rostedt 	struct hlist_node		node;
462493762fcSSteven Rostedt 	unsigned long			ip;
463493762fcSSteven Rostedt 	unsigned long			counter;
4640706f1c4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
4650706f1c4SSteven Rostedt 	unsigned long long		time;
466e330b3bcSChase Douglas 	unsigned long long		time_squared;
4670706f1c4SSteven Rostedt #endif
468493762fcSSteven Rostedt };
469493762fcSSteven Rostedt 
470493762fcSSteven Rostedt struct ftrace_profile_page {
471493762fcSSteven Rostedt 	struct ftrace_profile_page	*next;
472493762fcSSteven Rostedt 	unsigned long			index;
473493762fcSSteven Rostedt 	struct ftrace_profile		records[];
474493762fcSSteven Rostedt };
475493762fcSSteven Rostedt 
476cafb168aSSteven Rostedt struct ftrace_profile_stat {
477cafb168aSSteven Rostedt 	atomic_t			disabled;
478cafb168aSSteven Rostedt 	struct hlist_head		*hash;
479cafb168aSSteven Rostedt 	struct ftrace_profile_page	*pages;
480cafb168aSSteven Rostedt 	struct ftrace_profile_page	*start;
481cafb168aSSteven Rostedt 	struct tracer_stat		stat;
482cafb168aSSteven Rostedt };
483cafb168aSSteven Rostedt 
484493762fcSSteven Rostedt #define PROFILE_RECORDS_SIZE						\
485493762fcSSteven Rostedt 	(PAGE_SIZE - offsetof(struct ftrace_profile_page, records))
486493762fcSSteven Rostedt 
487493762fcSSteven Rostedt #define PROFILES_PER_PAGE					\
488493762fcSSteven Rostedt 	(PROFILE_RECORDS_SIZE / sizeof(struct ftrace_profile))
489493762fcSSteven Rostedt 
490fb9fb015SSteven Rostedt static int ftrace_profile_enabled __read_mostly;
491fb9fb015SSteven Rostedt 
492fb9fb015SSteven Rostedt /* ftrace_profile_lock - synchronize the enable and disable of the profiler */
493493762fcSSteven Rostedt static DEFINE_MUTEX(ftrace_profile_lock);
494493762fcSSteven Rostedt 
495cafb168aSSteven Rostedt static DEFINE_PER_CPU(struct ftrace_profile_stat, ftrace_profile_stats);
496493762fcSSteven Rostedt 
49720079ebeSNamhyung Kim #define FTRACE_PROFILE_HASH_BITS 10
49820079ebeSNamhyung Kim #define FTRACE_PROFILE_HASH_SIZE (1 << FTRACE_PROFILE_HASH_BITS)
499493762fcSSteven Rostedt 
500493762fcSSteven Rostedt static void *
501493762fcSSteven Rostedt function_stat_next(void *v, int idx)
502493762fcSSteven Rostedt {
503493762fcSSteven Rostedt 	struct ftrace_profile *rec = v;
504493762fcSSteven Rostedt 	struct ftrace_profile_page *pg;
505493762fcSSteven Rostedt 
506493762fcSSteven Rostedt 	pg = (struct ftrace_profile_page *)((unsigned long)rec & PAGE_MASK);
507493762fcSSteven Rostedt 
508493762fcSSteven Rostedt  again:
5090296e425SLi Zefan 	if (idx != 0)
510493762fcSSteven Rostedt 		rec++;
5110296e425SLi Zefan 
512493762fcSSteven Rostedt 	if ((void *)rec >= (void *)&pg->records[pg->index]) {
513493762fcSSteven Rostedt 		pg = pg->next;
514493762fcSSteven Rostedt 		if (!pg)
515493762fcSSteven Rostedt 			return NULL;
516493762fcSSteven Rostedt 		rec = &pg->records[0];
517493762fcSSteven Rostedt 		if (!rec->counter)
518493762fcSSteven Rostedt 			goto again;
519493762fcSSteven Rostedt 	}
520493762fcSSteven Rostedt 
521493762fcSSteven Rostedt 	return rec;
522493762fcSSteven Rostedt }
523493762fcSSteven Rostedt 
524493762fcSSteven Rostedt static void *function_stat_start(struct tracer_stat *trace)
525493762fcSSteven Rostedt {
526cafb168aSSteven Rostedt 	struct ftrace_profile_stat *stat =
527cafb168aSSteven Rostedt 		container_of(trace, struct ftrace_profile_stat, stat);
528cafb168aSSteven Rostedt 
529cafb168aSSteven Rostedt 	if (!stat || !stat->start)
530cafb168aSSteven Rostedt 		return NULL;
531cafb168aSSteven Rostedt 
532cafb168aSSteven Rostedt 	return function_stat_next(&stat->start->records[0], 0);
533493762fcSSteven Rostedt }
534493762fcSSteven Rostedt 
5350706f1c4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
5360706f1c4SSteven Rostedt /* function graph compares on total time */
5370706f1c4SSteven Rostedt static int function_stat_cmp(void *p1, void *p2)
5380706f1c4SSteven Rostedt {
5390706f1c4SSteven Rostedt 	struct ftrace_profile *a = p1;
5400706f1c4SSteven Rostedt 	struct ftrace_profile *b = p2;
5410706f1c4SSteven Rostedt 
5420706f1c4SSteven Rostedt 	if (a->time < b->time)
5430706f1c4SSteven Rostedt 		return -1;
5440706f1c4SSteven Rostedt 	if (a->time > b->time)
5450706f1c4SSteven Rostedt 		return 1;
5460706f1c4SSteven Rostedt 	else
5470706f1c4SSteven Rostedt 		return 0;
5480706f1c4SSteven Rostedt }
5490706f1c4SSteven Rostedt #else
5500706f1c4SSteven Rostedt /* not function graph compares against hits */
551493762fcSSteven Rostedt static int function_stat_cmp(void *p1, void *p2)
552493762fcSSteven Rostedt {
553493762fcSSteven Rostedt 	struct ftrace_profile *a = p1;
554493762fcSSteven Rostedt 	struct ftrace_profile *b = p2;
555493762fcSSteven Rostedt 
556493762fcSSteven Rostedt 	if (a->counter < b->counter)
557493762fcSSteven Rostedt 		return -1;
558493762fcSSteven Rostedt 	if (a->counter > b->counter)
559493762fcSSteven Rostedt 		return 1;
560493762fcSSteven Rostedt 	else
561493762fcSSteven Rostedt 		return 0;
562493762fcSSteven Rostedt }
5630706f1c4SSteven Rostedt #endif
564493762fcSSteven Rostedt 
565493762fcSSteven Rostedt static int function_stat_headers(struct seq_file *m)
566493762fcSSteven Rostedt {
5670706f1c4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
56834886c8bSSteven Rostedt 	seq_printf(m, "  Function                               "
569e330b3bcSChase Douglas 		   "Hit    Time            Avg             s^2\n"
57034886c8bSSteven Rostedt 		      "  --------                               "
571e330b3bcSChase Douglas 		   "---    ----            ---             ---\n");
5720706f1c4SSteven Rostedt #else
573493762fcSSteven Rostedt 	seq_printf(m, "  Function                               Hit\n"
574493762fcSSteven Rostedt 		      "  --------                               ---\n");
5750706f1c4SSteven Rostedt #endif
576493762fcSSteven Rostedt 	return 0;
577493762fcSSteven Rostedt }
578493762fcSSteven Rostedt 
579493762fcSSteven Rostedt static int function_stat_show(struct seq_file *m, void *v)
580493762fcSSteven Rostedt {
581493762fcSSteven Rostedt 	struct ftrace_profile *rec = v;
582493762fcSSteven Rostedt 	char str[KSYM_SYMBOL_LEN];
5833aaba20fSLi Zefan 	int ret = 0;
5840706f1c4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
58534886c8bSSteven Rostedt 	static struct trace_seq s;
58634886c8bSSteven Rostedt 	unsigned long long avg;
587e330b3bcSChase Douglas 	unsigned long long stddev;
5880706f1c4SSteven Rostedt #endif
5893aaba20fSLi Zefan 	mutex_lock(&ftrace_profile_lock);
5903aaba20fSLi Zefan 
5913aaba20fSLi Zefan 	/* we raced with function_profile_reset() */
5923aaba20fSLi Zefan 	if (unlikely(rec->counter == 0)) {
5933aaba20fSLi Zefan 		ret = -EBUSY;
5943aaba20fSLi Zefan 		goto out;
5953aaba20fSLi Zefan 	}
596493762fcSSteven Rostedt 
597493762fcSSteven Rostedt 	kallsyms_lookup(rec->ip, NULL, NULL, NULL, str);
5980706f1c4SSteven Rostedt 	seq_printf(m, "  %-30.30s  %10lu", str, rec->counter);
599493762fcSSteven Rostedt 
6000706f1c4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
6010706f1c4SSteven Rostedt 	seq_printf(m, "    ");
60234886c8bSSteven Rostedt 	avg = rec->time;
60334886c8bSSteven Rostedt 	do_div(avg, rec->counter);
60434886c8bSSteven Rostedt 
605e330b3bcSChase Douglas 	/* Sample standard deviation (s^2) */
606e330b3bcSChase Douglas 	if (rec->counter <= 1)
607e330b3bcSChase Douglas 		stddev = 0;
608e330b3bcSChase Douglas 	else {
60952d85d76SJuri Lelli 		/*
61052d85d76SJuri Lelli 		 * Apply Welford's method:
61152d85d76SJuri Lelli 		 * s^2 = 1 / (n * (n-1)) * (n * \Sum (x_i)^2 - (\Sum x_i)^2)
61252d85d76SJuri Lelli 		 */
61352d85d76SJuri Lelli 		stddev = rec->counter * rec->time_squared -
61452d85d76SJuri Lelli 			 rec->time * rec->time;
61552d85d76SJuri Lelli 
616e330b3bcSChase Douglas 		/*
617e330b3bcSChase Douglas 		 * Divide only 1000 for ns^2 -> us^2 conversion.
618e330b3bcSChase Douglas 		 * trace_print_graph_duration will divide 1000 again.
619e330b3bcSChase Douglas 		 */
62052d85d76SJuri Lelli 		do_div(stddev, rec->counter * (rec->counter - 1) * 1000);
621e330b3bcSChase Douglas 	}
622e330b3bcSChase Douglas 
62334886c8bSSteven Rostedt 	trace_seq_init(&s);
62434886c8bSSteven Rostedt 	trace_print_graph_duration(rec->time, &s);
62534886c8bSSteven Rostedt 	trace_seq_puts(&s, "    ");
62634886c8bSSteven Rostedt 	trace_print_graph_duration(avg, &s);
627e330b3bcSChase Douglas 	trace_seq_puts(&s, "    ");
628e330b3bcSChase Douglas 	trace_print_graph_duration(stddev, &s);
6290706f1c4SSteven Rostedt 	trace_print_seq(m, &s);
6300706f1c4SSteven Rostedt #endif
6310706f1c4SSteven Rostedt 	seq_putc(m, '\n');
6323aaba20fSLi Zefan out:
6333aaba20fSLi Zefan 	mutex_unlock(&ftrace_profile_lock);
6340706f1c4SSteven Rostedt 
6353aaba20fSLi Zefan 	return ret;
636493762fcSSteven Rostedt }
637493762fcSSteven Rostedt 
638cafb168aSSteven Rostedt static void ftrace_profile_reset(struct ftrace_profile_stat *stat)
639493762fcSSteven Rostedt {
640493762fcSSteven Rostedt 	struct ftrace_profile_page *pg;
641493762fcSSteven Rostedt 
642cafb168aSSteven Rostedt 	pg = stat->pages = stat->start;
643493762fcSSteven Rostedt 
644493762fcSSteven Rostedt 	while (pg) {
645493762fcSSteven Rostedt 		memset(pg->records, 0, PROFILE_RECORDS_SIZE);
646493762fcSSteven Rostedt 		pg->index = 0;
647493762fcSSteven Rostedt 		pg = pg->next;
648493762fcSSteven Rostedt 	}
649493762fcSSteven Rostedt 
650cafb168aSSteven Rostedt 	memset(stat->hash, 0,
651493762fcSSteven Rostedt 	       FTRACE_PROFILE_HASH_SIZE * sizeof(struct hlist_head));
652493762fcSSteven Rostedt }
653493762fcSSteven Rostedt 
654cafb168aSSteven Rostedt int ftrace_profile_pages_init(struct ftrace_profile_stat *stat)
655493762fcSSteven Rostedt {
656493762fcSSteven Rostedt 	struct ftrace_profile_page *pg;
657318e0a73SSteven Rostedt 	int functions;
658318e0a73SSteven Rostedt 	int pages;
659493762fcSSteven Rostedt 	int i;
660493762fcSSteven Rostedt 
661493762fcSSteven Rostedt 	/* If we already allocated, do nothing */
662cafb168aSSteven Rostedt 	if (stat->pages)
663493762fcSSteven Rostedt 		return 0;
664493762fcSSteven Rostedt 
665cafb168aSSteven Rostedt 	stat->pages = (void *)get_zeroed_page(GFP_KERNEL);
666cafb168aSSteven Rostedt 	if (!stat->pages)
667493762fcSSteven Rostedt 		return -ENOMEM;
668493762fcSSteven Rostedt 
669318e0a73SSteven Rostedt #ifdef CONFIG_DYNAMIC_FTRACE
670318e0a73SSteven Rostedt 	functions = ftrace_update_tot_cnt;
671318e0a73SSteven Rostedt #else
672318e0a73SSteven Rostedt 	/*
673318e0a73SSteven Rostedt 	 * We do not know the number of functions that exist because
674318e0a73SSteven Rostedt 	 * dynamic tracing is what counts them. With past experience
675318e0a73SSteven Rostedt 	 * we have around 20K functions. That should be more than enough.
676318e0a73SSteven Rostedt 	 * It is highly unlikely we will execute every function in
677318e0a73SSteven Rostedt 	 * the kernel.
678318e0a73SSteven Rostedt 	 */
679318e0a73SSteven Rostedt 	functions = 20000;
680318e0a73SSteven Rostedt #endif
681318e0a73SSteven Rostedt 
682cafb168aSSteven Rostedt 	pg = stat->start = stat->pages;
683493762fcSSteven Rostedt 
684318e0a73SSteven Rostedt 	pages = DIV_ROUND_UP(functions, PROFILES_PER_PAGE);
685318e0a73SSteven Rostedt 
68639e30cd1SNamhyung Kim 	for (i = 1; i < pages; i++) {
687493762fcSSteven Rostedt 		pg->next = (void *)get_zeroed_page(GFP_KERNEL);
688493762fcSSteven Rostedt 		if (!pg->next)
689318e0a73SSteven Rostedt 			goto out_free;
690493762fcSSteven Rostedt 		pg = pg->next;
691493762fcSSteven Rostedt 	}
692493762fcSSteven Rostedt 
693493762fcSSteven Rostedt 	return 0;
694318e0a73SSteven Rostedt 
695318e0a73SSteven Rostedt  out_free:
696318e0a73SSteven Rostedt 	pg = stat->start;
697318e0a73SSteven Rostedt 	while (pg) {
698318e0a73SSteven Rostedt 		unsigned long tmp = (unsigned long)pg;
699318e0a73SSteven Rostedt 
700318e0a73SSteven Rostedt 		pg = pg->next;
701318e0a73SSteven Rostedt 		free_page(tmp);
702318e0a73SSteven Rostedt 	}
703318e0a73SSteven Rostedt 
704318e0a73SSteven Rostedt 	stat->pages = NULL;
705318e0a73SSteven Rostedt 	stat->start = NULL;
706318e0a73SSteven Rostedt 
707318e0a73SSteven Rostedt 	return -ENOMEM;
708493762fcSSteven Rostedt }
709493762fcSSteven Rostedt 
710cafb168aSSteven Rostedt static int ftrace_profile_init_cpu(int cpu)
711493762fcSSteven Rostedt {
712cafb168aSSteven Rostedt 	struct ftrace_profile_stat *stat;
713493762fcSSteven Rostedt 	int size;
714493762fcSSteven Rostedt 
715cafb168aSSteven Rostedt 	stat = &per_cpu(ftrace_profile_stats, cpu);
716cafb168aSSteven Rostedt 
717cafb168aSSteven Rostedt 	if (stat->hash) {
718493762fcSSteven Rostedt 		/* If the profile is already created, simply reset it */
719cafb168aSSteven Rostedt 		ftrace_profile_reset(stat);
720493762fcSSteven Rostedt 		return 0;
721493762fcSSteven Rostedt 	}
722493762fcSSteven Rostedt 
723493762fcSSteven Rostedt 	/*
724493762fcSSteven Rostedt 	 * We are profiling all functions, but usually only a few thousand
725493762fcSSteven Rostedt 	 * functions are hit. We'll make a hash of 1024 items.
726493762fcSSteven Rostedt 	 */
727493762fcSSteven Rostedt 	size = FTRACE_PROFILE_HASH_SIZE;
728493762fcSSteven Rostedt 
729cafb168aSSteven Rostedt 	stat->hash = kzalloc(sizeof(struct hlist_head) * size, GFP_KERNEL);
730493762fcSSteven Rostedt 
731cafb168aSSteven Rostedt 	if (!stat->hash)
732493762fcSSteven Rostedt 		return -ENOMEM;
733493762fcSSteven Rostedt 
734318e0a73SSteven Rostedt 	/* Preallocate the function profiling pages */
735cafb168aSSteven Rostedt 	if (ftrace_profile_pages_init(stat) < 0) {
736cafb168aSSteven Rostedt 		kfree(stat->hash);
737cafb168aSSteven Rostedt 		stat->hash = NULL;
738493762fcSSteven Rostedt 		return -ENOMEM;
739493762fcSSteven Rostedt 	}
740493762fcSSteven Rostedt 
741493762fcSSteven Rostedt 	return 0;
742493762fcSSteven Rostedt }
743493762fcSSteven Rostedt 
744cafb168aSSteven Rostedt static int ftrace_profile_init(void)
745cafb168aSSteven Rostedt {
746cafb168aSSteven Rostedt 	int cpu;
747cafb168aSSteven Rostedt 	int ret = 0;
748cafb168aSSteven Rostedt 
749c4602c1cSMiao Xie 	for_each_possible_cpu(cpu) {
750cafb168aSSteven Rostedt 		ret = ftrace_profile_init_cpu(cpu);
751cafb168aSSteven Rostedt 		if (ret)
752cafb168aSSteven Rostedt 			break;
753cafb168aSSteven Rostedt 	}
754cafb168aSSteven Rostedt 
755cafb168aSSteven Rostedt 	return ret;
756cafb168aSSteven Rostedt }
757cafb168aSSteven Rostedt 
758493762fcSSteven Rostedt /* interrupts must be disabled */
759cafb168aSSteven Rostedt static struct ftrace_profile *
760cafb168aSSteven Rostedt ftrace_find_profiled_func(struct ftrace_profile_stat *stat, unsigned long ip)
761493762fcSSteven Rostedt {
762493762fcSSteven Rostedt 	struct ftrace_profile *rec;
763493762fcSSteven Rostedt 	struct hlist_head *hhd;
764493762fcSSteven Rostedt 	unsigned long key;
765493762fcSSteven Rostedt 
76620079ebeSNamhyung Kim 	key = hash_long(ip, FTRACE_PROFILE_HASH_BITS);
767cafb168aSSteven Rostedt 	hhd = &stat->hash[key];
768493762fcSSteven Rostedt 
769493762fcSSteven Rostedt 	if (hlist_empty(hhd))
770493762fcSSteven Rostedt 		return NULL;
771493762fcSSteven Rostedt 
7721bb539caSSteven Rostedt 	hlist_for_each_entry_rcu_notrace(rec, hhd, node) {
773493762fcSSteven Rostedt 		if (rec->ip == ip)
774493762fcSSteven Rostedt 			return rec;
775493762fcSSteven Rostedt 	}
776493762fcSSteven Rostedt 
777493762fcSSteven Rostedt 	return NULL;
778493762fcSSteven Rostedt }
779493762fcSSteven Rostedt 
780cafb168aSSteven Rostedt static void ftrace_add_profile(struct ftrace_profile_stat *stat,
781cafb168aSSteven Rostedt 			       struct ftrace_profile *rec)
782493762fcSSteven Rostedt {
783493762fcSSteven Rostedt 	unsigned long key;
784493762fcSSteven Rostedt 
78520079ebeSNamhyung Kim 	key = hash_long(rec->ip, FTRACE_PROFILE_HASH_BITS);
786cafb168aSSteven Rostedt 	hlist_add_head_rcu(&rec->node, &stat->hash[key]);
787493762fcSSteven Rostedt }
788493762fcSSteven Rostedt 
789318e0a73SSteven Rostedt /*
790318e0a73SSteven Rostedt  * The memory is already allocated, this simply finds a new record to use.
791318e0a73SSteven Rostedt  */
792493762fcSSteven Rostedt static struct ftrace_profile *
793318e0a73SSteven Rostedt ftrace_profile_alloc(struct ftrace_profile_stat *stat, unsigned long ip)
794493762fcSSteven Rostedt {
795493762fcSSteven Rostedt 	struct ftrace_profile *rec = NULL;
796493762fcSSteven Rostedt 
797318e0a73SSteven Rostedt 	/* prevent recursion (from NMIs) */
798cafb168aSSteven Rostedt 	if (atomic_inc_return(&stat->disabled) != 1)
799493762fcSSteven Rostedt 		goto out;
800493762fcSSteven Rostedt 
801493762fcSSteven Rostedt 	/*
802318e0a73SSteven Rostedt 	 * Try to find the function again since an NMI
803318e0a73SSteven Rostedt 	 * could have added it
804493762fcSSteven Rostedt 	 */
805cafb168aSSteven Rostedt 	rec = ftrace_find_profiled_func(stat, ip);
806493762fcSSteven Rostedt 	if (rec)
807cafb168aSSteven Rostedt 		goto out;
808493762fcSSteven Rostedt 
809cafb168aSSteven Rostedt 	if (stat->pages->index == PROFILES_PER_PAGE) {
810cafb168aSSteven Rostedt 		if (!stat->pages->next)
811cafb168aSSteven Rostedt 			goto out;
812cafb168aSSteven Rostedt 		stat->pages = stat->pages->next;
813493762fcSSteven Rostedt 	}
814493762fcSSteven Rostedt 
815cafb168aSSteven Rostedt 	rec = &stat->pages->records[stat->pages->index++];
816493762fcSSteven Rostedt 	rec->ip = ip;
817cafb168aSSteven Rostedt 	ftrace_add_profile(stat, rec);
818493762fcSSteven Rostedt 
819493762fcSSteven Rostedt  out:
820cafb168aSSteven Rostedt 	atomic_dec(&stat->disabled);
821493762fcSSteven Rostedt 
822493762fcSSteven Rostedt 	return rec;
823493762fcSSteven Rostedt }
824493762fcSSteven Rostedt 
825493762fcSSteven Rostedt static void
8262f5f6ad9SSteven Rostedt function_profile_call(unsigned long ip, unsigned long parent_ip,
827a1e2e31dSSteven Rostedt 		      struct ftrace_ops *ops, struct pt_regs *regs)
828493762fcSSteven Rostedt {
829cafb168aSSteven Rostedt 	struct ftrace_profile_stat *stat;
830493762fcSSteven Rostedt 	struct ftrace_profile *rec;
831493762fcSSteven Rostedt 	unsigned long flags;
832493762fcSSteven Rostedt 
833493762fcSSteven Rostedt 	if (!ftrace_profile_enabled)
834493762fcSSteven Rostedt 		return;
835493762fcSSteven Rostedt 
836493762fcSSteven Rostedt 	local_irq_save(flags);
837cafb168aSSteven Rostedt 
838bdffd893SChristoph Lameter 	stat = this_cpu_ptr(&ftrace_profile_stats);
8390f6ce3deSSteven Rostedt 	if (!stat->hash || !ftrace_profile_enabled)
840cafb168aSSteven Rostedt 		goto out;
841cafb168aSSteven Rostedt 
842cafb168aSSteven Rostedt 	rec = ftrace_find_profiled_func(stat, ip);
843493762fcSSteven Rostedt 	if (!rec) {
844318e0a73SSteven Rostedt 		rec = ftrace_profile_alloc(stat, ip);
845493762fcSSteven Rostedt 		if (!rec)
846493762fcSSteven Rostedt 			goto out;
847493762fcSSteven Rostedt 	}
848493762fcSSteven Rostedt 
849493762fcSSteven Rostedt 	rec->counter++;
850493762fcSSteven Rostedt  out:
851493762fcSSteven Rostedt 	local_irq_restore(flags);
852493762fcSSteven Rostedt }
853493762fcSSteven Rostedt 
8540706f1c4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
8550706f1c4SSteven Rostedt static int profile_graph_entry(struct ftrace_graph_ent *trace)
8560706f1c4SSteven Rostedt {
857a1e2e31dSSteven Rostedt 	function_profile_call(trace->func, 0, NULL, NULL);
8580706f1c4SSteven Rostedt 	return 1;
8590706f1c4SSteven Rostedt }
8600706f1c4SSteven Rostedt 
8610706f1c4SSteven Rostedt static void profile_graph_return(struct ftrace_graph_ret *trace)
8620706f1c4SSteven Rostedt {
863cafb168aSSteven Rostedt 	struct ftrace_profile_stat *stat;
864a2a16d6aSSteven Rostedt 	unsigned long long calltime;
8650706f1c4SSteven Rostedt 	struct ftrace_profile *rec;
866cafb168aSSteven Rostedt 	unsigned long flags;
8670706f1c4SSteven Rostedt 
8680706f1c4SSteven Rostedt 	local_irq_save(flags);
869bdffd893SChristoph Lameter 	stat = this_cpu_ptr(&ftrace_profile_stats);
8700f6ce3deSSteven Rostedt 	if (!stat->hash || !ftrace_profile_enabled)
871cafb168aSSteven Rostedt 		goto out;
872cafb168aSSteven Rostedt 
87337e44bc5SSteven Rostedt 	/* If the calltime was zero'd ignore it */
87437e44bc5SSteven Rostedt 	if (!trace->calltime)
87537e44bc5SSteven Rostedt 		goto out;
87637e44bc5SSteven Rostedt 
877a2a16d6aSSteven Rostedt 	calltime = trace->rettime - trace->calltime;
878a2a16d6aSSteven Rostedt 
879a2a16d6aSSteven Rostedt 	if (!(trace_flags & TRACE_ITER_GRAPH_TIME)) {
880a2a16d6aSSteven Rostedt 		int index;
881a2a16d6aSSteven Rostedt 
882a2a16d6aSSteven Rostedt 		index = trace->depth;
883a2a16d6aSSteven Rostedt 
884a2a16d6aSSteven Rostedt 		/* Append this call time to the parent time to subtract */
885a2a16d6aSSteven Rostedt 		if (index)
886a2a16d6aSSteven Rostedt 			current->ret_stack[index - 1].subtime += calltime;
887a2a16d6aSSteven Rostedt 
888a2a16d6aSSteven Rostedt 		if (current->ret_stack[index].subtime < calltime)
889a2a16d6aSSteven Rostedt 			calltime -= current->ret_stack[index].subtime;
890a2a16d6aSSteven Rostedt 		else
891a2a16d6aSSteven Rostedt 			calltime = 0;
892a2a16d6aSSteven Rostedt 	}
893a2a16d6aSSteven Rostedt 
894cafb168aSSteven Rostedt 	rec = ftrace_find_profiled_func(stat, trace->func);
895e330b3bcSChase Douglas 	if (rec) {
896a2a16d6aSSteven Rostedt 		rec->time += calltime;
897e330b3bcSChase Douglas 		rec->time_squared += calltime * calltime;
898e330b3bcSChase Douglas 	}
899a2a16d6aSSteven Rostedt 
900cafb168aSSteven Rostedt  out:
9010706f1c4SSteven Rostedt 	local_irq_restore(flags);
9020706f1c4SSteven Rostedt }
9030706f1c4SSteven Rostedt 
9040706f1c4SSteven Rostedt static int register_ftrace_profiler(void)
9050706f1c4SSteven Rostedt {
9060706f1c4SSteven Rostedt 	return register_ftrace_graph(&profile_graph_return,
9070706f1c4SSteven Rostedt 				     &profile_graph_entry);
9080706f1c4SSteven Rostedt }
9090706f1c4SSteven Rostedt 
9100706f1c4SSteven Rostedt static void unregister_ftrace_profiler(void)
9110706f1c4SSteven Rostedt {
9120706f1c4SSteven Rostedt 	unregister_ftrace_graph();
9130706f1c4SSteven Rostedt }
9140706f1c4SSteven Rostedt #else
915bd38c0e6SPaul McQuade static struct ftrace_ops ftrace_profile_ops __read_mostly = {
916493762fcSSteven Rostedt 	.func		= function_profile_call,
917f04f24fbSMasami Hiramatsu 	.flags		= FTRACE_OPS_FL_RECURSION_SAFE | FTRACE_OPS_FL_INITIALIZED,
91833b7f99cSSteven Rostedt (Red Hat) 	INIT_OPS_HASH(ftrace_profile_ops)
919493762fcSSteven Rostedt };
920493762fcSSteven Rostedt 
9210706f1c4SSteven Rostedt static int register_ftrace_profiler(void)
9220706f1c4SSteven Rostedt {
9230706f1c4SSteven Rostedt 	return register_ftrace_function(&ftrace_profile_ops);
9240706f1c4SSteven Rostedt }
9250706f1c4SSteven Rostedt 
9260706f1c4SSteven Rostedt static void unregister_ftrace_profiler(void)
9270706f1c4SSteven Rostedt {
9280706f1c4SSteven Rostedt 	unregister_ftrace_function(&ftrace_profile_ops);
9290706f1c4SSteven Rostedt }
9300706f1c4SSteven Rostedt #endif /* CONFIG_FUNCTION_GRAPH_TRACER */
9310706f1c4SSteven Rostedt 
932493762fcSSteven Rostedt static ssize_t
933493762fcSSteven Rostedt ftrace_profile_write(struct file *filp, const char __user *ubuf,
934493762fcSSteven Rostedt 		     size_t cnt, loff_t *ppos)
935493762fcSSteven Rostedt {
936493762fcSSteven Rostedt 	unsigned long val;
937493762fcSSteven Rostedt 	int ret;
938493762fcSSteven Rostedt 
93922fe9b54SPeter Huewe 	ret = kstrtoul_from_user(ubuf, cnt, 10, &val);
94022fe9b54SPeter Huewe 	if (ret)
941493762fcSSteven Rostedt 		return ret;
942493762fcSSteven Rostedt 
943493762fcSSteven Rostedt 	val = !!val;
944493762fcSSteven Rostedt 
945493762fcSSteven Rostedt 	mutex_lock(&ftrace_profile_lock);
946493762fcSSteven Rostedt 	if (ftrace_profile_enabled ^ val) {
947493762fcSSteven Rostedt 		if (val) {
948493762fcSSteven Rostedt 			ret = ftrace_profile_init();
949493762fcSSteven Rostedt 			if (ret < 0) {
950493762fcSSteven Rostedt 				cnt = ret;
951493762fcSSteven Rostedt 				goto out;
952493762fcSSteven Rostedt 			}
953493762fcSSteven Rostedt 
9540706f1c4SSteven Rostedt 			ret = register_ftrace_profiler();
9550706f1c4SSteven Rostedt 			if (ret < 0) {
9560706f1c4SSteven Rostedt 				cnt = ret;
9570706f1c4SSteven Rostedt 				goto out;
9580706f1c4SSteven Rostedt 			}
959493762fcSSteven Rostedt 			ftrace_profile_enabled = 1;
960493762fcSSteven Rostedt 		} else {
961493762fcSSteven Rostedt 			ftrace_profile_enabled = 0;
9620f6ce3deSSteven Rostedt 			/*
9630f6ce3deSSteven Rostedt 			 * unregister_ftrace_profiler calls stop_machine
9640f6ce3deSSteven Rostedt 			 * so this acts like an synchronize_sched.
9650f6ce3deSSteven Rostedt 			 */
9660706f1c4SSteven Rostedt 			unregister_ftrace_profiler();
967493762fcSSteven Rostedt 		}
968493762fcSSteven Rostedt 	}
969493762fcSSteven Rostedt  out:
970493762fcSSteven Rostedt 	mutex_unlock(&ftrace_profile_lock);
971493762fcSSteven Rostedt 
972cf8517cfSJiri Olsa 	*ppos += cnt;
973493762fcSSteven Rostedt 
974493762fcSSteven Rostedt 	return cnt;
975493762fcSSteven Rostedt }
976493762fcSSteven Rostedt 
977493762fcSSteven Rostedt static ssize_t
978493762fcSSteven Rostedt ftrace_profile_read(struct file *filp, char __user *ubuf,
979493762fcSSteven Rostedt 		     size_t cnt, loff_t *ppos)
980493762fcSSteven Rostedt {
981fb9fb015SSteven Rostedt 	char buf[64];		/* big enough to hold a number */
982493762fcSSteven Rostedt 	int r;
983493762fcSSteven Rostedt 
984493762fcSSteven Rostedt 	r = sprintf(buf, "%u\n", ftrace_profile_enabled);
985493762fcSSteven Rostedt 	return simple_read_from_buffer(ubuf, cnt, ppos, buf, r);
986493762fcSSteven Rostedt }
987493762fcSSteven Rostedt 
988493762fcSSteven Rostedt static const struct file_operations ftrace_profile_fops = {
989493762fcSSteven Rostedt 	.open		= tracing_open_generic,
990493762fcSSteven Rostedt 	.read		= ftrace_profile_read,
991493762fcSSteven Rostedt 	.write		= ftrace_profile_write,
9926038f373SArnd Bergmann 	.llseek		= default_llseek,
993493762fcSSteven Rostedt };
994493762fcSSteven Rostedt 
995cafb168aSSteven Rostedt /* used to initialize the real stat files */
996cafb168aSSteven Rostedt static struct tracer_stat function_stats __initdata = {
997cafb168aSSteven Rostedt 	.name		= "functions",
998cafb168aSSteven Rostedt 	.stat_start	= function_stat_start,
999cafb168aSSteven Rostedt 	.stat_next	= function_stat_next,
1000cafb168aSSteven Rostedt 	.stat_cmp	= function_stat_cmp,
1001cafb168aSSteven Rostedt 	.stat_headers	= function_stat_headers,
1002cafb168aSSteven Rostedt 	.stat_show	= function_stat_show
1003cafb168aSSteven Rostedt };
1004cafb168aSSteven Rostedt 
10056ab5d668SSteven Rostedt static __init void ftrace_profile_debugfs(struct dentry *d_tracer)
1006493762fcSSteven Rostedt {
1007cafb168aSSteven Rostedt 	struct ftrace_profile_stat *stat;
1008493762fcSSteven Rostedt 	struct dentry *entry;
1009cafb168aSSteven Rostedt 	char *name;
1010493762fcSSteven Rostedt 	int ret;
1011cafb168aSSteven Rostedt 	int cpu;
1012493762fcSSteven Rostedt 
1013cafb168aSSteven Rostedt 	for_each_possible_cpu(cpu) {
1014cafb168aSSteven Rostedt 		stat = &per_cpu(ftrace_profile_stats, cpu);
1015cafb168aSSteven Rostedt 
1016cafb168aSSteven Rostedt 		/* allocate enough for function name + cpu number */
1017cafb168aSSteven Rostedt 		name = kmalloc(32, GFP_KERNEL);
1018cafb168aSSteven Rostedt 		if (!name) {
1019cafb168aSSteven Rostedt 			/*
1020cafb168aSSteven Rostedt 			 * The files created are permanent, if something happens
1021cafb168aSSteven Rostedt 			 * we still do not free memory.
1022cafb168aSSteven Rostedt 			 */
1023cafb168aSSteven Rostedt 			WARN(1,
1024cafb168aSSteven Rostedt 			     "Could not allocate stat file for cpu %d\n",
1025cafb168aSSteven Rostedt 			     cpu);
1026493762fcSSteven Rostedt 			return;
1027493762fcSSteven Rostedt 		}
1028cafb168aSSteven Rostedt 		stat->stat = function_stats;
1029cafb168aSSteven Rostedt 		snprintf(name, 32, "function%d", cpu);
1030cafb168aSSteven Rostedt 		stat->stat.name = name;
1031cafb168aSSteven Rostedt 		ret = register_stat_tracer(&stat->stat);
1032cafb168aSSteven Rostedt 		if (ret) {
1033cafb168aSSteven Rostedt 			WARN(1,
1034cafb168aSSteven Rostedt 			     "Could not register function stat for cpu %d\n",
1035cafb168aSSteven Rostedt 			     cpu);
1036cafb168aSSteven Rostedt 			kfree(name);
1037cafb168aSSteven Rostedt 			return;
1038cafb168aSSteven Rostedt 		}
1039cafb168aSSteven Rostedt 	}
1040493762fcSSteven Rostedt 
1041493762fcSSteven Rostedt 	entry = debugfs_create_file("function_profile_enabled", 0644,
1042493762fcSSteven Rostedt 				    d_tracer, NULL, &ftrace_profile_fops);
1043493762fcSSteven Rostedt 	if (!entry)
1044493762fcSSteven Rostedt 		pr_warning("Could not create debugfs "
1045493762fcSSteven Rostedt 			   "'function_profile_enabled' entry\n");
1046493762fcSSteven Rostedt }
1047493762fcSSteven Rostedt 
1048493762fcSSteven Rostedt #else /* CONFIG_FUNCTION_PROFILER */
10496ab5d668SSteven Rostedt static __init void ftrace_profile_debugfs(struct dentry *d_tracer)
1050493762fcSSteven Rostedt {
1051493762fcSSteven Rostedt }
1052493762fcSSteven Rostedt #endif /* CONFIG_FUNCTION_PROFILER */
1053493762fcSSteven Rostedt 
105473d3fd96SIngo Molnar static struct pid * const ftrace_swapper_pid = &init_struct_pid;
105573d3fd96SIngo Molnar 
10563d083395SSteven Rostedt #ifdef CONFIG_DYNAMIC_FTRACE
105773d3fd96SIngo Molnar 
105879922b80SSteven Rostedt (Red Hat) static struct ftrace_ops *removed_ops;
105979922b80SSteven Rostedt (Red Hat) 
1060*e1effa01SSteven Rostedt (Red Hat) /*
1061*e1effa01SSteven Rostedt (Red Hat)  * Set when doing a global update, like enabling all recs or disabling them.
1062*e1effa01SSteven Rostedt (Red Hat)  * It is not set when just updating a single ftrace_ops.
1063*e1effa01SSteven Rostedt (Red Hat)  */
1064*e1effa01SSteven Rostedt (Red Hat) static bool update_all_ops;
1065*e1effa01SSteven Rostedt (Red Hat) 
106699ecdc43SSteven Rostedt #ifndef CONFIG_FTRACE_MCOUNT_RECORD
1067cb7be3b2SSteven Rostedt # error Dynamic ftrace depends on MCOUNT_RECORD
106899ecdc43SSteven Rostedt #endif
106999ecdc43SSteven Rostedt 
10708fc0c701SSteven Rostedt static struct hlist_head ftrace_func_hash[FTRACE_FUNC_HASHSIZE] __read_mostly;
10718fc0c701SSteven Rostedt 
1072b6887d79SSteven Rostedt struct ftrace_func_probe {
10738fc0c701SSteven Rostedt 	struct hlist_node	node;
1074b6887d79SSteven Rostedt 	struct ftrace_probe_ops	*ops;
10758fc0c701SSteven Rostedt 	unsigned long		flags;
10768fc0c701SSteven Rostedt 	unsigned long		ip;
10778fc0c701SSteven Rostedt 	void			*data;
10787818b388SSteven Rostedt (Red Hat) 	struct list_head	free_list;
10798fc0c701SSteven Rostedt };
10808fc0c701SSteven Rostedt 
1081b448c4e3SSteven Rostedt struct ftrace_func_entry {
1082b448c4e3SSteven Rostedt 	struct hlist_node hlist;
1083b448c4e3SSteven Rostedt 	unsigned long ip;
1084b448c4e3SSteven Rostedt };
1085b448c4e3SSteven Rostedt 
1086b448c4e3SSteven Rostedt struct ftrace_hash {
1087b448c4e3SSteven Rostedt 	unsigned long		size_bits;
1088b448c4e3SSteven Rostedt 	struct hlist_head	*buckets;
1089b448c4e3SSteven Rostedt 	unsigned long		count;
109007fd5515SSteven Rostedt 	struct rcu_head		rcu;
1091b448c4e3SSteven Rostedt };
1092b448c4e3SSteven Rostedt 
109333dc9b12SSteven Rostedt /*
109433dc9b12SSteven Rostedt  * We make these constant because no one should touch them,
109533dc9b12SSteven Rostedt  * but they are used as the default "empty hash", to avoid allocating
109633dc9b12SSteven Rostedt  * it all the time. These are in a read only section such that if
109733dc9b12SSteven Rostedt  * anyone does try to modify it, it will cause an exception.
109833dc9b12SSteven Rostedt  */
109933dc9b12SSteven Rostedt static const struct hlist_head empty_buckets[1];
110033dc9b12SSteven Rostedt static const struct ftrace_hash empty_hash = {
110133dc9b12SSteven Rostedt 	.buckets = (struct hlist_head *)empty_buckets,
1102b448c4e3SSteven Rostedt };
110333dc9b12SSteven Rostedt #define EMPTY_HASH	((struct ftrace_hash *)&empty_hash)
11045072c59fSSteven Rostedt 
11052b499381SSteven Rostedt static struct ftrace_ops global_ops = {
1106f45948e8SSteven Rostedt 	.func				= ftrace_stub,
110733b7f99cSSteven Rostedt (Red Hat) 	.local_hash.notrace_hash	= EMPTY_HASH,
110833b7f99cSSteven Rostedt (Red Hat) 	.local_hash.filter_hash		= EMPTY_HASH,
110933b7f99cSSteven Rostedt (Red Hat) 	INIT_OPS_HASH(global_ops)
111033b7f99cSSteven Rostedt (Red Hat) 	.flags				= FTRACE_OPS_FL_RECURSION_SAFE |
111133b7f99cSSteven Rostedt (Red Hat) 					  FTRACE_OPS_FL_INITIALIZED,
1112f45948e8SSteven Rostedt };
1113f45948e8SSteven Rostedt 
11143c1720f0SSteven Rostedt struct ftrace_page {
11153c1720f0SSteven Rostedt 	struct ftrace_page	*next;
1116a7900875SSteven Rostedt 	struct dyn_ftrace	*records;
1117431aa3fbSSteven Rostedt 	int			index;
1118a7900875SSteven Rostedt 	int			size;
1119aa5e5ceaSDavid Miller };
11203c1720f0SSteven Rostedt 
1121a7900875SSteven Rostedt #define ENTRY_SIZE sizeof(struct dyn_ftrace)
1122a7900875SSteven Rostedt #define ENTRIES_PER_PAGE (PAGE_SIZE / ENTRY_SIZE)
11233c1720f0SSteven Rostedt 
11243c1720f0SSteven Rostedt /* estimate from running different kernels */
11253c1720f0SSteven Rostedt #define NR_TO_INIT		10000
11263c1720f0SSteven Rostedt 
11273c1720f0SSteven Rostedt static struct ftrace_page	*ftrace_pages_start;
11283c1720f0SSteven Rostedt static struct ftrace_page	*ftrace_pages;
11293c1720f0SSteven Rostedt 
113068f40969SSteven Rostedt (Red Hat) static bool __always_inline ftrace_hash_empty(struct ftrace_hash *hash)
113106a51d93SSteven Rostedt {
113206a51d93SSteven Rostedt 	return !hash || !hash->count;
113306a51d93SSteven Rostedt }
113406a51d93SSteven Rostedt 
1135b448c4e3SSteven Rostedt static struct ftrace_func_entry *
1136b448c4e3SSteven Rostedt ftrace_lookup_ip(struct ftrace_hash *hash, unsigned long ip)
1137b448c4e3SSteven Rostedt {
1138b448c4e3SSteven Rostedt 	unsigned long key;
1139b448c4e3SSteven Rostedt 	struct ftrace_func_entry *entry;
1140b448c4e3SSteven Rostedt 	struct hlist_head *hhd;
1141b448c4e3SSteven Rostedt 
114206a51d93SSteven Rostedt 	if (ftrace_hash_empty(hash))
1143b448c4e3SSteven Rostedt 		return NULL;
1144b448c4e3SSteven Rostedt 
1145b448c4e3SSteven Rostedt 	if (hash->size_bits > 0)
1146b448c4e3SSteven Rostedt 		key = hash_long(ip, hash->size_bits);
1147b448c4e3SSteven Rostedt 	else
1148b448c4e3SSteven Rostedt 		key = 0;
1149b448c4e3SSteven Rostedt 
1150b448c4e3SSteven Rostedt 	hhd = &hash->buckets[key];
1151b448c4e3SSteven Rostedt 
11521bb539caSSteven Rostedt 	hlist_for_each_entry_rcu_notrace(entry, hhd, hlist) {
1153b448c4e3SSteven Rostedt 		if (entry->ip == ip)
1154b448c4e3SSteven Rostedt 			return entry;
1155b448c4e3SSteven Rostedt 	}
1156b448c4e3SSteven Rostedt 	return NULL;
1157b448c4e3SSteven Rostedt }
1158b448c4e3SSteven Rostedt 
115933dc9b12SSteven Rostedt static void __add_hash_entry(struct ftrace_hash *hash,
116033dc9b12SSteven Rostedt 			     struct ftrace_func_entry *entry)
116133dc9b12SSteven Rostedt {
116233dc9b12SSteven Rostedt 	struct hlist_head *hhd;
116333dc9b12SSteven Rostedt 	unsigned long key;
116433dc9b12SSteven Rostedt 
116533dc9b12SSteven Rostedt 	if (hash->size_bits)
116633dc9b12SSteven Rostedt 		key = hash_long(entry->ip, hash->size_bits);
116733dc9b12SSteven Rostedt 	else
116833dc9b12SSteven Rostedt 		key = 0;
116933dc9b12SSteven Rostedt 
117033dc9b12SSteven Rostedt 	hhd = &hash->buckets[key];
117133dc9b12SSteven Rostedt 	hlist_add_head(&entry->hlist, hhd);
117233dc9b12SSteven Rostedt 	hash->count++;
117333dc9b12SSteven Rostedt }
117433dc9b12SSteven Rostedt 
1175b448c4e3SSteven Rostedt static int add_hash_entry(struct ftrace_hash *hash, unsigned long ip)
1176b448c4e3SSteven Rostedt {
1177b448c4e3SSteven Rostedt 	struct ftrace_func_entry *entry;
1178b448c4e3SSteven Rostedt 
1179b448c4e3SSteven Rostedt 	entry = kmalloc(sizeof(*entry), GFP_KERNEL);
1180b448c4e3SSteven Rostedt 	if (!entry)
1181b448c4e3SSteven Rostedt 		return -ENOMEM;
1182b448c4e3SSteven Rostedt 
1183b448c4e3SSteven Rostedt 	entry->ip = ip;
118433dc9b12SSteven Rostedt 	__add_hash_entry(hash, entry);
1185b448c4e3SSteven Rostedt 
1186b448c4e3SSteven Rostedt 	return 0;
1187b448c4e3SSteven Rostedt }
1188b448c4e3SSteven Rostedt 
1189b448c4e3SSteven Rostedt static void
119033dc9b12SSteven Rostedt free_hash_entry(struct ftrace_hash *hash,
119133dc9b12SSteven Rostedt 		  struct ftrace_func_entry *entry)
119233dc9b12SSteven Rostedt {
119333dc9b12SSteven Rostedt 	hlist_del(&entry->hlist);
119433dc9b12SSteven Rostedt 	kfree(entry);
119533dc9b12SSteven Rostedt 	hash->count--;
119633dc9b12SSteven Rostedt }
119733dc9b12SSteven Rostedt 
119833dc9b12SSteven Rostedt static void
1199b448c4e3SSteven Rostedt remove_hash_entry(struct ftrace_hash *hash,
1200b448c4e3SSteven Rostedt 		  struct ftrace_func_entry *entry)
1201b448c4e3SSteven Rostedt {
1202b448c4e3SSteven Rostedt 	hlist_del(&entry->hlist);
1203b448c4e3SSteven Rostedt 	hash->count--;
1204b448c4e3SSteven Rostedt }
1205b448c4e3SSteven Rostedt 
1206b448c4e3SSteven Rostedt static void ftrace_hash_clear(struct ftrace_hash *hash)
1207b448c4e3SSteven Rostedt {
1208b448c4e3SSteven Rostedt 	struct hlist_head *hhd;
1209b67bfe0dSSasha Levin 	struct hlist_node *tn;
1210b448c4e3SSteven Rostedt 	struct ftrace_func_entry *entry;
1211b448c4e3SSteven Rostedt 	int size = 1 << hash->size_bits;
1212b448c4e3SSteven Rostedt 	int i;
1213b448c4e3SSteven Rostedt 
121433dc9b12SSteven Rostedt 	if (!hash->count)
121533dc9b12SSteven Rostedt 		return;
121633dc9b12SSteven Rostedt 
1217b448c4e3SSteven Rostedt 	for (i = 0; i < size; i++) {
1218b448c4e3SSteven Rostedt 		hhd = &hash->buckets[i];
1219b67bfe0dSSasha Levin 		hlist_for_each_entry_safe(entry, tn, hhd, hlist)
122033dc9b12SSteven Rostedt 			free_hash_entry(hash, entry);
1221b448c4e3SSteven Rostedt 	}
1222b448c4e3SSteven Rostedt 	FTRACE_WARN_ON(hash->count);
1223b448c4e3SSteven Rostedt }
1224b448c4e3SSteven Rostedt 
122533dc9b12SSteven Rostedt static void free_ftrace_hash(struct ftrace_hash *hash)
122633dc9b12SSteven Rostedt {
122733dc9b12SSteven Rostedt 	if (!hash || hash == EMPTY_HASH)
122833dc9b12SSteven Rostedt 		return;
122933dc9b12SSteven Rostedt 	ftrace_hash_clear(hash);
123033dc9b12SSteven Rostedt 	kfree(hash->buckets);
123133dc9b12SSteven Rostedt 	kfree(hash);
123233dc9b12SSteven Rostedt }
123333dc9b12SSteven Rostedt 
123407fd5515SSteven Rostedt static void __free_ftrace_hash_rcu(struct rcu_head *rcu)
123507fd5515SSteven Rostedt {
123607fd5515SSteven Rostedt 	struct ftrace_hash *hash;
123707fd5515SSteven Rostedt 
123807fd5515SSteven Rostedt 	hash = container_of(rcu, struct ftrace_hash, rcu);
123907fd5515SSteven Rostedt 	free_ftrace_hash(hash);
124007fd5515SSteven Rostedt }
124107fd5515SSteven Rostedt 
124207fd5515SSteven Rostedt static void free_ftrace_hash_rcu(struct ftrace_hash *hash)
124307fd5515SSteven Rostedt {
124407fd5515SSteven Rostedt 	if (!hash || hash == EMPTY_HASH)
124507fd5515SSteven Rostedt 		return;
124607fd5515SSteven Rostedt 	call_rcu_sched(&hash->rcu, __free_ftrace_hash_rcu);
124707fd5515SSteven Rostedt }
124807fd5515SSteven Rostedt 
12495500fa51SJiri Olsa void ftrace_free_filter(struct ftrace_ops *ops)
12505500fa51SJiri Olsa {
1251f04f24fbSMasami Hiramatsu 	ftrace_ops_init(ops);
125233b7f99cSSteven Rostedt (Red Hat) 	free_ftrace_hash(ops->func_hash->filter_hash);
125333b7f99cSSteven Rostedt (Red Hat) 	free_ftrace_hash(ops->func_hash->notrace_hash);
12545500fa51SJiri Olsa }
12555500fa51SJiri Olsa 
125633dc9b12SSteven Rostedt static struct ftrace_hash *alloc_ftrace_hash(int size_bits)
125733dc9b12SSteven Rostedt {
125833dc9b12SSteven Rostedt 	struct ftrace_hash *hash;
125933dc9b12SSteven Rostedt 	int size;
126033dc9b12SSteven Rostedt 
126133dc9b12SSteven Rostedt 	hash = kzalloc(sizeof(*hash), GFP_KERNEL);
126233dc9b12SSteven Rostedt 	if (!hash)
126333dc9b12SSteven Rostedt 		return NULL;
126433dc9b12SSteven Rostedt 
126533dc9b12SSteven Rostedt 	size = 1 << size_bits;
126647b0edcbSThomas Meyer 	hash->buckets = kcalloc(size, sizeof(*hash->buckets), GFP_KERNEL);
126733dc9b12SSteven Rostedt 
126833dc9b12SSteven Rostedt 	if (!hash->buckets) {
126933dc9b12SSteven Rostedt 		kfree(hash);
127033dc9b12SSteven Rostedt 		return NULL;
127133dc9b12SSteven Rostedt 	}
127233dc9b12SSteven Rostedt 
127333dc9b12SSteven Rostedt 	hash->size_bits = size_bits;
127433dc9b12SSteven Rostedt 
127533dc9b12SSteven Rostedt 	return hash;
127633dc9b12SSteven Rostedt }
127733dc9b12SSteven Rostedt 
127833dc9b12SSteven Rostedt static struct ftrace_hash *
127933dc9b12SSteven Rostedt alloc_and_copy_ftrace_hash(int size_bits, struct ftrace_hash *hash)
128033dc9b12SSteven Rostedt {
128133dc9b12SSteven Rostedt 	struct ftrace_func_entry *entry;
128233dc9b12SSteven Rostedt 	struct ftrace_hash *new_hash;
128333dc9b12SSteven Rostedt 	int size;
128433dc9b12SSteven Rostedt 	int ret;
128533dc9b12SSteven Rostedt 	int i;
128633dc9b12SSteven Rostedt 
128733dc9b12SSteven Rostedt 	new_hash = alloc_ftrace_hash(size_bits);
128833dc9b12SSteven Rostedt 	if (!new_hash)
128933dc9b12SSteven Rostedt 		return NULL;
129033dc9b12SSteven Rostedt 
129133dc9b12SSteven Rostedt 	/* Empty hash? */
129206a51d93SSteven Rostedt 	if (ftrace_hash_empty(hash))
129333dc9b12SSteven Rostedt 		return new_hash;
129433dc9b12SSteven Rostedt 
129533dc9b12SSteven Rostedt 	size = 1 << hash->size_bits;
129633dc9b12SSteven Rostedt 	for (i = 0; i < size; i++) {
1297b67bfe0dSSasha Levin 		hlist_for_each_entry(entry, &hash->buckets[i], hlist) {
129833dc9b12SSteven Rostedt 			ret = add_hash_entry(new_hash, entry->ip);
129933dc9b12SSteven Rostedt 			if (ret < 0)
130033dc9b12SSteven Rostedt 				goto free_hash;
130133dc9b12SSteven Rostedt 		}
130233dc9b12SSteven Rostedt 	}
130333dc9b12SSteven Rostedt 
130433dc9b12SSteven Rostedt 	FTRACE_WARN_ON(new_hash->count != hash->count);
130533dc9b12SSteven Rostedt 
130633dc9b12SSteven Rostedt 	return new_hash;
130733dc9b12SSteven Rostedt 
130833dc9b12SSteven Rostedt  free_hash:
130933dc9b12SSteven Rostedt 	free_ftrace_hash(new_hash);
131033dc9b12SSteven Rostedt 	return NULL;
131133dc9b12SSteven Rostedt }
131233dc9b12SSteven Rostedt 
131341fb61c2SSteven Rostedt static void
131484261912SSteven Rostedt (Red Hat) ftrace_hash_rec_disable_modify(struct ftrace_ops *ops, int filter_hash);
131541fb61c2SSteven Rostedt static void
131684261912SSteven Rostedt (Red Hat) ftrace_hash_rec_enable_modify(struct ftrace_ops *ops, int filter_hash);
131741fb61c2SSteven Rostedt 
131833dc9b12SSteven Rostedt static int
131941fb61c2SSteven Rostedt ftrace_hash_move(struct ftrace_ops *ops, int enable,
132041fb61c2SSteven Rostedt 		 struct ftrace_hash **dst, struct ftrace_hash *src)
132133dc9b12SSteven Rostedt {
132233dc9b12SSteven Rostedt 	struct ftrace_func_entry *entry;
1323b67bfe0dSSasha Levin 	struct hlist_node *tn;
132433dc9b12SSteven Rostedt 	struct hlist_head *hhd;
132507fd5515SSteven Rostedt 	struct ftrace_hash *new_hash;
132633dc9b12SSteven Rostedt 	int size = src->count;
132733dc9b12SSteven Rostedt 	int bits = 0;
132833dc9b12SSteven Rostedt 	int i;
132933dc9b12SSteven Rostedt 
133033dc9b12SSteven Rostedt 	/*
133133dc9b12SSteven Rostedt 	 * If the new source is empty, just free dst and assign it
133233dc9b12SSteven Rostedt 	 * the empty_hash.
133333dc9b12SSteven Rostedt 	 */
133433dc9b12SSteven Rostedt 	if (!src->count) {
13355c27c775SMasami Hiramatsu 		new_hash = EMPTY_HASH;
13365c27c775SMasami Hiramatsu 		goto update;
133733dc9b12SSteven Rostedt 	}
133833dc9b12SSteven Rostedt 
133933dc9b12SSteven Rostedt 	/*
134033dc9b12SSteven Rostedt 	 * Make the hash size about 1/2 the # found
134133dc9b12SSteven Rostedt 	 */
134233dc9b12SSteven Rostedt 	for (size /= 2; size; size >>= 1)
134333dc9b12SSteven Rostedt 		bits++;
134433dc9b12SSteven Rostedt 
134533dc9b12SSteven Rostedt 	/* Don't allocate too much */
134633dc9b12SSteven Rostedt 	if (bits > FTRACE_HASH_MAX_BITS)
134733dc9b12SSteven Rostedt 		bits = FTRACE_HASH_MAX_BITS;
134833dc9b12SSteven Rostedt 
134907fd5515SSteven Rostedt 	new_hash = alloc_ftrace_hash(bits);
135007fd5515SSteven Rostedt 	if (!new_hash)
13515c27c775SMasami Hiramatsu 		return -ENOMEM;
135233dc9b12SSteven Rostedt 
135333dc9b12SSteven Rostedt 	size = 1 << src->size_bits;
135433dc9b12SSteven Rostedt 	for (i = 0; i < size; i++) {
135533dc9b12SSteven Rostedt 		hhd = &src->buckets[i];
1356b67bfe0dSSasha Levin 		hlist_for_each_entry_safe(entry, tn, hhd, hlist) {
135733dc9b12SSteven Rostedt 			remove_hash_entry(src, entry);
135807fd5515SSteven Rostedt 			__add_hash_entry(new_hash, entry);
135933dc9b12SSteven Rostedt 		}
136033dc9b12SSteven Rostedt 	}
136133dc9b12SSteven Rostedt 
13625c27c775SMasami Hiramatsu update:
13635c27c775SMasami Hiramatsu 	/*
13645c27c775SMasami Hiramatsu 	 * Remove the current set, update the hash and add
13655c27c775SMasami Hiramatsu 	 * them back.
13665c27c775SMasami Hiramatsu 	 */
136784261912SSteven Rostedt (Red Hat) 	ftrace_hash_rec_disable_modify(ops, enable);
13685c27c775SMasami Hiramatsu 
136907fd5515SSteven Rostedt 	rcu_assign_pointer(*dst, new_hash);
137007fd5515SSteven Rostedt 
137184261912SSteven Rostedt (Red Hat) 	ftrace_hash_rec_enable_modify(ops, enable);
137241fb61c2SSteven Rostedt 
13735c27c775SMasami Hiramatsu 	return 0;
137433dc9b12SSteven Rostedt }
137533dc9b12SSteven Rostedt 
1376265c831cSSteven Rostedt /*
1377b848914cSSteven Rostedt  * Test the hashes for this ops to see if we want to call
1378b848914cSSteven Rostedt  * the ops->func or not.
1379b848914cSSteven Rostedt  *
1380b848914cSSteven Rostedt  * It's a match if the ip is in the ops->filter_hash or
1381b848914cSSteven Rostedt  * the filter_hash does not exist or is empty,
1382b848914cSSteven Rostedt  *  AND
1383b848914cSSteven Rostedt  * the ip is not in the ops->notrace_hash.
1384cdbe61bfSSteven Rostedt  *
1385cdbe61bfSSteven Rostedt  * This needs to be called with preemption disabled as
1386cdbe61bfSSteven Rostedt  * the hashes are freed with call_rcu_sched().
1387b848914cSSteven Rostedt  */
1388b848914cSSteven Rostedt static int
1389195a8afcSSteven Rostedt (Red Hat) ftrace_ops_test(struct ftrace_ops *ops, unsigned long ip, void *regs)
1390b848914cSSteven Rostedt {
1391b848914cSSteven Rostedt 	struct ftrace_hash *filter_hash;
1392b848914cSSteven Rostedt 	struct ftrace_hash *notrace_hash;
1393b848914cSSteven Rostedt 	int ret;
1394b848914cSSteven Rostedt 
1395195a8afcSSteven Rostedt (Red Hat) #ifdef CONFIG_DYNAMIC_FTRACE_WITH_REGS
1396195a8afcSSteven Rostedt (Red Hat) 	/*
1397195a8afcSSteven Rostedt (Red Hat) 	 * There's a small race when adding ops that the ftrace handler
1398195a8afcSSteven Rostedt (Red Hat) 	 * that wants regs, may be called without them. We can not
1399195a8afcSSteven Rostedt (Red Hat) 	 * allow that handler to be called if regs is NULL.
1400195a8afcSSteven Rostedt (Red Hat) 	 */
1401195a8afcSSteven Rostedt (Red Hat) 	if (regs == NULL && (ops->flags & FTRACE_OPS_FL_SAVE_REGS))
1402195a8afcSSteven Rostedt (Red Hat) 		return 0;
1403195a8afcSSteven Rostedt (Red Hat) #endif
1404195a8afcSSteven Rostedt (Red Hat) 
140533b7f99cSSteven Rostedt (Red Hat) 	filter_hash = rcu_dereference_raw_notrace(ops->func_hash->filter_hash);
140633b7f99cSSteven Rostedt (Red Hat) 	notrace_hash = rcu_dereference_raw_notrace(ops->func_hash->notrace_hash);
1407b848914cSSteven Rostedt 
140806a51d93SSteven Rostedt 	if ((ftrace_hash_empty(filter_hash) ||
1409b848914cSSteven Rostedt 	     ftrace_lookup_ip(filter_hash, ip)) &&
141006a51d93SSteven Rostedt 	    (ftrace_hash_empty(notrace_hash) ||
1411b848914cSSteven Rostedt 	     !ftrace_lookup_ip(notrace_hash, ip)))
1412b848914cSSteven Rostedt 		ret = 1;
1413b848914cSSteven Rostedt 	else
1414b848914cSSteven Rostedt 		ret = 0;
1415b848914cSSteven Rostedt 
1416b848914cSSteven Rostedt 	return ret;
1417b848914cSSteven Rostedt }
1418b848914cSSteven Rostedt 
1419b848914cSSteven Rostedt /*
1420265c831cSSteven Rostedt  * This is a double for. Do not use 'break' to break out of the loop,
1421265c831cSSteven Rostedt  * you must use a goto.
1422265c831cSSteven Rostedt  */
1423265c831cSSteven Rostedt #define do_for_each_ftrace_rec(pg, rec)					\
1424265c831cSSteven Rostedt 	for (pg = ftrace_pages_start; pg; pg = pg->next) {		\
1425265c831cSSteven Rostedt 		int _____i;						\
1426265c831cSSteven Rostedt 		for (_____i = 0; _____i < pg->index; _____i++) {	\
1427265c831cSSteven Rostedt 			rec = &pg->records[_____i];
1428265c831cSSteven Rostedt 
1429265c831cSSteven Rostedt #define while_for_each_ftrace_rec()		\
1430265c831cSSteven Rostedt 		}				\
1431265c831cSSteven Rostedt 	}
1432ecea656dSAbhishek Sagar 
14335855feadSSteven Rostedt 
14345855feadSSteven Rostedt static int ftrace_cmp_recs(const void *a, const void *b)
14355855feadSSteven Rostedt {
1436a650e02aSSteven Rostedt 	const struct dyn_ftrace *key = a;
1437a650e02aSSteven Rostedt 	const struct dyn_ftrace *rec = b;
14385855feadSSteven Rostedt 
1439a650e02aSSteven Rostedt 	if (key->flags < rec->ip)
14405855feadSSteven Rostedt 		return -1;
1441a650e02aSSteven Rostedt 	if (key->ip >= rec->ip + MCOUNT_INSN_SIZE)
1442a650e02aSSteven Rostedt 		return 1;
1443a650e02aSSteven Rostedt 	return 0;
1444a650e02aSSteven Rostedt }
1445a650e02aSSteven Rostedt 
1446f0cf973aSSteven Rostedt static unsigned long ftrace_location_range(unsigned long start, unsigned long end)
1447a650e02aSSteven Rostedt {
1448a650e02aSSteven Rostedt 	struct ftrace_page *pg;
1449a650e02aSSteven Rostedt 	struct dyn_ftrace *rec;
1450a650e02aSSteven Rostedt 	struct dyn_ftrace key;
1451a650e02aSSteven Rostedt 
1452a650e02aSSteven Rostedt 	key.ip = start;
1453a650e02aSSteven Rostedt 	key.flags = end;	/* overload flags, as it is unsigned long */
1454a650e02aSSteven Rostedt 
1455a650e02aSSteven Rostedt 	for (pg = ftrace_pages_start; pg; pg = pg->next) {
1456a650e02aSSteven Rostedt 		if (end < pg->records[0].ip ||
1457a650e02aSSteven Rostedt 		    start >= (pg->records[pg->index - 1].ip + MCOUNT_INSN_SIZE))
1458a650e02aSSteven Rostedt 			continue;
1459a650e02aSSteven Rostedt 		rec = bsearch(&key, pg->records, pg->index,
1460a650e02aSSteven Rostedt 			      sizeof(struct dyn_ftrace),
1461a650e02aSSteven Rostedt 			      ftrace_cmp_recs);
1462a650e02aSSteven Rostedt 		if (rec)
1463f0cf973aSSteven Rostedt 			return rec->ip;
1464a650e02aSSteven Rostedt 	}
1465a650e02aSSteven Rostedt 
14665855feadSSteven Rostedt 	return 0;
14675855feadSSteven Rostedt }
14685855feadSSteven Rostedt 
1469c88fd863SSteven Rostedt /**
1470c88fd863SSteven Rostedt  * ftrace_location - return true if the ip giving is a traced location
1471c88fd863SSteven Rostedt  * @ip: the instruction pointer to check
1472c88fd863SSteven Rostedt  *
1473f0cf973aSSteven Rostedt  * Returns rec->ip if @ip given is a pointer to a ftrace location.
1474c88fd863SSteven Rostedt  * That is, the instruction that is either a NOP or call to
1475c88fd863SSteven Rostedt  * the function tracer. It checks the ftrace internal tables to
1476c88fd863SSteven Rostedt  * determine if the address belongs or not.
1477c88fd863SSteven Rostedt  */
1478f0cf973aSSteven Rostedt unsigned long ftrace_location(unsigned long ip)
1479c88fd863SSteven Rostedt {
1480a650e02aSSteven Rostedt 	return ftrace_location_range(ip, ip);
14815855feadSSteven Rostedt }
1482c88fd863SSteven Rostedt 
1483a650e02aSSteven Rostedt /**
1484a650e02aSSteven Rostedt  * ftrace_text_reserved - return true if range contains an ftrace location
1485a650e02aSSteven Rostedt  * @start: start of range to search
1486a650e02aSSteven Rostedt  * @end: end of range to search (inclusive). @end points to the last byte to check.
1487a650e02aSSteven Rostedt  *
1488a650e02aSSteven Rostedt  * Returns 1 if @start and @end contains a ftrace location.
1489a650e02aSSteven Rostedt  * That is, the instruction that is either a NOP or call to
1490a650e02aSSteven Rostedt  * the function tracer. It checks the ftrace internal tables to
1491a650e02aSSteven Rostedt  * determine if the address belongs or not.
1492a650e02aSSteven Rostedt  */
1493d88471cbSSasha Levin int ftrace_text_reserved(const void *start, const void *end)
1494a650e02aSSteven Rostedt {
1495f0cf973aSSteven Rostedt 	unsigned long ret;
1496f0cf973aSSteven Rostedt 
1497f0cf973aSSteven Rostedt 	ret = ftrace_location_range((unsigned long)start,
1498a650e02aSSteven Rostedt 				    (unsigned long)end);
1499f0cf973aSSteven Rostedt 
1500f0cf973aSSteven Rostedt 	return (int)!!ret;
1501c88fd863SSteven Rostedt }
1502c88fd863SSteven Rostedt 
15034fbb48cbSSteven Rostedt (Red Hat) /* Test if ops registered to this rec needs regs */
15044fbb48cbSSteven Rostedt (Red Hat) static bool test_rec_ops_needs_regs(struct dyn_ftrace *rec)
15054fbb48cbSSteven Rostedt (Red Hat) {
15064fbb48cbSSteven Rostedt (Red Hat) 	struct ftrace_ops *ops;
15074fbb48cbSSteven Rostedt (Red Hat) 	bool keep_regs = false;
15084fbb48cbSSteven Rostedt (Red Hat) 
15094fbb48cbSSteven Rostedt (Red Hat) 	for (ops = ftrace_ops_list;
15104fbb48cbSSteven Rostedt (Red Hat) 	     ops != &ftrace_list_end; ops = ops->next) {
15114fbb48cbSSteven Rostedt (Red Hat) 		/* pass rec in as regs to have non-NULL val */
15124fbb48cbSSteven Rostedt (Red Hat) 		if (ftrace_ops_test(ops, rec->ip, rec)) {
15134fbb48cbSSteven Rostedt (Red Hat) 			if (ops->flags & FTRACE_OPS_FL_SAVE_REGS) {
15144fbb48cbSSteven Rostedt (Red Hat) 				keep_regs = true;
15154fbb48cbSSteven Rostedt (Red Hat) 				break;
15164fbb48cbSSteven Rostedt (Red Hat) 			}
15174fbb48cbSSteven Rostedt (Red Hat) 		}
15184fbb48cbSSteven Rostedt (Red Hat) 	}
15194fbb48cbSSteven Rostedt (Red Hat) 
15204fbb48cbSSteven Rostedt (Red Hat) 	return  keep_regs;
15214fbb48cbSSteven Rostedt (Red Hat) }
15224fbb48cbSSteven Rostedt (Red Hat) 
152379922b80SSteven Rostedt (Red Hat) static void ftrace_remove_tramp(struct ftrace_ops *ops,
152479922b80SSteven Rostedt (Red Hat) 				struct dyn_ftrace *rec)
152579922b80SSteven Rostedt (Red Hat) {
1526bce0b6c5SSteven Rostedt (Red Hat) 	/* If TRAMP is not set, no ops should have a trampoline for this */
1527bce0b6c5SSteven Rostedt (Red Hat) 	if (!(rec->flags & FTRACE_FL_TRAMP))
152879922b80SSteven Rostedt (Red Hat) 		return;
152979922b80SSteven Rostedt (Red Hat) 
1530bce0b6c5SSteven Rostedt (Red Hat) 	rec->flags &= ~FTRACE_FL_TRAMP;
1531bce0b6c5SSteven Rostedt (Red Hat) 
1532bce0b6c5SSteven Rostedt (Red Hat) 	if ((!ftrace_hash_empty(ops->func_hash->filter_hash) &&
1533bce0b6c5SSteven Rostedt (Red Hat) 	     !ftrace_lookup_ip(ops->func_hash->filter_hash, rec->ip)) ||
1534bce0b6c5SSteven Rostedt (Red Hat) 	    ftrace_lookup_ip(ops->func_hash->notrace_hash, rec->ip))
1535bce0b6c5SSteven Rostedt (Red Hat) 		return;
153679922b80SSteven Rostedt (Red Hat) 	/*
153779922b80SSteven Rostedt (Red Hat) 	 * The tramp_hash entry will be removed at time
153879922b80SSteven Rostedt (Red Hat) 	 * of update.
153979922b80SSteven Rostedt (Red Hat) 	 */
15400162d621SSteven Rostedt (Red Hat) 	ops->nr_trampolines--;
154179922b80SSteven Rostedt (Red Hat) }
154279922b80SSteven Rostedt (Red Hat) 
1543bce0b6c5SSteven Rostedt (Red Hat) static void ftrace_clear_tramps(struct dyn_ftrace *rec, struct ftrace_ops *ops)
154479922b80SSteven Rostedt (Red Hat) {
154579922b80SSteven Rostedt (Red Hat) 	struct ftrace_ops *op;
154679922b80SSteven Rostedt (Red Hat) 
1547bce0b6c5SSteven Rostedt (Red Hat) 	/* If TRAMP is not set, no ops should have a trampoline for this */
1548bce0b6c5SSteven Rostedt (Red Hat) 	if (!(rec->flags & FTRACE_FL_TRAMP))
1549bce0b6c5SSteven Rostedt (Red Hat) 		return;
1550bce0b6c5SSteven Rostedt (Red Hat) 
155179922b80SSteven Rostedt (Red Hat) 	do_for_each_ftrace_op(op, ftrace_ops_list) {
1552bce0b6c5SSteven Rostedt (Red Hat) 		/*
1553bce0b6c5SSteven Rostedt (Red Hat) 		 * This function is called to clear other tramps
1554bce0b6c5SSteven Rostedt (Red Hat) 		 * not the one that is being updated.
1555bce0b6c5SSteven Rostedt (Red Hat) 		 */
1556bce0b6c5SSteven Rostedt (Red Hat) 		if (op == ops)
1557bce0b6c5SSteven Rostedt (Red Hat) 			continue;
15580162d621SSteven Rostedt (Red Hat) 		if (op->nr_trampolines)
155979922b80SSteven Rostedt (Red Hat) 			ftrace_remove_tramp(op, rec);
156079922b80SSteven Rostedt (Red Hat) 	} while_for_each_ftrace_op(op);
156179922b80SSteven Rostedt (Red Hat) }
156279922b80SSteven Rostedt (Red Hat) 
1563ed926f9bSSteven Rostedt static void __ftrace_hash_rec_update(struct ftrace_ops *ops,
1564ed926f9bSSteven Rostedt 				     int filter_hash,
1565ed926f9bSSteven Rostedt 				     bool inc)
1566ed926f9bSSteven Rostedt {
1567ed926f9bSSteven Rostedt 	struct ftrace_hash *hash;
1568ed926f9bSSteven Rostedt 	struct ftrace_hash *other_hash;
1569ed926f9bSSteven Rostedt 	struct ftrace_page *pg;
1570ed926f9bSSteven Rostedt 	struct dyn_ftrace *rec;
1571ed926f9bSSteven Rostedt 	int count = 0;
1572ed926f9bSSteven Rostedt 	int all = 0;
1573ed926f9bSSteven Rostedt 
1574ed926f9bSSteven Rostedt 	/* Only update if the ops has been registered */
1575ed926f9bSSteven Rostedt 	if (!(ops->flags & FTRACE_OPS_FL_ENABLED))
1576ed926f9bSSteven Rostedt 		return;
1577ed926f9bSSteven Rostedt 
1578ed926f9bSSteven Rostedt 	/*
1579ed926f9bSSteven Rostedt 	 * In the filter_hash case:
1580ed926f9bSSteven Rostedt 	 *   If the count is zero, we update all records.
1581ed926f9bSSteven Rostedt 	 *   Otherwise we just update the items in the hash.
1582ed926f9bSSteven Rostedt 	 *
1583ed926f9bSSteven Rostedt 	 * In the notrace_hash case:
1584ed926f9bSSteven Rostedt 	 *   We enable the update in the hash.
1585ed926f9bSSteven Rostedt 	 *   As disabling notrace means enabling the tracing,
1586ed926f9bSSteven Rostedt 	 *   and enabling notrace means disabling, the inc variable
1587ed926f9bSSteven Rostedt 	 *   gets inversed.
1588ed926f9bSSteven Rostedt 	 */
1589ed926f9bSSteven Rostedt 	if (filter_hash) {
159033b7f99cSSteven Rostedt (Red Hat) 		hash = ops->func_hash->filter_hash;
159133b7f99cSSteven Rostedt (Red Hat) 		other_hash = ops->func_hash->notrace_hash;
159206a51d93SSteven Rostedt 		if (ftrace_hash_empty(hash))
1593ed926f9bSSteven Rostedt 			all = 1;
1594ed926f9bSSteven Rostedt 	} else {
1595ed926f9bSSteven Rostedt 		inc = !inc;
159633b7f99cSSteven Rostedt (Red Hat) 		hash = ops->func_hash->notrace_hash;
159733b7f99cSSteven Rostedt (Red Hat) 		other_hash = ops->func_hash->filter_hash;
1598ed926f9bSSteven Rostedt 		/*
1599ed926f9bSSteven Rostedt 		 * If the notrace hash has no items,
1600ed926f9bSSteven Rostedt 		 * then there's nothing to do.
1601ed926f9bSSteven Rostedt 		 */
160206a51d93SSteven Rostedt 		if (ftrace_hash_empty(hash))
1603ed926f9bSSteven Rostedt 			return;
1604ed926f9bSSteven Rostedt 	}
1605ed926f9bSSteven Rostedt 
1606ed926f9bSSteven Rostedt 	do_for_each_ftrace_rec(pg, rec) {
1607ed926f9bSSteven Rostedt 		int in_other_hash = 0;
1608ed926f9bSSteven Rostedt 		int in_hash = 0;
1609ed926f9bSSteven Rostedt 		int match = 0;
1610ed926f9bSSteven Rostedt 
1611ed926f9bSSteven Rostedt 		if (all) {
1612ed926f9bSSteven Rostedt 			/*
1613ed926f9bSSteven Rostedt 			 * Only the filter_hash affects all records.
1614ed926f9bSSteven Rostedt 			 * Update if the record is not in the notrace hash.
1615ed926f9bSSteven Rostedt 			 */
1616b848914cSSteven Rostedt 			if (!other_hash || !ftrace_lookup_ip(other_hash, rec->ip))
1617ed926f9bSSteven Rostedt 				match = 1;
1618ed926f9bSSteven Rostedt 		} else {
161906a51d93SSteven Rostedt 			in_hash = !!ftrace_lookup_ip(hash, rec->ip);
162006a51d93SSteven Rostedt 			in_other_hash = !!ftrace_lookup_ip(other_hash, rec->ip);
1621ed926f9bSSteven Rostedt 
1622ed926f9bSSteven Rostedt 			/*
162319eab4a4SSteven Rostedt (Red Hat) 			 * If filter_hash is set, we want to match all functions
162419eab4a4SSteven Rostedt (Red Hat) 			 * that are in the hash but not in the other hash.
1625ed926f9bSSteven Rostedt 			 *
162619eab4a4SSteven Rostedt (Red Hat) 			 * If filter_hash is not set, then we are decrementing.
162719eab4a4SSteven Rostedt (Red Hat) 			 * That means we match anything that is in the hash
162819eab4a4SSteven Rostedt (Red Hat) 			 * and also in the other_hash. That is, we need to turn
162919eab4a4SSteven Rostedt (Red Hat) 			 * off functions in the other hash because they are disabled
163019eab4a4SSteven Rostedt (Red Hat) 			 * by this hash.
1631ed926f9bSSteven Rostedt 			 */
1632ed926f9bSSteven Rostedt 			if (filter_hash && in_hash && !in_other_hash)
1633ed926f9bSSteven Rostedt 				match = 1;
1634ed926f9bSSteven Rostedt 			else if (!filter_hash && in_hash &&
163506a51d93SSteven Rostedt 				 (in_other_hash || ftrace_hash_empty(other_hash)))
1636ed926f9bSSteven Rostedt 				match = 1;
1637ed926f9bSSteven Rostedt 		}
1638ed926f9bSSteven Rostedt 		if (!match)
1639ed926f9bSSteven Rostedt 			continue;
1640ed926f9bSSteven Rostedt 
1641ed926f9bSSteven Rostedt 		if (inc) {
1642ed926f9bSSteven Rostedt 			rec->flags++;
16430376bde1SSteven Rostedt (Red Hat) 			if (FTRACE_WARN_ON(ftrace_rec_count(rec) == FTRACE_REF_MAX))
1644ed926f9bSSteven Rostedt 				return;
164579922b80SSteven Rostedt (Red Hat) 
164679922b80SSteven Rostedt (Red Hat) 			/*
164779922b80SSteven Rostedt (Red Hat) 			 * If there's only a single callback registered to a
164879922b80SSteven Rostedt (Red Hat) 			 * function, and the ops has a trampoline registered
164979922b80SSteven Rostedt (Red Hat) 			 * for it, then we can call it directly.
165079922b80SSteven Rostedt (Red Hat) 			 */
165179922b80SSteven Rostedt (Red Hat) 			if (ftrace_rec_count(rec) == 1 && ops->trampoline) {
165279922b80SSteven Rostedt (Red Hat) 				rec->flags |= FTRACE_FL_TRAMP;
16530162d621SSteven Rostedt (Red Hat) 				ops->nr_trampolines++;
165479922b80SSteven Rostedt (Red Hat) 			} else {
165579922b80SSteven Rostedt (Red Hat) 				/*
165679922b80SSteven Rostedt (Red Hat) 				 * If we are adding another function callback
165779922b80SSteven Rostedt (Red Hat) 				 * to this function, and the previous had a
1658bce0b6c5SSteven Rostedt (Red Hat) 				 * custom trampoline in use, then we need to go
1659bce0b6c5SSteven Rostedt (Red Hat) 				 * back to the default trampoline.
166079922b80SSteven Rostedt (Red Hat) 				 */
1661bce0b6c5SSteven Rostedt (Red Hat) 				ftrace_clear_tramps(rec, ops);
166279922b80SSteven Rostedt (Red Hat) 			}
166379922b80SSteven Rostedt (Red Hat) 
166408f6fba5SSteven Rostedt 			/*
166508f6fba5SSteven Rostedt 			 * If any ops wants regs saved for this function
166608f6fba5SSteven Rostedt 			 * then all ops will get saved regs.
166708f6fba5SSteven Rostedt 			 */
166808f6fba5SSteven Rostedt 			if (ops->flags & FTRACE_OPS_FL_SAVE_REGS)
166908f6fba5SSteven Rostedt 				rec->flags |= FTRACE_FL_REGS;
1670ed926f9bSSteven Rostedt 		} else {
16710376bde1SSteven Rostedt (Red Hat) 			if (FTRACE_WARN_ON(ftrace_rec_count(rec) == 0))
1672ed926f9bSSteven Rostedt 				return;
1673ed926f9bSSteven Rostedt 			rec->flags--;
167479922b80SSteven Rostedt (Red Hat) 
167579922b80SSteven Rostedt (Red Hat) 			if (ops->trampoline && !ftrace_rec_count(rec))
167679922b80SSteven Rostedt (Red Hat) 				ftrace_remove_tramp(ops, rec);
167779922b80SSteven Rostedt (Red Hat) 
16784fbb48cbSSteven Rostedt (Red Hat) 			/*
16794fbb48cbSSteven Rostedt (Red Hat) 			 * If the rec had REGS enabled and the ops that is
16804fbb48cbSSteven Rostedt (Red Hat) 			 * being removed had REGS set, then see if there is
16814fbb48cbSSteven Rostedt (Red Hat) 			 * still any ops for this record that wants regs.
16824fbb48cbSSteven Rostedt (Red Hat) 			 * If not, we can stop recording them.
16834fbb48cbSSteven Rostedt (Red Hat) 			 */
16840376bde1SSteven Rostedt (Red Hat) 			if (ftrace_rec_count(rec) > 0 &&
16854fbb48cbSSteven Rostedt (Red Hat) 			    rec->flags & FTRACE_FL_REGS &&
16864fbb48cbSSteven Rostedt (Red Hat) 			    ops->flags & FTRACE_OPS_FL_SAVE_REGS) {
16874fbb48cbSSteven Rostedt (Red Hat) 				if (!test_rec_ops_needs_regs(rec))
16884fbb48cbSSteven Rostedt (Red Hat) 					rec->flags &= ~FTRACE_FL_REGS;
16894fbb48cbSSteven Rostedt (Red Hat) 			}
169079922b80SSteven Rostedt (Red Hat) 
169179922b80SSteven Rostedt (Red Hat) 			/*
169279922b80SSteven Rostedt (Red Hat) 			 * flags will be cleared in ftrace_check_record()
169379922b80SSteven Rostedt (Red Hat) 			 * if rec count is zero.
169479922b80SSteven Rostedt (Red Hat) 			 */
1695ed926f9bSSteven Rostedt 		}
1696ed926f9bSSteven Rostedt 		count++;
1697ed926f9bSSteven Rostedt 		/* Shortcut, if we handled all records, we are done. */
1698ed926f9bSSteven Rostedt 		if (!all && count == hash->count)
1699ed926f9bSSteven Rostedt 			return;
1700ed926f9bSSteven Rostedt 	} while_for_each_ftrace_rec();
1701ed926f9bSSteven Rostedt }
1702ed926f9bSSteven Rostedt 
1703ed926f9bSSteven Rostedt static void ftrace_hash_rec_disable(struct ftrace_ops *ops,
1704ed926f9bSSteven Rostedt 				    int filter_hash)
1705ed926f9bSSteven Rostedt {
1706ed926f9bSSteven Rostedt 	__ftrace_hash_rec_update(ops, filter_hash, 0);
1707ed926f9bSSteven Rostedt }
1708ed926f9bSSteven Rostedt 
1709ed926f9bSSteven Rostedt static void ftrace_hash_rec_enable(struct ftrace_ops *ops,
1710ed926f9bSSteven Rostedt 				   int filter_hash)
1711ed926f9bSSteven Rostedt {
1712ed926f9bSSteven Rostedt 	__ftrace_hash_rec_update(ops, filter_hash, 1);
1713ed926f9bSSteven Rostedt }
1714ed926f9bSSteven Rostedt 
171584261912SSteven Rostedt (Red Hat) static void ftrace_hash_rec_update_modify(struct ftrace_ops *ops,
171684261912SSteven Rostedt (Red Hat) 					  int filter_hash, int inc)
171784261912SSteven Rostedt (Red Hat) {
171884261912SSteven Rostedt (Red Hat) 	struct ftrace_ops *op;
171984261912SSteven Rostedt (Red Hat) 
172084261912SSteven Rostedt (Red Hat) 	__ftrace_hash_rec_update(ops, filter_hash, inc);
172184261912SSteven Rostedt (Red Hat) 
172284261912SSteven Rostedt (Red Hat) 	if (ops->func_hash != &global_ops.local_hash)
172384261912SSteven Rostedt (Red Hat) 		return;
172484261912SSteven Rostedt (Red Hat) 
172584261912SSteven Rostedt (Red Hat) 	/*
172684261912SSteven Rostedt (Red Hat) 	 * If the ops shares the global_ops hash, then we need to update
172784261912SSteven Rostedt (Red Hat) 	 * all ops that are enabled and use this hash.
172884261912SSteven Rostedt (Red Hat) 	 */
172984261912SSteven Rostedt (Red Hat) 	do_for_each_ftrace_op(op, ftrace_ops_list) {
173084261912SSteven Rostedt (Red Hat) 		/* Already done */
173184261912SSteven Rostedt (Red Hat) 		if (op == ops)
173284261912SSteven Rostedt (Red Hat) 			continue;
173384261912SSteven Rostedt (Red Hat) 		if (op->func_hash == &global_ops.local_hash)
173484261912SSteven Rostedt (Red Hat) 			__ftrace_hash_rec_update(op, filter_hash, inc);
173584261912SSteven Rostedt (Red Hat) 	} while_for_each_ftrace_op(op);
173684261912SSteven Rostedt (Red Hat) }
173784261912SSteven Rostedt (Red Hat) 
173884261912SSteven Rostedt (Red Hat) static void ftrace_hash_rec_disable_modify(struct ftrace_ops *ops,
173984261912SSteven Rostedt (Red Hat) 					   int filter_hash)
174084261912SSteven Rostedt (Red Hat) {
174184261912SSteven Rostedt (Red Hat) 	ftrace_hash_rec_update_modify(ops, filter_hash, 0);
174284261912SSteven Rostedt (Red Hat) }
174384261912SSteven Rostedt (Red Hat) 
174484261912SSteven Rostedt (Red Hat) static void ftrace_hash_rec_enable_modify(struct ftrace_ops *ops,
174584261912SSteven Rostedt (Red Hat) 					  int filter_hash)
174684261912SSteven Rostedt (Red Hat) {
174784261912SSteven Rostedt (Red Hat) 	ftrace_hash_rec_update_modify(ops, filter_hash, 1);
174884261912SSteven Rostedt (Red Hat) }
174984261912SSteven Rostedt (Red Hat) 
175005736a42SSteven Rostedt static void print_ip_ins(const char *fmt, unsigned char *p)
175105736a42SSteven Rostedt {
175205736a42SSteven Rostedt 	int i;
175305736a42SSteven Rostedt 
175405736a42SSteven Rostedt 	printk(KERN_CONT "%s", fmt);
175505736a42SSteven Rostedt 
175605736a42SSteven Rostedt 	for (i = 0; i < MCOUNT_INSN_SIZE; i++)
175705736a42SSteven Rostedt 		printk(KERN_CONT "%s%02x", i ? ":" : "", p[i]);
175805736a42SSteven Rostedt }
175905736a42SSteven Rostedt 
1760c88fd863SSteven Rostedt /**
1761c88fd863SSteven Rostedt  * ftrace_bug - report and shutdown function tracer
1762c88fd863SSteven Rostedt  * @failed: The failed type (EFAULT, EINVAL, EPERM)
1763c88fd863SSteven Rostedt  * @ip: The address that failed
1764c88fd863SSteven Rostedt  *
1765c88fd863SSteven Rostedt  * The arch code that enables or disables the function tracing
1766c88fd863SSteven Rostedt  * can call ftrace_bug() when it has detected a problem in
1767c88fd863SSteven Rostedt  * modifying the code. @failed should be one of either:
1768c88fd863SSteven Rostedt  * EFAULT - if the problem happens on reading the @ip address
1769c88fd863SSteven Rostedt  * EINVAL - if what is read at @ip is not what was expected
1770c88fd863SSteven Rostedt  * EPERM - if the problem happens on writting to the @ip address
1771c88fd863SSteven Rostedt  */
1772c88fd863SSteven Rostedt void ftrace_bug(int failed, unsigned long ip)
17733c1720f0SSteven Rostedt {
1774b17e8a37SSteven Rostedt 	switch (failed) {
1775593eb8a2SSteven Rostedt 	case -EFAULT:
17766912896eSSteven Rostedt 		FTRACE_WARN_ON_ONCE(1);
177705736a42SSteven Rostedt 		pr_info("ftrace faulted on modifying ");
177805736a42SSteven Rostedt 		print_ip_sym(ip);
177905736a42SSteven Rostedt 		break;
1780593eb8a2SSteven Rostedt 	case -EINVAL:
17816912896eSSteven Rostedt 		FTRACE_WARN_ON_ONCE(1);
178205736a42SSteven Rostedt 		pr_info("ftrace failed to modify ");
178305736a42SSteven Rostedt 		print_ip_sym(ip);
178405736a42SSteven Rostedt 		print_ip_ins(" actual: ", (unsigned char *)ip);
178505736a42SSteven Rostedt 		printk(KERN_CONT "\n");
178605736a42SSteven Rostedt 		break;
1787593eb8a2SSteven Rostedt 	case -EPERM:
17886912896eSSteven Rostedt 		FTRACE_WARN_ON_ONCE(1);
1789593eb8a2SSteven Rostedt 		pr_info("ftrace faulted on writing ");
1790593eb8a2SSteven Rostedt 		print_ip_sym(ip);
1791593eb8a2SSteven Rostedt 		break;
1792593eb8a2SSteven Rostedt 	default:
17936912896eSSteven Rostedt 		FTRACE_WARN_ON_ONCE(1);
1794593eb8a2SSteven Rostedt 		pr_info("ftrace faulted on unknown error ");
1795593eb8a2SSteven Rostedt 		print_ip_sym(ip);
179605736a42SSteven Rostedt 	}
1797b17e8a37SSteven Rostedt }
179805736a42SSteven Rostedt 
1799c88fd863SSteven Rostedt static int ftrace_check_record(struct dyn_ftrace *rec, int enable, int update)
18003d083395SSteven Rostedt {
180164fbcd16SXiao Guangrong 	unsigned long flag = 0UL;
1802e7d3737eSFrederic Weisbecker 
18033d083395SSteven Rostedt 	/*
180430fb6aa7SJiri Olsa 	 * If we are updating calls:
18053d083395SSteven Rostedt 	 *
1806ed926f9bSSteven Rostedt 	 *   If the record has a ref count, then we need to enable it
1807ed926f9bSSteven Rostedt 	 *   because someone is using it.
18083d083395SSteven Rostedt 	 *
1809ed926f9bSSteven Rostedt 	 *   Otherwise we make sure its disabled.
1810ed926f9bSSteven Rostedt 	 *
181130fb6aa7SJiri Olsa 	 * If we are disabling calls, then disable all records that
1812ed926f9bSSteven Rostedt 	 * are enabled.
18133d083395SSteven Rostedt 	 */
18140376bde1SSteven Rostedt (Red Hat) 	if (enable && ftrace_rec_count(rec))
181564fbcd16SXiao Guangrong 		flag = FTRACE_FL_ENABLED;
18163d083395SSteven Rostedt 
181708f6fba5SSteven Rostedt 	/*
181879922b80SSteven Rostedt (Red Hat) 	 * If enabling and the REGS flag does not match the REGS_EN, or
181979922b80SSteven Rostedt (Red Hat) 	 * the TRAMP flag doesn't match the TRAMP_EN, then do not ignore
182079922b80SSteven Rostedt (Red Hat) 	 * this record. Set flags to fail the compare against ENABLED.
182108f6fba5SSteven Rostedt 	 */
182279922b80SSteven Rostedt (Red Hat) 	if (flag) {
182379922b80SSteven Rostedt (Red Hat) 		if (!(rec->flags & FTRACE_FL_REGS) !=
182479922b80SSteven Rostedt (Red Hat) 		    !(rec->flags & FTRACE_FL_REGS_EN))
182508f6fba5SSteven Rostedt 			flag |= FTRACE_FL_REGS;
182608f6fba5SSteven Rostedt 
182779922b80SSteven Rostedt (Red Hat) 		if (!(rec->flags & FTRACE_FL_TRAMP) !=
182879922b80SSteven Rostedt (Red Hat) 		    !(rec->flags & FTRACE_FL_TRAMP_EN))
182979922b80SSteven Rostedt (Red Hat) 			flag |= FTRACE_FL_TRAMP;
183079922b80SSteven Rostedt (Red Hat) 	}
183179922b80SSteven Rostedt (Red Hat) 
183264fbcd16SXiao Guangrong 	/* If the state of this record hasn't changed, then do nothing */
183364fbcd16SXiao Guangrong 	if ((rec->flags & FTRACE_FL_ENABLED) == flag)
1834c88fd863SSteven Rostedt 		return FTRACE_UPDATE_IGNORE;
183564fbcd16SXiao Guangrong 
183664fbcd16SXiao Guangrong 	if (flag) {
183708f6fba5SSteven Rostedt 		/* Save off if rec is being enabled (for return value) */
183808f6fba5SSteven Rostedt 		flag ^= rec->flags & FTRACE_FL_ENABLED;
183908f6fba5SSteven Rostedt 
184008f6fba5SSteven Rostedt 		if (update) {
184164fbcd16SXiao Guangrong 			rec->flags |= FTRACE_FL_ENABLED;
184208f6fba5SSteven Rostedt 			if (flag & FTRACE_FL_REGS) {
184308f6fba5SSteven Rostedt 				if (rec->flags & FTRACE_FL_REGS)
184408f6fba5SSteven Rostedt 					rec->flags |= FTRACE_FL_REGS_EN;
184508f6fba5SSteven Rostedt 				else
184608f6fba5SSteven Rostedt 					rec->flags &= ~FTRACE_FL_REGS_EN;
184708f6fba5SSteven Rostedt 			}
184879922b80SSteven Rostedt (Red Hat) 			if (flag & FTRACE_FL_TRAMP) {
184979922b80SSteven Rostedt (Red Hat) 				if (rec->flags & FTRACE_FL_TRAMP)
185079922b80SSteven Rostedt (Red Hat) 					rec->flags |= FTRACE_FL_TRAMP_EN;
185179922b80SSteven Rostedt (Red Hat) 				else
185279922b80SSteven Rostedt (Red Hat) 					rec->flags &= ~FTRACE_FL_TRAMP_EN;
185379922b80SSteven Rostedt (Red Hat) 			}
185464fbcd16SXiao Guangrong 		}
185564fbcd16SXiao Guangrong 
185608f6fba5SSteven Rostedt 		/*
185708f6fba5SSteven Rostedt 		 * If this record is being updated from a nop, then
185808f6fba5SSteven Rostedt 		 *   return UPDATE_MAKE_CALL.
185908f6fba5SSteven Rostedt 		 * Otherwise,
186008f6fba5SSteven Rostedt 		 *   return UPDATE_MODIFY_CALL to tell the caller to convert
1861f1b2f2bdSSteven Rostedt (Red Hat) 		 *   from the save regs, to a non-save regs function or
186279922b80SSteven Rostedt (Red Hat) 		 *   vice versa, or from a trampoline call.
186308f6fba5SSteven Rostedt 		 */
186408f6fba5SSteven Rostedt 		if (flag & FTRACE_FL_ENABLED)
186508f6fba5SSteven Rostedt 			return FTRACE_UPDATE_MAKE_CALL;
1866f1b2f2bdSSteven Rostedt (Red Hat) 
186708f6fba5SSteven Rostedt 		return FTRACE_UPDATE_MODIFY_CALL;
186808f6fba5SSteven Rostedt 	}
186908f6fba5SSteven Rostedt 
187008f6fba5SSteven Rostedt 	if (update) {
187108f6fba5SSteven Rostedt 		/* If there's no more users, clear all flags */
18720376bde1SSteven Rostedt (Red Hat) 		if (!ftrace_rec_count(rec))
187308f6fba5SSteven Rostedt 			rec->flags = 0;
187408f6fba5SSteven Rostedt 		else
187508f6fba5SSteven Rostedt 			/* Just disable the record (keep REGS state) */
187664fbcd16SXiao Guangrong 			rec->flags &= ~FTRACE_FL_ENABLED;
187708f6fba5SSteven Rostedt 	}
1878c88fd863SSteven Rostedt 
1879c88fd863SSteven Rostedt 	return FTRACE_UPDATE_MAKE_NOP;
1880c88fd863SSteven Rostedt }
1881c88fd863SSteven Rostedt 
1882c88fd863SSteven Rostedt /**
1883c88fd863SSteven Rostedt  * ftrace_update_record, set a record that now is tracing or not
1884c88fd863SSteven Rostedt  * @rec: the record to update
1885c88fd863SSteven Rostedt  * @enable: set to 1 if the record is tracing, zero to force disable
1886c88fd863SSteven Rostedt  *
1887c88fd863SSteven Rostedt  * The records that represent all functions that can be traced need
1888c88fd863SSteven Rostedt  * to be updated when tracing has been enabled.
1889c88fd863SSteven Rostedt  */
1890c88fd863SSteven Rostedt int ftrace_update_record(struct dyn_ftrace *rec, int enable)
1891c88fd863SSteven Rostedt {
1892c88fd863SSteven Rostedt 	return ftrace_check_record(rec, enable, 1);
1893c88fd863SSteven Rostedt }
1894c88fd863SSteven Rostedt 
1895c88fd863SSteven Rostedt /**
1896c88fd863SSteven Rostedt  * ftrace_test_record, check if the record has been enabled or not
1897c88fd863SSteven Rostedt  * @rec: the record to test
1898c88fd863SSteven Rostedt  * @enable: set to 1 to check if enabled, 0 if it is disabled
1899c88fd863SSteven Rostedt  *
1900c88fd863SSteven Rostedt  * The arch code may need to test if a record is already set to
1901c88fd863SSteven Rostedt  * tracing to determine how to modify the function code that it
1902c88fd863SSteven Rostedt  * represents.
1903c88fd863SSteven Rostedt  */
1904c88fd863SSteven Rostedt int ftrace_test_record(struct dyn_ftrace *rec, int enable)
1905c88fd863SSteven Rostedt {
1906c88fd863SSteven Rostedt 	return ftrace_check_record(rec, enable, 0);
1907c88fd863SSteven Rostedt }
1908c88fd863SSteven Rostedt 
190979922b80SSteven Rostedt (Red Hat) static struct ftrace_ops *
19105fecaa04SSteven Rostedt (Red Hat) ftrace_find_tramp_ops_any(struct dyn_ftrace *rec)
19115fecaa04SSteven Rostedt (Red Hat) {
19125fecaa04SSteven Rostedt (Red Hat) 	struct ftrace_ops *op;
19135fecaa04SSteven Rostedt (Red Hat) 
19145fecaa04SSteven Rostedt (Red Hat) 	do_for_each_ftrace_op(op, ftrace_ops_list) {
19155fecaa04SSteven Rostedt (Red Hat) 
19165fecaa04SSteven Rostedt (Red Hat) 		if (!op->trampoline)
19175fecaa04SSteven Rostedt (Red Hat) 			continue;
19185fecaa04SSteven Rostedt (Red Hat) 
19195fecaa04SSteven Rostedt (Red Hat) 		if (ftrace_lookup_ip(op->func_hash->filter_hash, rec->ip) &&
19205fecaa04SSteven Rostedt (Red Hat) 		    (ftrace_hash_empty(op->func_hash->notrace_hash) ||
19215fecaa04SSteven Rostedt (Red Hat) 		     !ftrace_lookup_ip(op->func_hash->notrace_hash, rec->ip)))
19225fecaa04SSteven Rostedt (Red Hat) 			return op;
19235fecaa04SSteven Rostedt (Red Hat) 	} while_for_each_ftrace_op(op);
19245fecaa04SSteven Rostedt (Red Hat) 
19255fecaa04SSteven Rostedt (Red Hat) 	return NULL;
19265fecaa04SSteven Rostedt (Red Hat) }
19275fecaa04SSteven Rostedt (Red Hat) 
19285fecaa04SSteven Rostedt (Red Hat) static struct ftrace_ops *
192979922b80SSteven Rostedt (Red Hat) ftrace_find_tramp_ops_curr(struct dyn_ftrace *rec)
193079922b80SSteven Rostedt (Red Hat) {
193179922b80SSteven Rostedt (Red Hat) 	struct ftrace_ops *op;
193279922b80SSteven Rostedt (Red Hat) 
193379922b80SSteven Rostedt (Red Hat) 	/* Removed ops need to be tested first */
193479922b80SSteven Rostedt (Red Hat) 	if (removed_ops && removed_ops->tramp_hash) {
193579922b80SSteven Rostedt (Red Hat) 		if (ftrace_lookup_ip(removed_ops->tramp_hash, rec->ip))
193679922b80SSteven Rostedt (Red Hat) 			return removed_ops;
193779922b80SSteven Rostedt (Red Hat) 	}
193879922b80SSteven Rostedt (Red Hat) 
193979922b80SSteven Rostedt (Red Hat) 	do_for_each_ftrace_op(op, ftrace_ops_list) {
194079922b80SSteven Rostedt (Red Hat) 		if (!op->tramp_hash)
194179922b80SSteven Rostedt (Red Hat) 			continue;
194279922b80SSteven Rostedt (Red Hat) 
194379922b80SSteven Rostedt (Red Hat) 		if (ftrace_lookup_ip(op->tramp_hash, rec->ip))
194479922b80SSteven Rostedt (Red Hat) 			return op;
194579922b80SSteven Rostedt (Red Hat) 
194679922b80SSteven Rostedt (Red Hat) 	} while_for_each_ftrace_op(op);
194779922b80SSteven Rostedt (Red Hat) 
194879922b80SSteven Rostedt (Red Hat) 	return NULL;
194979922b80SSteven Rostedt (Red Hat) }
195079922b80SSteven Rostedt (Red Hat) 
195179922b80SSteven Rostedt (Red Hat) static struct ftrace_ops *
195279922b80SSteven Rostedt (Red Hat) ftrace_find_tramp_ops_new(struct dyn_ftrace *rec)
195379922b80SSteven Rostedt (Red Hat) {
195479922b80SSteven Rostedt (Red Hat) 	struct ftrace_ops *op;
195579922b80SSteven Rostedt (Red Hat) 
195679922b80SSteven Rostedt (Red Hat) 	do_for_each_ftrace_op(op, ftrace_ops_list) {
195779922b80SSteven Rostedt (Red Hat) 		/* pass rec in as regs to have non-NULL val */
195879922b80SSteven Rostedt (Red Hat) 		if (ftrace_ops_test(op, rec->ip, rec))
195979922b80SSteven Rostedt (Red Hat) 			return op;
196079922b80SSteven Rostedt (Red Hat) 	} while_for_each_ftrace_op(op);
196179922b80SSteven Rostedt (Red Hat) 
196279922b80SSteven Rostedt (Red Hat) 	return NULL;
196379922b80SSteven Rostedt (Red Hat) }
196479922b80SSteven Rostedt (Red Hat) 
19657413af1fSSteven Rostedt (Red Hat) /**
19667413af1fSSteven Rostedt (Red Hat)  * ftrace_get_addr_new - Get the call address to set to
19677413af1fSSteven Rostedt (Red Hat)  * @rec:  The ftrace record descriptor
19687413af1fSSteven Rostedt (Red Hat)  *
19697413af1fSSteven Rostedt (Red Hat)  * If the record has the FTRACE_FL_REGS set, that means that it
19707413af1fSSteven Rostedt (Red Hat)  * wants to convert to a callback that saves all regs. If FTRACE_FL_REGS
19717413af1fSSteven Rostedt (Red Hat)  * is not not set, then it wants to convert to the normal callback.
19727413af1fSSteven Rostedt (Red Hat)  *
19737413af1fSSteven Rostedt (Red Hat)  * Returns the address of the trampoline to set to
19747413af1fSSteven Rostedt (Red Hat)  */
19757413af1fSSteven Rostedt (Red Hat) unsigned long ftrace_get_addr_new(struct dyn_ftrace *rec)
19767413af1fSSteven Rostedt (Red Hat) {
197779922b80SSteven Rostedt (Red Hat) 	struct ftrace_ops *ops;
197879922b80SSteven Rostedt (Red Hat) 
197979922b80SSteven Rostedt (Red Hat) 	/* Trampolines take precedence over regs */
198079922b80SSteven Rostedt (Red Hat) 	if (rec->flags & FTRACE_FL_TRAMP) {
198179922b80SSteven Rostedt (Red Hat) 		ops = ftrace_find_tramp_ops_new(rec);
198279922b80SSteven Rostedt (Red Hat) 		if (FTRACE_WARN_ON(!ops || !ops->trampoline)) {
1983bce0b6c5SSteven Rostedt (Red Hat) 			pr_warn("Bad trampoline accounting at: %p (%pS) (%lx)\n",
1984bce0b6c5SSteven Rostedt (Red Hat) 				(void *)rec->ip, (void *)rec->ip, rec->flags);
198579922b80SSteven Rostedt (Red Hat) 			/* Ftrace is shutting down, return anything */
198679922b80SSteven Rostedt (Red Hat) 			return (unsigned long)FTRACE_ADDR;
198779922b80SSteven Rostedt (Red Hat) 		}
198879922b80SSteven Rostedt (Red Hat) 		return ops->trampoline;
198979922b80SSteven Rostedt (Red Hat) 	}
199079922b80SSteven Rostedt (Red Hat) 
19917413af1fSSteven Rostedt (Red Hat) 	if (rec->flags & FTRACE_FL_REGS)
19927413af1fSSteven Rostedt (Red Hat) 		return (unsigned long)FTRACE_REGS_ADDR;
19937413af1fSSteven Rostedt (Red Hat) 	else
19947413af1fSSteven Rostedt (Red Hat) 		return (unsigned long)FTRACE_ADDR;
19957413af1fSSteven Rostedt (Red Hat) }
19967413af1fSSteven Rostedt (Red Hat) 
19977413af1fSSteven Rostedt (Red Hat) /**
19987413af1fSSteven Rostedt (Red Hat)  * ftrace_get_addr_curr - Get the call address that is already there
19997413af1fSSteven Rostedt (Red Hat)  * @rec:  The ftrace record descriptor
20007413af1fSSteven Rostedt (Red Hat)  *
20017413af1fSSteven Rostedt (Red Hat)  * The FTRACE_FL_REGS_EN is set when the record already points to
20027413af1fSSteven Rostedt (Red Hat)  * a function that saves all the regs. Basically the '_EN' version
20037413af1fSSteven Rostedt (Red Hat)  * represents the current state of the function.
20047413af1fSSteven Rostedt (Red Hat)  *
20057413af1fSSteven Rostedt (Red Hat)  * Returns the address of the trampoline that is currently being called
20067413af1fSSteven Rostedt (Red Hat)  */
20077413af1fSSteven Rostedt (Red Hat) unsigned long ftrace_get_addr_curr(struct dyn_ftrace *rec)
20087413af1fSSteven Rostedt (Red Hat) {
200979922b80SSteven Rostedt (Red Hat) 	struct ftrace_ops *ops;
201079922b80SSteven Rostedt (Red Hat) 
201179922b80SSteven Rostedt (Red Hat) 	/* Trampolines take precedence over regs */
201279922b80SSteven Rostedt (Red Hat) 	if (rec->flags & FTRACE_FL_TRAMP_EN) {
201379922b80SSteven Rostedt (Red Hat) 		ops = ftrace_find_tramp_ops_curr(rec);
201479922b80SSteven Rostedt (Red Hat) 		if (FTRACE_WARN_ON(!ops)) {
201579922b80SSteven Rostedt (Red Hat) 			pr_warning("Bad trampoline accounting at: %p (%pS)\n",
201679922b80SSteven Rostedt (Red Hat) 				    (void *)rec->ip, (void *)rec->ip);
201779922b80SSteven Rostedt (Red Hat) 			/* Ftrace is shutting down, return anything */
201879922b80SSteven Rostedt (Red Hat) 			return (unsigned long)FTRACE_ADDR;
201979922b80SSteven Rostedt (Red Hat) 		}
202079922b80SSteven Rostedt (Red Hat) 		return ops->trampoline;
202179922b80SSteven Rostedt (Red Hat) 	}
202279922b80SSteven Rostedt (Red Hat) 
20237413af1fSSteven Rostedt (Red Hat) 	if (rec->flags & FTRACE_FL_REGS_EN)
20247413af1fSSteven Rostedt (Red Hat) 		return (unsigned long)FTRACE_REGS_ADDR;
20257413af1fSSteven Rostedt (Red Hat) 	else
20267413af1fSSteven Rostedt (Red Hat) 		return (unsigned long)FTRACE_ADDR;
20277413af1fSSteven Rostedt (Red Hat) }
20287413af1fSSteven Rostedt (Red Hat) 
2029c88fd863SSteven Rostedt static int
2030c88fd863SSteven Rostedt __ftrace_replace_code(struct dyn_ftrace *rec, int enable)
2031c88fd863SSteven Rostedt {
203208f6fba5SSteven Rostedt 	unsigned long ftrace_old_addr;
2033c88fd863SSteven Rostedt 	unsigned long ftrace_addr;
2034c88fd863SSteven Rostedt 	int ret;
2035c88fd863SSteven Rostedt 
20367c0868e0SSteven Rostedt (Red Hat) 	ftrace_addr = ftrace_get_addr_new(rec);
2037c88fd863SSteven Rostedt 
20387c0868e0SSteven Rostedt (Red Hat) 	/* This needs to be done before we call ftrace_update_record */
20397c0868e0SSteven Rostedt (Red Hat) 	ftrace_old_addr = ftrace_get_addr_curr(rec);
20407c0868e0SSteven Rostedt (Red Hat) 
20417c0868e0SSteven Rostedt (Red Hat) 	ret = ftrace_update_record(rec, enable);
204208f6fba5SSteven Rostedt 
2043c88fd863SSteven Rostedt 	switch (ret) {
2044c88fd863SSteven Rostedt 	case FTRACE_UPDATE_IGNORE:
2045c88fd863SSteven Rostedt 		return 0;
2046c88fd863SSteven Rostedt 
2047c88fd863SSteven Rostedt 	case FTRACE_UPDATE_MAKE_CALL:
2048c88fd863SSteven Rostedt 		return ftrace_make_call(rec, ftrace_addr);
2049c88fd863SSteven Rostedt 
2050c88fd863SSteven Rostedt 	case FTRACE_UPDATE_MAKE_NOP:
205139b5552cSSteven Rostedt (Red Hat) 		return ftrace_make_nop(NULL, rec, ftrace_old_addr);
205208f6fba5SSteven Rostedt 
205308f6fba5SSteven Rostedt 	case FTRACE_UPDATE_MODIFY_CALL:
205408f6fba5SSteven Rostedt 		return ftrace_modify_call(rec, ftrace_old_addr, ftrace_addr);
20553d083395SSteven Rostedt 	}
20563d083395SSteven Rostedt 
2057c88fd863SSteven Rostedt 	return -1; /* unknow ftrace bug */
2058c88fd863SSteven Rostedt }
2059c88fd863SSteven Rostedt 
2060e4f5d544SSteven Rostedt void __weak ftrace_replace_code(int enable)
20613d083395SSteven Rostedt {
20623d083395SSteven Rostedt 	struct dyn_ftrace *rec;
20633d083395SSteven Rostedt 	struct ftrace_page *pg;
20646a24a244SSteven Rostedt 	int failed;
20653d083395SSteven Rostedt 
206645a4a237SSteven Rostedt 	if (unlikely(ftrace_disabled))
206745a4a237SSteven Rostedt 		return;
206845a4a237SSteven Rostedt 
2069265c831cSSteven Rostedt 	do_for_each_ftrace_rec(pg, rec) {
2070e4f5d544SSteven Rostedt 		failed = __ftrace_replace_code(rec, enable);
2071fa9d13cfSZhaolei 		if (failed) {
207231e88909SSteven Rostedt 			ftrace_bug(failed, rec->ip);
20734377245aSSteven Rostedt 			/* Stop processing */
20744377245aSSteven Rostedt 			return;
20754377245aSSteven Rostedt 		}
2076265c831cSSteven Rostedt 	} while_for_each_ftrace_rec();
20773d083395SSteven Rostedt }
20783c1720f0SSteven Rostedt 
2079c88fd863SSteven Rostedt struct ftrace_rec_iter {
2080c88fd863SSteven Rostedt 	struct ftrace_page	*pg;
2081c88fd863SSteven Rostedt 	int			index;
2082c88fd863SSteven Rostedt };
2083c88fd863SSteven Rostedt 
2084c88fd863SSteven Rostedt /**
2085c88fd863SSteven Rostedt  * ftrace_rec_iter_start, start up iterating over traced functions
2086c88fd863SSteven Rostedt  *
2087c88fd863SSteven Rostedt  * Returns an iterator handle that is used to iterate over all
2088c88fd863SSteven Rostedt  * the records that represent address locations where functions
2089c88fd863SSteven Rostedt  * are traced.
2090c88fd863SSteven Rostedt  *
2091c88fd863SSteven Rostedt  * May return NULL if no records are available.
2092c88fd863SSteven Rostedt  */
2093c88fd863SSteven Rostedt struct ftrace_rec_iter *ftrace_rec_iter_start(void)
2094c88fd863SSteven Rostedt {
2095c88fd863SSteven Rostedt 	/*
2096c88fd863SSteven Rostedt 	 * We only use a single iterator.
2097c88fd863SSteven Rostedt 	 * Protected by the ftrace_lock mutex.
2098c88fd863SSteven Rostedt 	 */
2099c88fd863SSteven Rostedt 	static struct ftrace_rec_iter ftrace_rec_iter;
2100c88fd863SSteven Rostedt 	struct ftrace_rec_iter *iter = &ftrace_rec_iter;
2101c88fd863SSteven Rostedt 
2102c88fd863SSteven Rostedt 	iter->pg = ftrace_pages_start;
2103c88fd863SSteven Rostedt 	iter->index = 0;
2104c88fd863SSteven Rostedt 
2105c88fd863SSteven Rostedt 	/* Could have empty pages */
2106c88fd863SSteven Rostedt 	while (iter->pg && !iter->pg->index)
2107c88fd863SSteven Rostedt 		iter->pg = iter->pg->next;
2108c88fd863SSteven Rostedt 
2109c88fd863SSteven Rostedt 	if (!iter->pg)
2110c88fd863SSteven Rostedt 		return NULL;
2111c88fd863SSteven Rostedt 
2112c88fd863SSteven Rostedt 	return iter;
2113c88fd863SSteven Rostedt }
2114c88fd863SSteven Rostedt 
2115c88fd863SSteven Rostedt /**
2116c88fd863SSteven Rostedt  * ftrace_rec_iter_next, get the next record to process.
2117c88fd863SSteven Rostedt  * @iter: The handle to the iterator.
2118c88fd863SSteven Rostedt  *
2119c88fd863SSteven Rostedt  * Returns the next iterator after the given iterator @iter.
2120c88fd863SSteven Rostedt  */
2121c88fd863SSteven Rostedt struct ftrace_rec_iter *ftrace_rec_iter_next(struct ftrace_rec_iter *iter)
2122c88fd863SSteven Rostedt {
2123c88fd863SSteven Rostedt 	iter->index++;
2124c88fd863SSteven Rostedt 
2125c88fd863SSteven Rostedt 	if (iter->index >= iter->pg->index) {
2126c88fd863SSteven Rostedt 		iter->pg = iter->pg->next;
2127c88fd863SSteven Rostedt 		iter->index = 0;
2128c88fd863SSteven Rostedt 
2129c88fd863SSteven Rostedt 		/* Could have empty pages */
2130c88fd863SSteven Rostedt 		while (iter->pg && !iter->pg->index)
2131c88fd863SSteven Rostedt 			iter->pg = iter->pg->next;
2132c88fd863SSteven Rostedt 	}
2133c88fd863SSteven Rostedt 
2134c88fd863SSteven Rostedt 	if (!iter->pg)
2135c88fd863SSteven Rostedt 		return NULL;
2136c88fd863SSteven Rostedt 
2137c88fd863SSteven Rostedt 	return iter;
2138c88fd863SSteven Rostedt }
2139c88fd863SSteven Rostedt 
2140c88fd863SSteven Rostedt /**
2141c88fd863SSteven Rostedt  * ftrace_rec_iter_record, get the record at the iterator location
2142c88fd863SSteven Rostedt  * @iter: The current iterator location
2143c88fd863SSteven Rostedt  *
2144c88fd863SSteven Rostedt  * Returns the record that the current @iter is at.
2145c88fd863SSteven Rostedt  */
2146c88fd863SSteven Rostedt struct dyn_ftrace *ftrace_rec_iter_record(struct ftrace_rec_iter *iter)
2147c88fd863SSteven Rostedt {
2148c88fd863SSteven Rostedt 	return &iter->pg->records[iter->index];
2149c88fd863SSteven Rostedt }
2150c88fd863SSteven Rostedt 
21513b47bfc1SSteven Rostedt static int
215231e88909SSteven Rostedt ftrace_code_disable(struct module *mod, struct dyn_ftrace *rec)
21533c1720f0SSteven Rostedt {
215437ad5084SSteven Rostedt 	unsigned long ip;
2155492a7ea5SAbhishek Sagar 	int ret;
215637ad5084SSteven Rostedt 
2157492a7ea5SAbhishek Sagar 	ip = rec->ip;
21583c1720f0SSteven Rostedt 
215945a4a237SSteven Rostedt 	if (unlikely(ftrace_disabled))
216045a4a237SSteven Rostedt 		return 0;
216145a4a237SSteven Rostedt 
216225aac9dcSShaohua Li 	ret = ftrace_make_nop(mod, rec, MCOUNT_ADDR);
21633d083395SSteven Rostedt 	if (ret) {
216431e88909SSteven Rostedt 		ftrace_bug(ret, ip);
21653d083395SSteven Rostedt 		return 0;
2166d61f82d0SSteven Rostedt 	}
2167d61f82d0SSteven Rostedt 	return 1;
21683d083395SSteven Rostedt }
21693d083395SSteven Rostedt 
2170000ab691SSteven Rostedt /*
2171000ab691SSteven Rostedt  * archs can override this function if they must do something
2172000ab691SSteven Rostedt  * before the modifying code is performed.
2173000ab691SSteven Rostedt  */
2174000ab691SSteven Rostedt int __weak ftrace_arch_code_modify_prepare(void)
2175000ab691SSteven Rostedt {
2176000ab691SSteven Rostedt 	return 0;
2177000ab691SSteven Rostedt }
2178000ab691SSteven Rostedt 
2179000ab691SSteven Rostedt /*
2180000ab691SSteven Rostedt  * archs can override this function if they must do something
2181000ab691SSteven Rostedt  * after the modifying code is performed.
2182000ab691SSteven Rostedt  */
2183000ab691SSteven Rostedt int __weak ftrace_arch_code_modify_post_process(void)
2184000ab691SSteven Rostedt {
2185000ab691SSteven Rostedt 	return 0;
2186000ab691SSteven Rostedt }
2187000ab691SSteven Rostedt 
21888ed3e2cfSSteven Rostedt void ftrace_modify_all_code(int command)
21898ed3e2cfSSteven Rostedt {
219059338f75SSteven Rostedt (Red Hat) 	int update = command & FTRACE_UPDATE_TRACE_FUNC;
2191cd21067fSPetr Mladek 	int err = 0;
219259338f75SSteven Rostedt (Red Hat) 
219359338f75SSteven Rostedt (Red Hat) 	/*
219459338f75SSteven Rostedt (Red Hat) 	 * If the ftrace_caller calls a ftrace_ops func directly,
219559338f75SSteven Rostedt (Red Hat) 	 * we need to make sure that it only traces functions it
219659338f75SSteven Rostedt (Red Hat) 	 * expects to trace. When doing the switch of functions,
219759338f75SSteven Rostedt (Red Hat) 	 * we need to update to the ftrace_ops_list_func first
219859338f75SSteven Rostedt (Red Hat) 	 * before the transition between old and new calls are set,
219959338f75SSteven Rostedt (Red Hat) 	 * as the ftrace_ops_list_func will check the ops hashes
220059338f75SSteven Rostedt (Red Hat) 	 * to make sure the ops are having the right functions
220159338f75SSteven Rostedt (Red Hat) 	 * traced.
220259338f75SSteven Rostedt (Red Hat) 	 */
2203cd21067fSPetr Mladek 	if (update) {
2204cd21067fSPetr Mladek 		err = ftrace_update_ftrace_func(ftrace_ops_list_func);
2205cd21067fSPetr Mladek 		if (FTRACE_WARN_ON(err))
2206cd21067fSPetr Mladek 			return;
2207cd21067fSPetr Mladek 	}
220859338f75SSteven Rostedt (Red Hat) 
22098ed3e2cfSSteven Rostedt 	if (command & FTRACE_UPDATE_CALLS)
22108ed3e2cfSSteven Rostedt 		ftrace_replace_code(1);
22118ed3e2cfSSteven Rostedt 	else if (command & FTRACE_DISABLE_CALLS)
22128ed3e2cfSSteven Rostedt 		ftrace_replace_code(0);
22138ed3e2cfSSteven Rostedt 
2214405e1d83SSteven Rostedt (Red Hat) 	if (update && ftrace_trace_function != ftrace_ops_list_func) {
2215405e1d83SSteven Rostedt (Red Hat) 		function_trace_op = set_function_trace_op;
2216405e1d83SSteven Rostedt (Red Hat) 		smp_wmb();
2217405e1d83SSteven Rostedt (Red Hat) 		/* If irqs are disabled, we are in stop machine */
2218405e1d83SSteven Rostedt (Red Hat) 		if (!irqs_disabled())
2219405e1d83SSteven Rostedt (Red Hat) 			smp_call_function(ftrace_sync_ipi, NULL, 1);
2220cd21067fSPetr Mladek 		err = ftrace_update_ftrace_func(ftrace_trace_function);
2221cd21067fSPetr Mladek 		if (FTRACE_WARN_ON(err))
2222cd21067fSPetr Mladek 			return;
2223405e1d83SSteven Rostedt (Red Hat) 	}
22248ed3e2cfSSteven Rostedt 
22258ed3e2cfSSteven Rostedt 	if (command & FTRACE_START_FUNC_RET)
2226cd21067fSPetr Mladek 		err = ftrace_enable_ftrace_graph_caller();
22278ed3e2cfSSteven Rostedt 	else if (command & FTRACE_STOP_FUNC_RET)
2228cd21067fSPetr Mladek 		err = ftrace_disable_ftrace_graph_caller();
2229cd21067fSPetr Mladek 	FTRACE_WARN_ON(err);
22308ed3e2cfSSteven Rostedt }
22318ed3e2cfSSteven Rostedt 
22323d083395SSteven Rostedt static int __ftrace_modify_code(void *data)
22333d083395SSteven Rostedt {
22343d083395SSteven Rostedt 	int *command = data;
22353d083395SSteven Rostedt 
22368ed3e2cfSSteven Rostedt 	ftrace_modify_all_code(*command);
22375a45cfe1SSteven Rostedt 
2238c88fd863SSteven Rostedt 	return 0;
2239c88fd863SSteven Rostedt }
2240c88fd863SSteven Rostedt 
2241c88fd863SSteven Rostedt /**
2242c88fd863SSteven Rostedt  * ftrace_run_stop_machine, go back to the stop machine method
2243c88fd863SSteven Rostedt  * @command: The command to tell ftrace what to do
2244c88fd863SSteven Rostedt  *
2245c88fd863SSteven Rostedt  * If an arch needs to fall back to the stop machine method, the
2246c88fd863SSteven Rostedt  * it can call this function.
2247c88fd863SSteven Rostedt  */
2248c88fd863SSteven Rostedt void ftrace_run_stop_machine(int command)
2249c88fd863SSteven Rostedt {
2250c88fd863SSteven Rostedt 	stop_machine(__ftrace_modify_code, &command, NULL);
2251c88fd863SSteven Rostedt }
2252c88fd863SSteven Rostedt 
2253c88fd863SSteven Rostedt /**
2254c88fd863SSteven Rostedt  * arch_ftrace_update_code, modify the code to trace or not trace
2255c88fd863SSteven Rostedt  * @command: The command that needs to be done
2256c88fd863SSteven Rostedt  *
2257c88fd863SSteven Rostedt  * Archs can override this function if it does not need to
2258c88fd863SSteven Rostedt  * run stop_machine() to modify code.
2259c88fd863SSteven Rostedt  */
2260c88fd863SSteven Rostedt void __weak arch_ftrace_update_code(int command)
2261c88fd863SSteven Rostedt {
2262c88fd863SSteven Rostedt 	ftrace_run_stop_machine(command);
2263c88fd863SSteven Rostedt }
2264c88fd863SSteven Rostedt 
226579922b80SSteven Rostedt (Red Hat) static int ftrace_save_ops_tramp_hash(struct ftrace_ops *ops)
226679922b80SSteven Rostedt (Red Hat) {
226779922b80SSteven Rostedt (Red Hat) 	struct ftrace_page *pg;
226879922b80SSteven Rostedt (Red Hat) 	struct dyn_ftrace *rec;
226979922b80SSteven Rostedt (Red Hat) 	int size, bits;
227079922b80SSteven Rostedt (Red Hat) 	int ret;
227179922b80SSteven Rostedt (Red Hat) 
22720162d621SSteven Rostedt (Red Hat) 	size = ops->nr_trampolines;
227379922b80SSteven Rostedt (Red Hat) 	bits = 0;
227479922b80SSteven Rostedt (Red Hat) 	/*
227579922b80SSteven Rostedt (Red Hat) 	 * Make the hash size about 1/2 the # found
227679922b80SSteven Rostedt (Red Hat) 	 */
227779922b80SSteven Rostedt (Red Hat) 	for (size /= 2; size; size >>= 1)
227879922b80SSteven Rostedt (Red Hat) 		bits++;
227979922b80SSteven Rostedt (Red Hat) 
228079922b80SSteven Rostedt (Red Hat) 	ops->tramp_hash = alloc_ftrace_hash(bits);
228179922b80SSteven Rostedt (Red Hat) 	/*
228279922b80SSteven Rostedt (Red Hat) 	 * TODO: a failed allocation is going to screw up
228379922b80SSteven Rostedt (Red Hat) 	 * the accounting of what needs to be modified
228479922b80SSteven Rostedt (Red Hat) 	 * and not. For now, we kill ftrace if we fail
228579922b80SSteven Rostedt (Red Hat) 	 * to allocate here. But there are ways around this,
228679922b80SSteven Rostedt (Red Hat) 	 * but that will take a little more work.
228779922b80SSteven Rostedt (Red Hat) 	 */
228879922b80SSteven Rostedt (Red Hat) 	if (!ops->tramp_hash)
228979922b80SSteven Rostedt (Red Hat) 		return -ENOMEM;
229079922b80SSteven Rostedt (Red Hat) 
229179922b80SSteven Rostedt (Red Hat) 	do_for_each_ftrace_rec(pg, rec) {
229279922b80SSteven Rostedt (Red Hat) 		if (ftrace_rec_count(rec) == 1 &&
229379922b80SSteven Rostedt (Red Hat) 		    ftrace_ops_test(ops, rec->ip, rec)) {
229479922b80SSteven Rostedt (Red Hat) 
22952a0343baSSteven Rostedt (Red Hat) 			/*
22962a0343baSSteven Rostedt (Red Hat) 			 * If another ops adds to a rec, the rec will
22972a0343baSSteven Rostedt (Red Hat) 			 * lose its trampoline and never get it back
22982a0343baSSteven Rostedt (Red Hat) 			 * until all ops are off of it.
22992a0343baSSteven Rostedt (Red Hat) 			 */
23002a0343baSSteven Rostedt (Red Hat) 			if (!(rec->flags & FTRACE_FL_TRAMP))
23012a0343baSSteven Rostedt (Red Hat) 				continue;
23022a0343baSSteven Rostedt (Red Hat) 
230379922b80SSteven Rostedt (Red Hat) 			/* This record had better have a trampoline */
230479922b80SSteven Rostedt (Red Hat) 			if (FTRACE_WARN_ON(!(rec->flags & FTRACE_FL_TRAMP_EN)))
230579922b80SSteven Rostedt (Red Hat) 				return -1;
230679922b80SSteven Rostedt (Red Hat) 
230779922b80SSteven Rostedt (Red Hat) 			ret = add_hash_entry(ops->tramp_hash, rec->ip);
230879922b80SSteven Rostedt (Red Hat) 			if (ret < 0)
230979922b80SSteven Rostedt (Red Hat) 				return ret;
231079922b80SSteven Rostedt (Red Hat) 		}
231179922b80SSteven Rostedt (Red Hat) 	} while_for_each_ftrace_rec();
231279922b80SSteven Rostedt (Red Hat) 
2313dc6f03f2SSteven Rostedt (Red Hat) 	/* The number of recs in the hash must match nr_trampolines */
2314bce0b6c5SSteven Rostedt (Red Hat) 	if (FTRACE_WARN_ON(ops->tramp_hash->count != ops->nr_trampolines))
2315bce0b6c5SSteven Rostedt (Red Hat) 		pr_warn("count=%ld trampolines=%d\n",
2316bce0b6c5SSteven Rostedt (Red Hat) 			ops->tramp_hash->count,
2317bce0b6c5SSteven Rostedt (Red Hat) 			ops->nr_trampolines);
2318dc6f03f2SSteven Rostedt (Red Hat) 
231979922b80SSteven Rostedt (Red Hat) 	return 0;
232079922b80SSteven Rostedt (Red Hat) }
232179922b80SSteven Rostedt (Red Hat) 
232279922b80SSteven Rostedt (Red Hat) static int ftrace_save_tramp_hashes(void)
232379922b80SSteven Rostedt (Red Hat) {
232479922b80SSteven Rostedt (Red Hat) 	struct ftrace_ops *op;
232579922b80SSteven Rostedt (Red Hat) 	int ret;
232679922b80SSteven Rostedt (Red Hat) 
232779922b80SSteven Rostedt (Red Hat) 	/*
232879922b80SSteven Rostedt (Red Hat) 	 * Now that any trampoline is being used, we need to save the
232979922b80SSteven Rostedt (Red Hat) 	 * hashes for the ops that have them. This allows the mapping
233079922b80SSteven Rostedt (Red Hat) 	 * back from the record to the ops that has the trampoline to
233179922b80SSteven Rostedt (Red Hat) 	 * know what code is being replaced. Modifying code must always
233279922b80SSteven Rostedt (Red Hat) 	 * verify what it is changing.
233379922b80SSteven Rostedt (Red Hat) 	 */
233479922b80SSteven Rostedt (Red Hat) 	do_for_each_ftrace_op(op, ftrace_ops_list) {
233579922b80SSteven Rostedt (Red Hat) 
233679922b80SSteven Rostedt (Red Hat) 		/* The tramp_hash is recreated each time. */
233779922b80SSteven Rostedt (Red Hat) 		free_ftrace_hash(op->tramp_hash);
233879922b80SSteven Rostedt (Red Hat) 		op->tramp_hash = NULL;
233979922b80SSteven Rostedt (Red Hat) 
23400162d621SSteven Rostedt (Red Hat) 		if (op->nr_trampolines) {
234179922b80SSteven Rostedt (Red Hat) 			ret = ftrace_save_ops_tramp_hash(op);
234279922b80SSteven Rostedt (Red Hat) 			if (ret)
234379922b80SSteven Rostedt (Red Hat) 				return ret;
234479922b80SSteven Rostedt (Red Hat) 		}
234579922b80SSteven Rostedt (Red Hat) 
234679922b80SSteven Rostedt (Red Hat) 	} while_for_each_ftrace_op(op);
234779922b80SSteven Rostedt (Red Hat) 
234879922b80SSteven Rostedt (Red Hat) 	return 0;
234979922b80SSteven Rostedt (Red Hat) }
235079922b80SSteven Rostedt (Red Hat) 
2351c88fd863SSteven Rostedt static void ftrace_run_update_code(int command)
2352c88fd863SSteven Rostedt {
2353c88fd863SSteven Rostedt 	int ret;
2354c88fd863SSteven Rostedt 
2355c88fd863SSteven Rostedt 	ret = ftrace_arch_code_modify_prepare();
2356c88fd863SSteven Rostedt 	FTRACE_WARN_ON(ret);
2357c88fd863SSteven Rostedt 	if (ret)
2358c88fd863SSteven Rostedt 		return;
2359c88fd863SSteven Rostedt 
2360c88fd863SSteven Rostedt 	/*
2361c88fd863SSteven Rostedt 	 * By default we use stop_machine() to modify the code.
2362c88fd863SSteven Rostedt 	 * But archs can do what ever they want as long as it
2363c88fd863SSteven Rostedt 	 * is safe. The stop_machine() is the safest, but also
2364c88fd863SSteven Rostedt 	 * produces the most overhead.
2365c88fd863SSteven Rostedt 	 */
2366c88fd863SSteven Rostedt 	arch_ftrace_update_code(command);
2367c88fd863SSteven Rostedt 
2368000ab691SSteven Rostedt 	ret = ftrace_arch_code_modify_post_process();
2369000ab691SSteven Rostedt 	FTRACE_WARN_ON(ret);
237079922b80SSteven Rostedt (Red Hat) 
237179922b80SSteven Rostedt (Red Hat) 	ret = ftrace_save_tramp_hashes();
237279922b80SSteven Rostedt (Red Hat) 	FTRACE_WARN_ON(ret);
23733d083395SSteven Rostedt }
23743d083395SSteven Rostedt 
2375*e1effa01SSteven Rostedt (Red Hat) static void ftrace_run_modify_code(struct ftrace_ops *ops, int command)
2376*e1effa01SSteven Rostedt (Red Hat) {
2377*e1effa01SSteven Rostedt (Red Hat) 	ops->flags |= FTRACE_OPS_FL_MODIFYING;
2378*e1effa01SSteven Rostedt (Red Hat) 	ftrace_run_update_code(command);
2379*e1effa01SSteven Rostedt (Red Hat) 	ops->flags &= ~FTRACE_OPS_FL_MODIFYING;
2380*e1effa01SSteven Rostedt (Red Hat) }
2381*e1effa01SSteven Rostedt (Red Hat) 
23823d083395SSteven Rostedt static ftrace_func_t saved_ftrace_func;
238360a7ecf4SSteven Rostedt static int ftrace_start_up;
2384df4fc315SSteven Rostedt 
2385db0fbadcSJiri Slaby static void control_ops_free(struct ftrace_ops *ops)
2386db0fbadcSJiri Slaby {
2387db0fbadcSJiri Slaby 	free_percpu(ops->disabled);
2388db0fbadcSJiri Slaby }
2389db0fbadcSJiri Slaby 
2390df4fc315SSteven Rostedt static void ftrace_startup_enable(int command)
2391df4fc315SSteven Rostedt {
2392df4fc315SSteven Rostedt 	if (saved_ftrace_func != ftrace_trace_function) {
2393df4fc315SSteven Rostedt 		saved_ftrace_func = ftrace_trace_function;
2394df4fc315SSteven Rostedt 		command |= FTRACE_UPDATE_TRACE_FUNC;
2395df4fc315SSteven Rostedt 	}
2396df4fc315SSteven Rostedt 
2397df4fc315SSteven Rostedt 	if (!command || !ftrace_enabled)
2398df4fc315SSteven Rostedt 		return;
2399df4fc315SSteven Rostedt 
2400df4fc315SSteven Rostedt 	ftrace_run_update_code(command);
2401df4fc315SSteven Rostedt }
24023d083395SSteven Rostedt 
2403*e1effa01SSteven Rostedt (Red Hat) static void ftrace_startup_all(int command)
2404*e1effa01SSteven Rostedt (Red Hat) {
2405*e1effa01SSteven Rostedt (Red Hat) 	update_all_ops = true;
2406*e1effa01SSteven Rostedt (Red Hat) 	ftrace_startup_enable(command);
2407*e1effa01SSteven Rostedt (Red Hat) 	update_all_ops = false;
2408*e1effa01SSteven Rostedt (Red Hat) }
2409*e1effa01SSteven Rostedt (Red Hat) 
2410a1cd6173SSteven Rostedt static int ftrace_startup(struct ftrace_ops *ops, int command)
24113d083395SSteven Rostedt {
24128a56d776SSteven Rostedt (Red Hat) 	int ret;
2413b848914cSSteven Rostedt 
24144eebcc81SSteven Rostedt 	if (unlikely(ftrace_disabled))
2415a1cd6173SSteven Rostedt 		return -ENODEV;
24164eebcc81SSteven Rostedt 
24178a56d776SSteven Rostedt (Red Hat) 	ret = __register_ftrace_function(ops);
24188a56d776SSteven Rostedt (Red Hat) 	if (ret)
24198a56d776SSteven Rostedt (Red Hat) 		return ret;
24208a56d776SSteven Rostedt (Red Hat) 
242160a7ecf4SSteven Rostedt 	ftrace_start_up++;
242230fb6aa7SJiri Olsa 	command |= FTRACE_UPDATE_CALLS;
24233d083395SSteven Rostedt 
2424*e1effa01SSteven Rostedt (Red Hat) 	/*
2425*e1effa01SSteven Rostedt (Red Hat) 	 * Note that ftrace probes uses this to start up
2426*e1effa01SSteven Rostedt (Red Hat) 	 * and modify functions it will probe. But we still
2427*e1effa01SSteven Rostedt (Red Hat) 	 * set the ADDING flag for modification, as probes
2428*e1effa01SSteven Rostedt (Red Hat) 	 * do not have trampolines. If they add them in the
2429*e1effa01SSteven Rostedt (Red Hat) 	 * future, then the probes will need to distinguish
2430*e1effa01SSteven Rostedt (Red Hat) 	 * between adding and updating probes.
2431*e1effa01SSteven Rostedt (Red Hat) 	 */
2432*e1effa01SSteven Rostedt (Red Hat) 	ops->flags |= FTRACE_OPS_FL_ENABLED | FTRACE_OPS_FL_ADDING;
243366209a5bSSteven Rostedt (Red Hat) 
2434ed926f9bSSteven Rostedt 	ftrace_hash_rec_enable(ops, 1);
2435ed926f9bSSteven Rostedt 
2436df4fc315SSteven Rostedt 	ftrace_startup_enable(command);
2437a1cd6173SSteven Rostedt 
2438*e1effa01SSteven Rostedt (Red Hat) 	ops->flags &= ~FTRACE_OPS_FL_ADDING;
2439*e1effa01SSteven Rostedt (Red Hat) 
2440a1cd6173SSteven Rostedt 	return 0;
24413d083395SSteven Rostedt }
24423d083395SSteven Rostedt 
24438a56d776SSteven Rostedt (Red Hat) static int ftrace_shutdown(struct ftrace_ops *ops, int command)
24443d083395SSteven Rostedt {
24458a56d776SSteven Rostedt (Red Hat) 	int ret;
2446b848914cSSteven Rostedt 
24474eebcc81SSteven Rostedt 	if (unlikely(ftrace_disabled))
24488a56d776SSteven Rostedt (Red Hat) 		return -ENODEV;
24498a56d776SSteven Rostedt (Red Hat) 
24508a56d776SSteven Rostedt (Red Hat) 	ret = __unregister_ftrace_function(ops);
24518a56d776SSteven Rostedt (Red Hat) 	if (ret)
24528a56d776SSteven Rostedt (Red Hat) 		return ret;
24534eebcc81SSteven Rostedt 
245460a7ecf4SSteven Rostedt 	ftrace_start_up--;
24559ea1a153SFrederic Weisbecker 	/*
24569ea1a153SFrederic Weisbecker 	 * Just warn in case of unbalance, no need to kill ftrace, it's not
24579ea1a153SFrederic Weisbecker 	 * critical but the ftrace_call callers may be never nopped again after
24589ea1a153SFrederic Weisbecker 	 * further ftrace uses.
24599ea1a153SFrederic Weisbecker 	 */
24609ea1a153SFrederic Weisbecker 	WARN_ON_ONCE(ftrace_start_up < 0);
24619ea1a153SFrederic Weisbecker 
2462ed926f9bSSteven Rostedt 	ftrace_hash_rec_disable(ops, 1);
2463ed926f9bSSteven Rostedt 
2464ed926f9bSSteven Rostedt 	ops->flags &= ~FTRACE_OPS_FL_ENABLED;
2465b848914cSSteven Rostedt 
246630fb6aa7SJiri Olsa 	command |= FTRACE_UPDATE_CALLS;
2467d61f82d0SSteven Rostedt 
2468d61f82d0SSteven Rostedt 	if (saved_ftrace_func != ftrace_trace_function) {
2469d61f82d0SSteven Rostedt 		saved_ftrace_func = ftrace_trace_function;
2470d61f82d0SSteven Rostedt 		command |= FTRACE_UPDATE_TRACE_FUNC;
2471d61f82d0SSteven Rostedt 	}
2472d61f82d0SSteven Rostedt 
2473a4c35ed2SSteven Rostedt (Red Hat) 	if (!command || !ftrace_enabled) {
2474a4c35ed2SSteven Rostedt (Red Hat) 		/*
2475a4c35ed2SSteven Rostedt (Red Hat) 		 * If these are control ops, they still need their
2476a4c35ed2SSteven Rostedt (Red Hat) 		 * per_cpu field freed. Since, function tracing is
2477a4c35ed2SSteven Rostedt (Red Hat) 		 * not currently active, we can just free them
2478a4c35ed2SSteven Rostedt (Red Hat) 		 * without synchronizing all CPUs.
2479a4c35ed2SSteven Rostedt (Red Hat) 		 */
2480a4c35ed2SSteven Rostedt (Red Hat) 		if (ops->flags & FTRACE_OPS_FL_CONTROL)
2481a4c35ed2SSteven Rostedt (Red Hat) 			control_ops_free(ops);
24828a56d776SSteven Rostedt (Red Hat) 		return 0;
2483a4c35ed2SSteven Rostedt (Red Hat) 	}
24843d083395SSteven Rostedt 
248579922b80SSteven Rostedt (Red Hat) 	/*
248679922b80SSteven Rostedt (Red Hat) 	 * If the ops uses a trampoline, then it needs to be
248779922b80SSteven Rostedt (Red Hat) 	 * tested first on update.
248879922b80SSteven Rostedt (Red Hat) 	 */
2489*e1effa01SSteven Rostedt (Red Hat) 	ops->flags |= FTRACE_OPS_FL_REMOVING;
249079922b80SSteven Rostedt (Red Hat) 	removed_ops = ops;
249179922b80SSteven Rostedt (Red Hat) 
2492d61f82d0SSteven Rostedt 	ftrace_run_update_code(command);
2493a4c35ed2SSteven Rostedt (Red Hat) 
2494*e1effa01SSteven Rostedt (Red Hat) 	ops->flags &= ~FTRACE_OPS_FL_REMOVING;
249579922b80SSteven Rostedt (Red Hat) 
2496a4c35ed2SSteven Rostedt (Red Hat) 	/*
2497a4c35ed2SSteven Rostedt (Red Hat) 	 * Dynamic ops may be freed, we must make sure that all
2498a4c35ed2SSteven Rostedt (Red Hat) 	 * callers are done before leaving this function.
2499a4c35ed2SSteven Rostedt (Red Hat) 	 * The same goes for freeing the per_cpu data of the control
2500a4c35ed2SSteven Rostedt (Red Hat) 	 * ops.
2501a4c35ed2SSteven Rostedt (Red Hat) 	 *
2502a4c35ed2SSteven Rostedt (Red Hat) 	 * Again, normal synchronize_sched() is not good enough.
2503a4c35ed2SSteven Rostedt (Red Hat) 	 * We need to do a hard force of sched synchronization.
2504a4c35ed2SSteven Rostedt (Red Hat) 	 * This is because we use preempt_disable() to do RCU, but
2505a4c35ed2SSteven Rostedt (Red Hat) 	 * the function tracers can be called where RCU is not watching
2506a4c35ed2SSteven Rostedt (Red Hat) 	 * (like before user_exit()). We can not rely on the RCU
2507a4c35ed2SSteven Rostedt (Red Hat) 	 * infrastructure to do the synchronization, thus we must do it
2508a4c35ed2SSteven Rostedt (Red Hat) 	 * ourselves.
2509a4c35ed2SSteven Rostedt (Red Hat) 	 */
2510a4c35ed2SSteven Rostedt (Red Hat) 	if (ops->flags & (FTRACE_OPS_FL_DYNAMIC | FTRACE_OPS_FL_CONTROL)) {
2511a4c35ed2SSteven Rostedt (Red Hat) 		schedule_on_each_cpu(ftrace_sync);
2512a4c35ed2SSteven Rostedt (Red Hat) 
2513a4c35ed2SSteven Rostedt (Red Hat) 		if (ops->flags & FTRACE_OPS_FL_CONTROL)
2514a4c35ed2SSteven Rostedt (Red Hat) 			control_ops_free(ops);
2515a4c35ed2SSteven Rostedt (Red Hat) 	}
2516a4c35ed2SSteven Rostedt (Red Hat) 
25178a56d776SSteven Rostedt (Red Hat) 	return 0;
25183d083395SSteven Rostedt }
25193d083395SSteven Rostedt 
2520e309b41dSIngo Molnar static void ftrace_startup_sysctl(void)
2521b0fc494fSSteven Rostedt {
25224eebcc81SSteven Rostedt 	if (unlikely(ftrace_disabled))
25234eebcc81SSteven Rostedt 		return;
25244eebcc81SSteven Rostedt 
2525d61f82d0SSteven Rostedt 	/* Force update next time */
2526d61f82d0SSteven Rostedt 	saved_ftrace_func = NULL;
252760a7ecf4SSteven Rostedt 	/* ftrace_start_up is true if we want ftrace running */
252860a7ecf4SSteven Rostedt 	if (ftrace_start_up)
252930fb6aa7SJiri Olsa 		ftrace_run_update_code(FTRACE_UPDATE_CALLS);
2530b0fc494fSSteven Rostedt }
2531b0fc494fSSteven Rostedt 
2532e309b41dSIngo Molnar static void ftrace_shutdown_sysctl(void)
2533b0fc494fSSteven Rostedt {
25344eebcc81SSteven Rostedt 	if (unlikely(ftrace_disabled))
25354eebcc81SSteven Rostedt 		return;
25364eebcc81SSteven Rostedt 
253760a7ecf4SSteven Rostedt 	/* ftrace_start_up is true if ftrace is running */
253860a7ecf4SSteven Rostedt 	if (ftrace_start_up)
253979e406d7SSteven Rostedt 		ftrace_run_update_code(FTRACE_DISABLE_CALLS);
2540b0fc494fSSteven Rostedt }
2541b0fc494fSSteven Rostedt 
25423d083395SSteven Rostedt static cycle_t		ftrace_update_time;
25433d083395SSteven Rostedt unsigned long		ftrace_update_tot_cnt;
25443d083395SSteven Rostedt 
25458c4f3c3fSSteven Rostedt (Red Hat) static inline int ops_traces_mod(struct ftrace_ops *ops)
2546f7bc8b61SSteven Rostedt {
25478c4f3c3fSSteven Rostedt (Red Hat) 	/*
25488c4f3c3fSSteven Rostedt (Red Hat) 	 * Filter_hash being empty will default to trace module.
25498c4f3c3fSSteven Rostedt (Red Hat) 	 * But notrace hash requires a test of individual module functions.
25508c4f3c3fSSteven Rostedt (Red Hat) 	 */
255133b7f99cSSteven Rostedt (Red Hat) 	return ftrace_hash_empty(ops->func_hash->filter_hash) &&
255233b7f99cSSteven Rostedt (Red Hat) 		ftrace_hash_empty(ops->func_hash->notrace_hash);
25538c4f3c3fSSteven Rostedt (Red Hat) }
2554f7bc8b61SSteven Rostedt 
25558c4f3c3fSSteven Rostedt (Red Hat) /*
25568c4f3c3fSSteven Rostedt (Red Hat)  * Check if the current ops references the record.
25578c4f3c3fSSteven Rostedt (Red Hat)  *
25588c4f3c3fSSteven Rostedt (Red Hat)  * If the ops traces all functions, then it was already accounted for.
25598c4f3c3fSSteven Rostedt (Red Hat)  * If the ops does not trace the current record function, skip it.
25608c4f3c3fSSteven Rostedt (Red Hat)  * If the ops ignores the function via notrace filter, skip it.
25618c4f3c3fSSteven Rostedt (Red Hat)  */
25628c4f3c3fSSteven Rostedt (Red Hat) static inline bool
25638c4f3c3fSSteven Rostedt (Red Hat) ops_references_rec(struct ftrace_ops *ops, struct dyn_ftrace *rec)
25648c4f3c3fSSteven Rostedt (Red Hat) {
25658c4f3c3fSSteven Rostedt (Red Hat) 	/* If ops isn't enabled, ignore it */
25668c4f3c3fSSteven Rostedt (Red Hat) 	if (!(ops->flags & FTRACE_OPS_FL_ENABLED))
25678c4f3c3fSSteven Rostedt (Red Hat) 		return 0;
25688c4f3c3fSSteven Rostedt (Red Hat) 
25698c4f3c3fSSteven Rostedt (Red Hat) 	/* If ops traces all mods, we already accounted for it */
25708c4f3c3fSSteven Rostedt (Red Hat) 	if (ops_traces_mod(ops))
25718c4f3c3fSSteven Rostedt (Red Hat) 		return 0;
25728c4f3c3fSSteven Rostedt (Red Hat) 
25738c4f3c3fSSteven Rostedt (Red Hat) 	/* The function must be in the filter */
257433b7f99cSSteven Rostedt (Red Hat) 	if (!ftrace_hash_empty(ops->func_hash->filter_hash) &&
257533b7f99cSSteven Rostedt (Red Hat) 	    !ftrace_lookup_ip(ops->func_hash->filter_hash, rec->ip))
25768c4f3c3fSSteven Rostedt (Red Hat) 		return 0;
25778c4f3c3fSSteven Rostedt (Red Hat) 
25788c4f3c3fSSteven Rostedt (Red Hat) 	/* If in notrace hash, we ignore it too */
257933b7f99cSSteven Rostedt (Red Hat) 	if (ftrace_lookup_ip(ops->func_hash->notrace_hash, rec->ip))
25808c4f3c3fSSteven Rostedt (Red Hat) 		return 0;
25818c4f3c3fSSteven Rostedt (Red Hat) 
25828c4f3c3fSSteven Rostedt (Red Hat) 	return 1;
25838c4f3c3fSSteven Rostedt (Red Hat) }
25848c4f3c3fSSteven Rostedt (Red Hat) 
25858c4f3c3fSSteven Rostedt (Red Hat) static int referenced_filters(struct dyn_ftrace *rec)
25868c4f3c3fSSteven Rostedt (Red Hat) {
25878c4f3c3fSSteven Rostedt (Red Hat) 	struct ftrace_ops *ops;
25888c4f3c3fSSteven Rostedt (Red Hat) 	int cnt = 0;
25898c4f3c3fSSteven Rostedt (Red Hat) 
25908c4f3c3fSSteven Rostedt (Red Hat) 	for (ops = ftrace_ops_list; ops != &ftrace_list_end; ops = ops->next) {
25918c4f3c3fSSteven Rostedt (Red Hat) 		if (ops_references_rec(ops, rec))
25928c4f3c3fSSteven Rostedt (Red Hat) 		    cnt++;
25938c4f3c3fSSteven Rostedt (Red Hat) 	}
25948c4f3c3fSSteven Rostedt (Red Hat) 
25958c4f3c3fSSteven Rostedt (Red Hat) 	return cnt;
2596f7bc8b61SSteven Rostedt }
2597f7bc8b61SSteven Rostedt 
25981dc43cf0SJiri Slaby static int ftrace_update_code(struct module *mod, struct ftrace_page *new_pgs)
25993d083395SSteven Rostedt {
260085ae32aeSSteven Rostedt 	struct ftrace_page *pg;
2601e94142a6SLai Jiangshan 	struct dyn_ftrace *p;
2602f22f9a89SAbhishek Sagar 	cycle_t start, stop;
26031dc43cf0SJiri Slaby 	unsigned long update_cnt = 0;
2604f7bc8b61SSteven Rostedt 	unsigned long ref = 0;
26058c4f3c3fSSteven Rostedt (Red Hat) 	bool test = false;
260685ae32aeSSteven Rostedt 	int i;
2607f7bc8b61SSteven Rostedt 
2608f7bc8b61SSteven Rostedt 	/*
2609f7bc8b61SSteven Rostedt 	 * When adding a module, we need to check if tracers are
2610f7bc8b61SSteven Rostedt 	 * currently enabled and if they are set to trace all functions.
2611f7bc8b61SSteven Rostedt 	 * If they are, we need to enable the module functions as well
2612f7bc8b61SSteven Rostedt 	 * as update the reference counts for those function records.
2613f7bc8b61SSteven Rostedt 	 */
2614f7bc8b61SSteven Rostedt 	if (mod) {
2615f7bc8b61SSteven Rostedt 		struct ftrace_ops *ops;
2616f7bc8b61SSteven Rostedt 
2617f7bc8b61SSteven Rostedt 		for (ops = ftrace_ops_list;
2618f7bc8b61SSteven Rostedt 		     ops != &ftrace_list_end; ops = ops->next) {
26198c4f3c3fSSteven Rostedt (Red Hat) 			if (ops->flags & FTRACE_OPS_FL_ENABLED) {
26208c4f3c3fSSteven Rostedt (Red Hat) 				if (ops_traces_mod(ops))
2621f7bc8b61SSteven Rostedt 					ref++;
26228c4f3c3fSSteven Rostedt (Red Hat) 				else
26238c4f3c3fSSteven Rostedt (Red Hat) 					test = true;
26248c4f3c3fSSteven Rostedt (Red Hat) 			}
2625f7bc8b61SSteven Rostedt 		}
2626f7bc8b61SSteven Rostedt 	}
26273d083395SSteven Rostedt 
2628750ed1a4SIngo Molnar 	start = ftrace_now(raw_smp_processor_id());
26293d083395SSteven Rostedt 
26301dc43cf0SJiri Slaby 	for (pg = new_pgs; pg; pg = pg->next) {
2631f22f9a89SAbhishek Sagar 
263285ae32aeSSteven Rostedt 		for (i = 0; i < pg->index; i++) {
26338c4f3c3fSSteven Rostedt (Red Hat) 			int cnt = ref;
26348c4f3c3fSSteven Rostedt (Red Hat) 
263508f5ac90SSteven Rostedt 			/* If something went wrong, bail without enabling anything */
263608f5ac90SSteven Rostedt 			if (unlikely(ftrace_disabled))
263708f5ac90SSteven Rostedt 				return -1;
26383d083395SSteven Rostedt 
263985ae32aeSSteven Rostedt 			p = &pg->records[i];
26408c4f3c3fSSteven Rostedt (Red Hat) 			if (test)
26418c4f3c3fSSteven Rostedt (Red Hat) 				cnt += referenced_filters(p);
26428c4f3c3fSSteven Rostedt (Red Hat) 			p->flags = cnt;
2643f22f9a89SAbhishek Sagar 
26445cb084bbSJiri Olsa 			/*
264525985edcSLucas De Marchi 			 * Do the initial record conversion from mcount jump
26465cb084bbSJiri Olsa 			 * to the NOP instructions.
26475cb084bbSJiri Olsa 			 */
264832082309SSteven Rostedt 			if (!ftrace_code_disable(mod, p))
2649d2c8c3eaSSteven Rostedt 				break;
26505cb084bbSJiri Olsa 
26511dc43cf0SJiri Slaby 			update_cnt++;
26525cb084bbSJiri Olsa 
26535cb084bbSJiri Olsa 			/*
26545cb084bbSJiri Olsa 			 * If the tracing is enabled, go ahead and enable the record.
26555cb084bbSJiri Olsa 			 *
26565cb084bbSJiri Olsa 			 * The reason not to enable the record immediatelly is the
26575cb084bbSJiri Olsa 			 * inherent check of ftrace_make_nop/ftrace_make_call for
26585cb084bbSJiri Olsa 			 * correct previous instructions.  Making first the NOP
26595cb084bbSJiri Olsa 			 * conversion puts the module to the correct state, thus
26605cb084bbSJiri Olsa 			 * passing the ftrace_make_call check.
26615cb084bbSJiri Olsa 			 */
26628c4f3c3fSSteven Rostedt (Red Hat) 			if (ftrace_start_up && cnt) {
26635cb084bbSJiri Olsa 				int failed = __ftrace_replace_code(p, 1);
266432082309SSteven Rostedt 				if (failed)
26655cb084bbSJiri Olsa 					ftrace_bug(failed, p->ip);
26665cb084bbSJiri Olsa 			}
26675cb084bbSJiri Olsa 		}
266885ae32aeSSteven Rostedt 	}
266985ae32aeSSteven Rostedt 
2670750ed1a4SIngo Molnar 	stop = ftrace_now(raw_smp_processor_id());
26713d083395SSteven Rostedt 	ftrace_update_time = stop - start;
26721dc43cf0SJiri Slaby 	ftrace_update_tot_cnt += update_cnt;
26733d083395SSteven Rostedt 
267416444a8aSArnaldo Carvalho de Melo 	return 0;
267516444a8aSArnaldo Carvalho de Melo }
267616444a8aSArnaldo Carvalho de Melo 
2677a7900875SSteven Rostedt static int ftrace_allocate_records(struct ftrace_page *pg, int count)
26783c1720f0SSteven Rostedt {
2679a7900875SSteven Rostedt 	int order;
26803c1720f0SSteven Rostedt 	int cnt;
26813c1720f0SSteven Rostedt 
2682a7900875SSteven Rostedt 	if (WARN_ON(!count))
2683a7900875SSteven Rostedt 		return -EINVAL;
2684a7900875SSteven Rostedt 
2685a7900875SSteven Rostedt 	order = get_count_order(DIV_ROUND_UP(count, ENTRIES_PER_PAGE));
26863c1720f0SSteven Rostedt 
26873c1720f0SSteven Rostedt 	/*
2688a7900875SSteven Rostedt 	 * We want to fill as much as possible. No more than a page
2689a7900875SSteven Rostedt 	 * may be empty.
26903c1720f0SSteven Rostedt 	 */
2691a7900875SSteven Rostedt 	while ((PAGE_SIZE << order) / ENTRY_SIZE >= count + ENTRIES_PER_PAGE)
2692a7900875SSteven Rostedt 		order--;
26933c1720f0SSteven Rostedt 
2694a7900875SSteven Rostedt  again:
2695a7900875SSteven Rostedt 	pg->records = (void *)__get_free_pages(GFP_KERNEL | __GFP_ZERO, order);
2696a7900875SSteven Rostedt 
2697a7900875SSteven Rostedt 	if (!pg->records) {
2698a7900875SSteven Rostedt 		/* if we can't allocate this size, try something smaller */
2699a7900875SSteven Rostedt 		if (!order)
2700a7900875SSteven Rostedt 			return -ENOMEM;
2701a7900875SSteven Rostedt 		order >>= 1;
2702a7900875SSteven Rostedt 		goto again;
2703a7900875SSteven Rostedt 	}
2704a7900875SSteven Rostedt 
2705a7900875SSteven Rostedt 	cnt = (PAGE_SIZE << order) / ENTRY_SIZE;
2706a7900875SSteven Rostedt 	pg->size = cnt;
2707a7900875SSteven Rostedt 
2708a7900875SSteven Rostedt 	if (cnt > count)
2709a7900875SSteven Rostedt 		cnt = count;
2710a7900875SSteven Rostedt 
2711a7900875SSteven Rostedt 	return cnt;
2712a7900875SSteven Rostedt }
2713a7900875SSteven Rostedt 
2714a7900875SSteven Rostedt static struct ftrace_page *
2715a7900875SSteven Rostedt ftrace_allocate_pages(unsigned long num_to_init)
2716a7900875SSteven Rostedt {
2717a7900875SSteven Rostedt 	struct ftrace_page *start_pg;
2718a7900875SSteven Rostedt 	struct ftrace_page *pg;
2719a7900875SSteven Rostedt 	int order;
2720a7900875SSteven Rostedt 	int cnt;
2721a7900875SSteven Rostedt 
2722a7900875SSteven Rostedt 	if (!num_to_init)
2723a7900875SSteven Rostedt 		return 0;
2724a7900875SSteven Rostedt 
2725a7900875SSteven Rostedt 	start_pg = pg = kzalloc(sizeof(*pg), GFP_KERNEL);
2726a7900875SSteven Rostedt 	if (!pg)
2727a7900875SSteven Rostedt 		return NULL;
2728a7900875SSteven Rostedt 
2729a7900875SSteven Rostedt 	/*
2730a7900875SSteven Rostedt 	 * Try to allocate as much as possible in one continues
2731a7900875SSteven Rostedt 	 * location that fills in all of the space. We want to
2732a7900875SSteven Rostedt 	 * waste as little space as possible.
2733a7900875SSteven Rostedt 	 */
2734a7900875SSteven Rostedt 	for (;;) {
2735a7900875SSteven Rostedt 		cnt = ftrace_allocate_records(pg, num_to_init);
2736a7900875SSteven Rostedt 		if (cnt < 0)
2737a7900875SSteven Rostedt 			goto free_pages;
2738a7900875SSteven Rostedt 
2739a7900875SSteven Rostedt 		num_to_init -= cnt;
2740a7900875SSteven Rostedt 		if (!num_to_init)
2741a7900875SSteven Rostedt 			break;
2742a7900875SSteven Rostedt 
2743a7900875SSteven Rostedt 		pg->next = kzalloc(sizeof(*pg), GFP_KERNEL);
2744a7900875SSteven Rostedt 		if (!pg->next)
2745a7900875SSteven Rostedt 			goto free_pages;
2746a7900875SSteven Rostedt 
2747a7900875SSteven Rostedt 		pg = pg->next;
2748a7900875SSteven Rostedt 	}
2749a7900875SSteven Rostedt 
2750a7900875SSteven Rostedt 	return start_pg;
2751a7900875SSteven Rostedt 
2752a7900875SSteven Rostedt  free_pages:
27531f61be00SNamhyung Kim 	pg = start_pg;
27541f61be00SNamhyung Kim 	while (pg) {
2755a7900875SSteven Rostedt 		order = get_count_order(pg->size / ENTRIES_PER_PAGE);
2756a7900875SSteven Rostedt 		free_pages((unsigned long)pg->records, order);
2757a7900875SSteven Rostedt 		start_pg = pg->next;
2758a7900875SSteven Rostedt 		kfree(pg);
2759a7900875SSteven Rostedt 		pg = start_pg;
2760a7900875SSteven Rostedt 	}
2761a7900875SSteven Rostedt 	pr_info("ftrace: FAILED to allocate memory for functions\n");
2762a7900875SSteven Rostedt 	return NULL;
2763a7900875SSteven Rostedt }
2764a7900875SSteven Rostedt 
27655072c59fSSteven Rostedt #define FTRACE_BUFF_MAX (KSYM_SYMBOL_LEN+4) /* room for wildcards */
27665072c59fSSteven Rostedt 
27675072c59fSSteven Rostedt struct ftrace_iterator {
276898c4fd04SSteven Rostedt 	loff_t				pos;
27692bccfffdSSteven Rostedt 	loff_t				func_pos;
27705072c59fSSteven Rostedt 	struct ftrace_page		*pg;
27714aeb6967SSteven Rostedt 	struct dyn_ftrace		*func;
27724aeb6967SSteven Rostedt 	struct ftrace_func_probe	*probe;
27734aeb6967SSteven Rostedt 	struct trace_parser		parser;
27741cf41dd7SSteven Rostedt 	struct ftrace_hash		*hash;
277533dc9b12SSteven Rostedt 	struct ftrace_ops		*ops;
27768fc0c701SSteven Rostedt 	int				hidx;
2777431aa3fbSSteven Rostedt 	int				idx;
27785072c59fSSteven Rostedt 	unsigned			flags;
27795072c59fSSteven Rostedt };
27805072c59fSSteven Rostedt 
2781e309b41dSIngo Molnar static void *
27824aeb6967SSteven Rostedt t_hash_next(struct seq_file *m, loff_t *pos)
27838fc0c701SSteven Rostedt {
27848fc0c701SSteven Rostedt 	struct ftrace_iterator *iter = m->private;
27854aeb6967SSteven Rostedt 	struct hlist_node *hnd = NULL;
27868fc0c701SSteven Rostedt 	struct hlist_head *hhd;
27878fc0c701SSteven Rostedt 
27888fc0c701SSteven Rostedt 	(*pos)++;
278998c4fd04SSteven Rostedt 	iter->pos = *pos;
27908fc0c701SSteven Rostedt 
27914aeb6967SSteven Rostedt 	if (iter->probe)
27924aeb6967SSteven Rostedt 		hnd = &iter->probe->node;
27938fc0c701SSteven Rostedt  retry:
27948fc0c701SSteven Rostedt 	if (iter->hidx >= FTRACE_FUNC_HASHSIZE)
27958fc0c701SSteven Rostedt 		return NULL;
27968fc0c701SSteven Rostedt 
27978fc0c701SSteven Rostedt 	hhd = &ftrace_func_hash[iter->hidx];
27988fc0c701SSteven Rostedt 
27998fc0c701SSteven Rostedt 	if (hlist_empty(hhd)) {
28008fc0c701SSteven Rostedt 		iter->hidx++;
28018fc0c701SSteven Rostedt 		hnd = NULL;
28028fc0c701SSteven Rostedt 		goto retry;
28038fc0c701SSteven Rostedt 	}
28048fc0c701SSteven Rostedt 
28058fc0c701SSteven Rostedt 	if (!hnd)
28068fc0c701SSteven Rostedt 		hnd = hhd->first;
28078fc0c701SSteven Rostedt 	else {
28088fc0c701SSteven Rostedt 		hnd = hnd->next;
28098fc0c701SSteven Rostedt 		if (!hnd) {
28108fc0c701SSteven Rostedt 			iter->hidx++;
28118fc0c701SSteven Rostedt 			goto retry;
28128fc0c701SSteven Rostedt 		}
28138fc0c701SSteven Rostedt 	}
28148fc0c701SSteven Rostedt 
28154aeb6967SSteven Rostedt 	if (WARN_ON_ONCE(!hnd))
28164aeb6967SSteven Rostedt 		return NULL;
28174aeb6967SSteven Rostedt 
28184aeb6967SSteven Rostedt 	iter->probe = hlist_entry(hnd, struct ftrace_func_probe, node);
28194aeb6967SSteven Rostedt 
28204aeb6967SSteven Rostedt 	return iter;
28218fc0c701SSteven Rostedt }
28228fc0c701SSteven Rostedt 
28238fc0c701SSteven Rostedt static void *t_hash_start(struct seq_file *m, loff_t *pos)
28248fc0c701SSteven Rostedt {
28258fc0c701SSteven Rostedt 	struct ftrace_iterator *iter = m->private;
28268fc0c701SSteven Rostedt 	void *p = NULL;
2827d82d6244SLi Zefan 	loff_t l;
2828d82d6244SLi Zefan 
282969a3083cSSteven Rostedt 	if (!(iter->flags & FTRACE_ITER_DO_HASH))
283069a3083cSSteven Rostedt 		return NULL;
283169a3083cSSteven Rostedt 
28322bccfffdSSteven Rostedt 	if (iter->func_pos > *pos)
28332bccfffdSSteven Rostedt 		return NULL;
28348fc0c701SSteven Rostedt 
2835d82d6244SLi Zefan 	iter->hidx = 0;
28362bccfffdSSteven Rostedt 	for (l = 0; l <= (*pos - iter->func_pos); ) {
28374aeb6967SSteven Rostedt 		p = t_hash_next(m, &l);
2838d82d6244SLi Zefan 		if (!p)
2839d82d6244SLi Zefan 			break;
2840d82d6244SLi Zefan 	}
28414aeb6967SSteven Rostedt 	if (!p)
28424aeb6967SSteven Rostedt 		return NULL;
28434aeb6967SSteven Rostedt 
284498c4fd04SSteven Rostedt 	/* Only set this if we have an item */
284598c4fd04SSteven Rostedt 	iter->flags |= FTRACE_ITER_HASH;
284698c4fd04SSteven Rostedt 
28474aeb6967SSteven Rostedt 	return iter;
28488fc0c701SSteven Rostedt }
28498fc0c701SSteven Rostedt 
28504aeb6967SSteven Rostedt static int
28514aeb6967SSteven Rostedt t_hash_show(struct seq_file *m, struct ftrace_iterator *iter)
28528fc0c701SSteven Rostedt {
2853b6887d79SSteven Rostedt 	struct ftrace_func_probe *rec;
28548fc0c701SSteven Rostedt 
28554aeb6967SSteven Rostedt 	rec = iter->probe;
28564aeb6967SSteven Rostedt 	if (WARN_ON_ONCE(!rec))
28574aeb6967SSteven Rostedt 		return -EIO;
28588fc0c701SSteven Rostedt 
2859809dcf29SSteven Rostedt 	if (rec->ops->print)
2860809dcf29SSteven Rostedt 		return rec->ops->print(m, rec->ip, rec->ops, rec->data);
2861809dcf29SSteven Rostedt 
2862b375a11aSSteven Rostedt 	seq_printf(m, "%ps:%ps", (void *)rec->ip, (void *)rec->ops->func);
28638fc0c701SSteven Rostedt 
28648fc0c701SSteven Rostedt 	if (rec->data)
28658fc0c701SSteven Rostedt 		seq_printf(m, ":%p", rec->data);
28668fc0c701SSteven Rostedt 	seq_putc(m, '\n');
28678fc0c701SSteven Rostedt 
28688fc0c701SSteven Rostedt 	return 0;
28698fc0c701SSteven Rostedt }
28708fc0c701SSteven Rostedt 
28718fc0c701SSteven Rostedt static void *
28725072c59fSSteven Rostedt t_next(struct seq_file *m, void *v, loff_t *pos)
28735072c59fSSteven Rostedt {
28745072c59fSSteven Rostedt 	struct ftrace_iterator *iter = m->private;
2875fc13cb0cSSteven Rostedt 	struct ftrace_ops *ops = iter->ops;
28765072c59fSSteven Rostedt 	struct dyn_ftrace *rec = NULL;
28775072c59fSSteven Rostedt 
287845a4a237SSteven Rostedt 	if (unlikely(ftrace_disabled))
287945a4a237SSteven Rostedt 		return NULL;
288045a4a237SSteven Rostedt 
28818fc0c701SSteven Rostedt 	if (iter->flags & FTRACE_ITER_HASH)
28824aeb6967SSteven Rostedt 		return t_hash_next(m, pos);
28838fc0c701SSteven Rostedt 
28845072c59fSSteven Rostedt 	(*pos)++;
28851106b699SJiri Olsa 	iter->pos = iter->func_pos = *pos;
28865072c59fSSteven Rostedt 
28870c75a3edSSteven Rostedt 	if (iter->flags & FTRACE_ITER_PRINTALL)
288857c072c7SSteven Rostedt 		return t_hash_start(m, pos);
28890c75a3edSSteven Rostedt 
28905072c59fSSteven Rostedt  retry:
28915072c59fSSteven Rostedt 	if (iter->idx >= iter->pg->index) {
28925072c59fSSteven Rostedt 		if (iter->pg->next) {
28935072c59fSSteven Rostedt 			iter->pg = iter->pg->next;
28945072c59fSSteven Rostedt 			iter->idx = 0;
28955072c59fSSteven Rostedt 			goto retry;
28965072c59fSSteven Rostedt 		}
28975072c59fSSteven Rostedt 	} else {
28985072c59fSSteven Rostedt 		rec = &iter->pg->records[iter->idx++];
289932082309SSteven Rostedt 		if (((iter->flags & FTRACE_ITER_FILTER) &&
290033b7f99cSSteven Rostedt (Red Hat) 		     !(ftrace_lookup_ip(ops->func_hash->filter_hash, rec->ip))) ||
29010183fb1cSSteven Rostedt 
290241c52c0dSSteven Rostedt 		    ((iter->flags & FTRACE_ITER_NOTRACE) &&
290333b7f99cSSteven Rostedt (Red Hat) 		     !ftrace_lookup_ip(ops->func_hash->notrace_hash, rec->ip)) ||
2904647bcd03SSteven Rostedt 
2905647bcd03SSteven Rostedt 		    ((iter->flags & FTRACE_ITER_ENABLED) &&
290623ea9c4dSSteven Rostedt (Red Hat) 		     !(rec->flags & FTRACE_FL_ENABLED))) {
2907647bcd03SSteven Rostedt 
29085072c59fSSteven Rostedt 			rec = NULL;
29095072c59fSSteven Rostedt 			goto retry;
29105072c59fSSteven Rostedt 		}
29115072c59fSSteven Rostedt 	}
29125072c59fSSteven Rostedt 
29134aeb6967SSteven Rostedt 	if (!rec)
291457c072c7SSteven Rostedt 		return t_hash_start(m, pos);
29154aeb6967SSteven Rostedt 
29164aeb6967SSteven Rostedt 	iter->func = rec;
29174aeb6967SSteven Rostedt 
29184aeb6967SSteven Rostedt 	return iter;
29195072c59fSSteven Rostedt }
29205072c59fSSteven Rostedt 
292198c4fd04SSteven Rostedt static void reset_iter_read(struct ftrace_iterator *iter)
292298c4fd04SSteven Rostedt {
292398c4fd04SSteven Rostedt 	iter->pos = 0;
292498c4fd04SSteven Rostedt 	iter->func_pos = 0;
292570f77b3fSDan Carpenter 	iter->flags &= ~(FTRACE_ITER_PRINTALL | FTRACE_ITER_HASH);
29265072c59fSSteven Rostedt }
29275072c59fSSteven Rostedt 
29285072c59fSSteven Rostedt static void *t_start(struct seq_file *m, loff_t *pos)
29295072c59fSSteven Rostedt {
29305072c59fSSteven Rostedt 	struct ftrace_iterator *iter = m->private;
2931fc13cb0cSSteven Rostedt 	struct ftrace_ops *ops = iter->ops;
29325072c59fSSteven Rostedt 	void *p = NULL;
2933694ce0a5SLi Zefan 	loff_t l;
29345072c59fSSteven Rostedt 
29358fc0c701SSteven Rostedt 	mutex_lock(&ftrace_lock);
293645a4a237SSteven Rostedt 
293745a4a237SSteven Rostedt 	if (unlikely(ftrace_disabled))
293845a4a237SSteven Rostedt 		return NULL;
293945a4a237SSteven Rostedt 
29400c75a3edSSteven Rostedt 	/*
294198c4fd04SSteven Rostedt 	 * If an lseek was done, then reset and start from beginning.
294298c4fd04SSteven Rostedt 	 */
294398c4fd04SSteven Rostedt 	if (*pos < iter->pos)
294498c4fd04SSteven Rostedt 		reset_iter_read(iter);
294598c4fd04SSteven Rostedt 
294698c4fd04SSteven Rostedt 	/*
29470c75a3edSSteven Rostedt 	 * For set_ftrace_filter reading, if we have the filter
29480c75a3edSSteven Rostedt 	 * off, we can short cut and just print out that all
29490c75a3edSSteven Rostedt 	 * functions are enabled.
29500c75a3edSSteven Rostedt 	 */
29518c006cf7SNamhyung Kim 	if ((iter->flags & FTRACE_ITER_FILTER &&
295233b7f99cSSteven Rostedt (Red Hat) 	     ftrace_hash_empty(ops->func_hash->filter_hash)) ||
29538c006cf7SNamhyung Kim 	    (iter->flags & FTRACE_ITER_NOTRACE &&
295433b7f99cSSteven Rostedt (Red Hat) 	     ftrace_hash_empty(ops->func_hash->notrace_hash))) {
29550c75a3edSSteven Rostedt 		if (*pos > 0)
29568fc0c701SSteven Rostedt 			return t_hash_start(m, pos);
29570c75a3edSSteven Rostedt 		iter->flags |= FTRACE_ITER_PRINTALL;
2958df091625SChris Wright 		/* reset in case of seek/pread */
2959df091625SChris Wright 		iter->flags &= ~FTRACE_ITER_HASH;
29600c75a3edSSteven Rostedt 		return iter;
29610c75a3edSSteven Rostedt 	}
29620c75a3edSSteven Rostedt 
29638fc0c701SSteven Rostedt 	if (iter->flags & FTRACE_ITER_HASH)
29648fc0c701SSteven Rostedt 		return t_hash_start(m, pos);
29658fc0c701SSteven Rostedt 
296698c4fd04SSteven Rostedt 	/*
296798c4fd04SSteven Rostedt 	 * Unfortunately, we need to restart at ftrace_pages_start
296898c4fd04SSteven Rostedt 	 * every time we let go of the ftrace_mutex. This is because
296998c4fd04SSteven Rostedt 	 * those pointers can change without the lock.
297098c4fd04SSteven Rostedt 	 */
2971694ce0a5SLi Zefan 	iter->pg = ftrace_pages_start;
2972694ce0a5SLi Zefan 	iter->idx = 0;
2973694ce0a5SLi Zefan 	for (l = 0; l <= *pos; ) {
2974694ce0a5SLi Zefan 		p = t_next(m, p, &l);
2975694ce0a5SLi Zefan 		if (!p)
2976694ce0a5SLi Zefan 			break;
297750cdaf08SLiming Wang 	}
29785821e1b7Swalimis 
297969a3083cSSteven Rostedt 	if (!p)
29808fc0c701SSteven Rostedt 		return t_hash_start(m, pos);
29818fc0c701SSteven Rostedt 
29824aeb6967SSteven Rostedt 	return iter;
29835072c59fSSteven Rostedt }
29845072c59fSSteven Rostedt 
29855072c59fSSteven Rostedt static void t_stop(struct seq_file *m, void *p)
29865072c59fSSteven Rostedt {
29878fc0c701SSteven Rostedt 	mutex_unlock(&ftrace_lock);
29885072c59fSSteven Rostedt }
29895072c59fSSteven Rostedt 
29905072c59fSSteven Rostedt static int t_show(struct seq_file *m, void *v)
29915072c59fSSteven Rostedt {
29920c75a3edSSteven Rostedt 	struct ftrace_iterator *iter = m->private;
29934aeb6967SSteven Rostedt 	struct dyn_ftrace *rec;
29945072c59fSSteven Rostedt 
29958fc0c701SSteven Rostedt 	if (iter->flags & FTRACE_ITER_HASH)
29964aeb6967SSteven Rostedt 		return t_hash_show(m, iter);
29978fc0c701SSteven Rostedt 
29980c75a3edSSteven Rostedt 	if (iter->flags & FTRACE_ITER_PRINTALL) {
29998c006cf7SNamhyung Kim 		if (iter->flags & FTRACE_ITER_NOTRACE)
30008c006cf7SNamhyung Kim 			seq_printf(m, "#### no functions disabled ####\n");
30018c006cf7SNamhyung Kim 		else
30020c75a3edSSteven Rostedt 			seq_printf(m, "#### all functions enabled ####\n");
30030c75a3edSSteven Rostedt 		return 0;
30040c75a3edSSteven Rostedt 	}
30050c75a3edSSteven Rostedt 
30064aeb6967SSteven Rostedt 	rec = iter->func;
30074aeb6967SSteven Rostedt 
30085072c59fSSteven Rostedt 	if (!rec)
30095072c59fSSteven Rostedt 		return 0;
30105072c59fSSteven Rostedt 
3011647bcd03SSteven Rostedt 	seq_printf(m, "%ps", (void *)rec->ip);
30129674b2faSSteven Rostedt (Red Hat) 	if (iter->flags & FTRACE_ITER_ENABLED) {
301308f6fba5SSteven Rostedt 		seq_printf(m, " (%ld)%s",
30140376bde1SSteven Rostedt (Red Hat) 			   ftrace_rec_count(rec),
301508f6fba5SSteven Rostedt 			   rec->flags & FTRACE_FL_REGS ? " R" : "  ");
30169674b2faSSteven Rostedt (Red Hat) 		if (rec->flags & FTRACE_FL_TRAMP_EN) {
30179674b2faSSteven Rostedt (Red Hat) 			struct ftrace_ops *ops;
30189674b2faSSteven Rostedt (Red Hat) 
30195fecaa04SSteven Rostedt (Red Hat) 			ops = ftrace_find_tramp_ops_any(rec);
30209674b2faSSteven Rostedt (Red Hat) 			if (ops && ops->trampoline)
30219674b2faSSteven Rostedt (Red Hat) 				seq_printf(m, "\ttramp: %pS",
30229674b2faSSteven Rostedt (Red Hat) 					   (void *)ops->trampoline);
30239674b2faSSteven Rostedt (Red Hat) 			else
30249674b2faSSteven Rostedt (Red Hat) 				seq_printf(m, "\ttramp: ERROR!");
30259674b2faSSteven Rostedt (Red Hat) 		}
30269674b2faSSteven Rostedt (Red Hat) 	}
30279674b2faSSteven Rostedt (Red Hat) 
3028647bcd03SSteven Rostedt 	seq_printf(m, "\n");
30295072c59fSSteven Rostedt 
30305072c59fSSteven Rostedt 	return 0;
30315072c59fSSteven Rostedt }
30325072c59fSSteven Rostedt 
303388e9d34cSJames Morris static const struct seq_operations show_ftrace_seq_ops = {
30345072c59fSSteven Rostedt 	.start = t_start,
30355072c59fSSteven Rostedt 	.next = t_next,
30365072c59fSSteven Rostedt 	.stop = t_stop,
30375072c59fSSteven Rostedt 	.show = t_show,
30385072c59fSSteven Rostedt };
30395072c59fSSteven Rostedt 
3040e309b41dSIngo Molnar static int
30415072c59fSSteven Rostedt ftrace_avail_open(struct inode *inode, struct file *file)
30425072c59fSSteven Rostedt {
30435072c59fSSteven Rostedt 	struct ftrace_iterator *iter;
30445072c59fSSteven Rostedt 
30454eebcc81SSteven Rostedt 	if (unlikely(ftrace_disabled))
30464eebcc81SSteven Rostedt 		return -ENODEV;
30474eebcc81SSteven Rostedt 
304850e18b94SJiri Olsa 	iter = __seq_open_private(file, &show_ftrace_seq_ops, sizeof(*iter));
304950e18b94SJiri Olsa 	if (iter) {
30505072c59fSSteven Rostedt 		iter->pg = ftrace_pages_start;
3051fc13cb0cSSteven Rostedt 		iter->ops = &global_ops;
30524bf39a94SIngo Molnar 	}
30535072c59fSSteven Rostedt 
305450e18b94SJiri Olsa 	return iter ? 0 : -ENOMEM;
30555072c59fSSteven Rostedt }
30565072c59fSSteven Rostedt 
3057647bcd03SSteven Rostedt static int
3058647bcd03SSteven Rostedt ftrace_enabled_open(struct inode *inode, struct file *file)
3059647bcd03SSteven Rostedt {
3060647bcd03SSteven Rostedt 	struct ftrace_iterator *iter;
3061647bcd03SSteven Rostedt 
3062647bcd03SSteven Rostedt 	if (unlikely(ftrace_disabled))
3063647bcd03SSteven Rostedt 		return -ENODEV;
3064647bcd03SSteven Rostedt 
306550e18b94SJiri Olsa 	iter = __seq_open_private(file, &show_ftrace_seq_ops, sizeof(*iter));
306650e18b94SJiri Olsa 	if (iter) {
3067647bcd03SSteven Rostedt 		iter->pg = ftrace_pages_start;
3068647bcd03SSteven Rostedt 		iter->flags = FTRACE_ITER_ENABLED;
3069fc13cb0cSSteven Rostedt 		iter->ops = &global_ops;
3070647bcd03SSteven Rostedt 	}
3071647bcd03SSteven Rostedt 
307250e18b94SJiri Olsa 	return iter ? 0 : -ENOMEM;
3073647bcd03SSteven Rostedt }
3074647bcd03SSteven Rostedt 
3075fc13cb0cSSteven Rostedt /**
3076fc13cb0cSSteven Rostedt  * ftrace_regex_open - initialize function tracer filter files
3077fc13cb0cSSteven Rostedt  * @ops: The ftrace_ops that hold the hash filters
3078fc13cb0cSSteven Rostedt  * @flag: The type of filter to process
3079fc13cb0cSSteven Rostedt  * @inode: The inode, usually passed in to your open routine
3080fc13cb0cSSteven Rostedt  * @file: The file, usually passed in to your open routine
3081fc13cb0cSSteven Rostedt  *
3082fc13cb0cSSteven Rostedt  * ftrace_regex_open() initializes the filter files for the
3083fc13cb0cSSteven Rostedt  * @ops. Depending on @flag it may process the filter hash or
3084fc13cb0cSSteven Rostedt  * the notrace hash of @ops. With this called from the open
3085fc13cb0cSSteven Rostedt  * routine, you can use ftrace_filter_write() for the write
3086fc13cb0cSSteven Rostedt  * routine if @flag has FTRACE_ITER_FILTER set, or
3087fc13cb0cSSteven Rostedt  * ftrace_notrace_write() if @flag has FTRACE_ITER_NOTRACE set.
3088098c879eSSteven Rostedt (Red Hat)  * tracing_lseek() should be used as the lseek routine, and
3089fc13cb0cSSteven Rostedt  * release must call ftrace_regex_release().
3090fc13cb0cSSteven Rostedt  */
3091fc13cb0cSSteven Rostedt int
3092f45948e8SSteven Rostedt ftrace_regex_open(struct ftrace_ops *ops, int flag,
30931cf41dd7SSteven Rostedt 		  struct inode *inode, struct file *file)
30945072c59fSSteven Rostedt {
30955072c59fSSteven Rostedt 	struct ftrace_iterator *iter;
3096f45948e8SSteven Rostedt 	struct ftrace_hash *hash;
30975072c59fSSteven Rostedt 	int ret = 0;
30985072c59fSSteven Rostedt 
3099f04f24fbSMasami Hiramatsu 	ftrace_ops_init(ops);
3100f04f24fbSMasami Hiramatsu 
31014eebcc81SSteven Rostedt 	if (unlikely(ftrace_disabled))
31024eebcc81SSteven Rostedt 		return -ENODEV;
31034eebcc81SSteven Rostedt 
31045072c59fSSteven Rostedt 	iter = kzalloc(sizeof(*iter), GFP_KERNEL);
31055072c59fSSteven Rostedt 	if (!iter)
31065072c59fSSteven Rostedt 		return -ENOMEM;
31075072c59fSSteven Rostedt 
3108689fd8b6S[email protected] 	if (trace_parser_get_init(&iter->parser, FTRACE_BUFF_MAX)) {
3109689fd8b6S[email protected] 		kfree(iter);
3110689fd8b6S[email protected] 		return -ENOMEM;
3111689fd8b6S[email protected] 	}
3112689fd8b6S[email protected] 
31133f2367baSMasami Hiramatsu 	iter->ops = ops;
31143f2367baSMasami Hiramatsu 	iter->flags = flag;
31153f2367baSMasami Hiramatsu 
311633b7f99cSSteven Rostedt (Red Hat) 	mutex_lock(&ops->func_hash->regex_lock);
31173f2367baSMasami Hiramatsu 
3118f45948e8SSteven Rostedt 	if (flag & FTRACE_ITER_NOTRACE)
311933b7f99cSSteven Rostedt (Red Hat) 		hash = ops->func_hash->notrace_hash;
3120f45948e8SSteven Rostedt 	else
312133b7f99cSSteven Rostedt (Red Hat) 		hash = ops->func_hash->filter_hash;
3122f45948e8SSteven Rostedt 
312333dc9b12SSteven Rostedt 	if (file->f_mode & FMODE_WRITE) {
3124ef2fbe16SNamhyung Kim 		const int size_bits = FTRACE_HASH_DEFAULT_BITS;
3125ef2fbe16SNamhyung Kim 
3126ef2fbe16SNamhyung Kim 		if (file->f_flags & O_TRUNC)
3127ef2fbe16SNamhyung Kim 			iter->hash = alloc_ftrace_hash(size_bits);
3128ef2fbe16SNamhyung Kim 		else
3129ef2fbe16SNamhyung Kim 			iter->hash = alloc_and_copy_ftrace_hash(size_bits, hash);
3130ef2fbe16SNamhyung Kim 
313133dc9b12SSteven Rostedt 		if (!iter->hash) {
313233dc9b12SSteven Rostedt 			trace_parser_put(&iter->parser);
313333dc9b12SSteven Rostedt 			kfree(iter);
31343f2367baSMasami Hiramatsu 			ret = -ENOMEM;
31353f2367baSMasami Hiramatsu 			goto out_unlock;
313633dc9b12SSteven Rostedt 		}
313733dc9b12SSteven Rostedt 	}
31381cf41dd7SSteven Rostedt 
31395072c59fSSteven Rostedt 	if (file->f_mode & FMODE_READ) {
31405072c59fSSteven Rostedt 		iter->pg = ftrace_pages_start;
31415072c59fSSteven Rostedt 
31425072c59fSSteven Rostedt 		ret = seq_open(file, &show_ftrace_seq_ops);
31435072c59fSSteven Rostedt 		if (!ret) {
31445072c59fSSteven Rostedt 			struct seq_file *m = file->private_data;
31455072c59fSSteven Rostedt 			m->private = iter;
314679fe249cSLi Zefan 		} else {
314733dc9b12SSteven Rostedt 			/* Failed */
314833dc9b12SSteven Rostedt 			free_ftrace_hash(iter->hash);
314979fe249cSLi Zefan 			trace_parser_put(&iter->parser);
31505072c59fSSteven Rostedt 			kfree(iter);
315179fe249cSLi Zefan 		}
31525072c59fSSteven Rostedt 	} else
31535072c59fSSteven Rostedt 		file->private_data = iter;
31543f2367baSMasami Hiramatsu 
31553f2367baSMasami Hiramatsu  out_unlock:
315633b7f99cSSteven Rostedt (Red Hat) 	mutex_unlock(&ops->func_hash->regex_lock);
31575072c59fSSteven Rostedt 
31585072c59fSSteven Rostedt 	return ret;
31595072c59fSSteven Rostedt }
31605072c59fSSteven Rostedt 
316141c52c0dSSteven Rostedt static int
316241c52c0dSSteven Rostedt ftrace_filter_open(struct inode *inode, struct file *file)
316341c52c0dSSteven Rostedt {
3164e3b3e2e8SSteven Rostedt (Red Hat) 	struct ftrace_ops *ops = inode->i_private;
3165e3b3e2e8SSteven Rostedt (Red Hat) 
3166e3b3e2e8SSteven Rostedt (Red Hat) 	return ftrace_regex_open(ops,
316769a3083cSSteven Rostedt 			FTRACE_ITER_FILTER | FTRACE_ITER_DO_HASH,
31681cf41dd7SSteven Rostedt 			inode, file);
316941c52c0dSSteven Rostedt }
317041c52c0dSSteven Rostedt 
317141c52c0dSSteven Rostedt static int
317241c52c0dSSteven Rostedt ftrace_notrace_open(struct inode *inode, struct file *file)
317341c52c0dSSteven Rostedt {
3174e3b3e2e8SSteven Rostedt (Red Hat) 	struct ftrace_ops *ops = inode->i_private;
3175e3b3e2e8SSteven Rostedt (Red Hat) 
3176e3b3e2e8SSteven Rostedt (Red Hat) 	return ftrace_regex_open(ops, FTRACE_ITER_NOTRACE,
31771cf41dd7SSteven Rostedt 				 inode, file);
317841c52c0dSSteven Rostedt }
317941c52c0dSSteven Rostedt 
318064e7c440SSteven Rostedt static int ftrace_match(char *str, char *regex, int len, int type)
31819f4801e3SSteven Rostedt {
31829f4801e3SSteven Rostedt 	int matched = 0;
3183751e9983SLi Zefan 	int slen;
31849f4801e3SSteven Rostedt 
31859f4801e3SSteven Rostedt 	switch (type) {
31869f4801e3SSteven Rostedt 	case MATCH_FULL:
31879f4801e3SSteven Rostedt 		if (strcmp(str, regex) == 0)
31889f4801e3SSteven Rostedt 			matched = 1;
31899f4801e3SSteven Rostedt 		break;
31909f4801e3SSteven Rostedt 	case MATCH_FRONT_ONLY:
31919f4801e3SSteven Rostedt 		if (strncmp(str, regex, len) == 0)
31929f4801e3SSteven Rostedt 			matched = 1;
31939f4801e3SSteven Rostedt 		break;
31949f4801e3SSteven Rostedt 	case MATCH_MIDDLE_ONLY:
31959f4801e3SSteven Rostedt 		if (strstr(str, regex))
31969f4801e3SSteven Rostedt 			matched = 1;
31979f4801e3SSteven Rostedt 		break;
31989f4801e3SSteven Rostedt 	case MATCH_END_ONLY:
3199751e9983SLi Zefan 		slen = strlen(str);
3200751e9983SLi Zefan 		if (slen >= len && memcmp(str + slen - len, regex, len) == 0)
32019f4801e3SSteven Rostedt 			matched = 1;
32029f4801e3SSteven Rostedt 		break;
32039f4801e3SSteven Rostedt 	}
32049f4801e3SSteven Rostedt 
32059f4801e3SSteven Rostedt 	return matched;
32069f4801e3SSteven Rostedt }
32079f4801e3SSteven Rostedt 
3208b448c4e3SSteven Rostedt static int
32091cf41dd7SSteven Rostedt enter_record(struct ftrace_hash *hash, struct dyn_ftrace *rec, int not)
321064e7c440SSteven Rostedt {
3211b448c4e3SSteven Rostedt 	struct ftrace_func_entry *entry;
3212b448c4e3SSteven Rostedt 	int ret = 0;
3213b448c4e3SSteven Rostedt 
32141cf41dd7SSteven Rostedt 	entry = ftrace_lookup_ip(hash, rec->ip);
3215b448c4e3SSteven Rostedt 	if (not) {
3216b448c4e3SSteven Rostedt 		/* Do nothing if it doesn't exist */
3217b448c4e3SSteven Rostedt 		if (!entry)
3218b448c4e3SSteven Rostedt 			return 0;
3219b448c4e3SSteven Rostedt 
322033dc9b12SSteven Rostedt 		free_hash_entry(hash, entry);
3221b448c4e3SSteven Rostedt 	} else {
3222b448c4e3SSteven Rostedt 		/* Do nothing if it exists */
3223b448c4e3SSteven Rostedt 		if (entry)
3224b448c4e3SSteven Rostedt 			return 0;
3225b448c4e3SSteven Rostedt 
3226b448c4e3SSteven Rostedt 		ret = add_hash_entry(hash, rec->ip);
3227b448c4e3SSteven Rostedt 	}
3228b448c4e3SSteven Rostedt 	return ret;
3229996e87beSSteven Rostedt }
3230996e87beSSteven Rostedt 
323164e7c440SSteven Rostedt static int
3232b9df92d2SSteven Rostedt ftrace_match_record(struct dyn_ftrace *rec, char *mod,
3233b9df92d2SSteven Rostedt 		    char *regex, int len, int type)
323464e7c440SSteven Rostedt {
323564e7c440SSteven Rostedt 	char str[KSYM_SYMBOL_LEN];
3236b9df92d2SSteven Rostedt 	char *modname;
323764e7c440SSteven Rostedt 
3238b9df92d2SSteven Rostedt 	kallsyms_lookup(rec->ip, NULL, NULL, &modname, str);
3239b9df92d2SSteven Rostedt 
3240b9df92d2SSteven Rostedt 	if (mod) {
3241b9df92d2SSteven Rostedt 		/* module lookup requires matching the module */
3242b9df92d2SSteven Rostedt 		if (!modname || strcmp(modname, mod))
3243b9df92d2SSteven Rostedt 			return 0;
3244b9df92d2SSteven Rostedt 
3245b9df92d2SSteven Rostedt 		/* blank search means to match all funcs in the mod */
3246b9df92d2SSteven Rostedt 		if (!len)
3247b9df92d2SSteven Rostedt 			return 1;
3248b9df92d2SSteven Rostedt 	}
3249b9df92d2SSteven Rostedt 
325064e7c440SSteven Rostedt 	return ftrace_match(str, regex, len, type);
325164e7c440SSteven Rostedt }
325264e7c440SSteven Rostedt 
32531cf41dd7SSteven Rostedt static int
32541cf41dd7SSteven Rostedt match_records(struct ftrace_hash *hash, char *buff,
32551cf41dd7SSteven Rostedt 	      int len, char *mod, int not)
32569f4801e3SSteven Rostedt {
3257b9df92d2SSteven Rostedt 	unsigned search_len = 0;
32589f4801e3SSteven Rostedt 	struct ftrace_page *pg;
32599f4801e3SSteven Rostedt 	struct dyn_ftrace *rec;
3260b9df92d2SSteven Rostedt 	int type = MATCH_FULL;
3261b9df92d2SSteven Rostedt 	char *search = buff;
3262311d16daSLi Zefan 	int found = 0;
3263b448c4e3SSteven Rostedt 	int ret;
32649f4801e3SSteven Rostedt 
3265b9df92d2SSteven Rostedt 	if (len) {
32663f6fe06dSFrederic Weisbecker 		type = filter_parse_regex(buff, len, &search, &not);
32679f4801e3SSteven Rostedt 		search_len = strlen(search);
3268b9df92d2SSteven Rostedt 	}
3269b9df92d2SSteven Rostedt 
327052baf119SSteven Rostedt 	mutex_lock(&ftrace_lock);
3271b9df92d2SSteven Rostedt 
3272b9df92d2SSteven Rostedt 	if (unlikely(ftrace_disabled))
3273b9df92d2SSteven Rostedt 		goto out_unlock;
3274b9df92d2SSteven Rostedt 
3275265c831cSSteven Rostedt 	do_for_each_ftrace_rec(pg, rec) {
3276b9df92d2SSteven Rostedt 		if (ftrace_match_record(rec, mod, search, search_len, type)) {
32771cf41dd7SSteven Rostedt 			ret = enter_record(hash, rec, not);
3278b448c4e3SSteven Rostedt 			if (ret < 0) {
3279b448c4e3SSteven Rostedt 				found = ret;
3280b448c4e3SSteven Rostedt 				goto out_unlock;
3281b448c4e3SSteven Rostedt 			}
3282311d16daSLi Zefan 			found = 1;
32835072c59fSSteven Rostedt 		}
3284265c831cSSteven Rostedt 	} while_for_each_ftrace_rec();
3285b9df92d2SSteven Rostedt  out_unlock:
328652baf119SSteven Rostedt 	mutex_unlock(&ftrace_lock);
3287311d16daSLi Zefan 
3288311d16daSLi Zefan 	return found;
32895072c59fSSteven Rostedt }
32905072c59fSSteven Rostedt 
329164e7c440SSteven Rostedt static int
32921cf41dd7SSteven Rostedt ftrace_match_records(struct ftrace_hash *hash, char *buff, int len)
329364e7c440SSteven Rostedt {
32941cf41dd7SSteven Rostedt 	return match_records(hash, buff, len, NULL, 0);
329564e7c440SSteven Rostedt }
329664e7c440SSteven Rostedt 
32971cf41dd7SSteven Rostedt static int
32981cf41dd7SSteven Rostedt ftrace_match_module_records(struct ftrace_hash *hash, char *buff, char *mod)
329964e7c440SSteven Rostedt {
330064e7c440SSteven Rostedt 	int not = 0;
33016a24a244SSteven Rostedt 
330264e7c440SSteven Rostedt 	/* blank or '*' mean the same */
330364e7c440SSteven Rostedt 	if (strcmp(buff, "*") == 0)
330464e7c440SSteven Rostedt 		buff[0] = 0;
330564e7c440SSteven Rostedt 
330664e7c440SSteven Rostedt 	/* handle the case of 'dont filter this module' */
330764e7c440SSteven Rostedt 	if (strcmp(buff, "!") == 0 || strcmp(buff, "!*") == 0) {
330864e7c440SSteven Rostedt 		buff[0] = 0;
330964e7c440SSteven Rostedt 		not = 1;
331064e7c440SSteven Rostedt 	}
331164e7c440SSteven Rostedt 
33121cf41dd7SSteven Rostedt 	return match_records(hash, buff, strlen(buff), mod, not);
331364e7c440SSteven Rostedt }
331464e7c440SSteven Rostedt 
3315f6180773SSteven Rostedt /*
3316f6180773SSteven Rostedt  * We register the module command as a template to show others how
3317f6180773SSteven Rostedt  * to register the a command as well.
3318f6180773SSteven Rostedt  */
3319f6180773SSteven Rostedt 
3320f6180773SSteven Rostedt static int
332143dd61c9SSteven Rostedt ftrace_mod_callback(struct ftrace_hash *hash,
332243dd61c9SSteven Rostedt 		    char *func, char *cmd, char *param, int enable)
3323f6180773SSteven Rostedt {
3324f6180773SSteven Rostedt 	char *mod;
3325b448c4e3SSteven Rostedt 	int ret = -EINVAL;
3326f6180773SSteven Rostedt 
3327f6180773SSteven Rostedt 	/*
3328f6180773SSteven Rostedt 	 * cmd == 'mod' because we only registered this func
3329f6180773SSteven Rostedt 	 * for the 'mod' ftrace_func_command.
3330f6180773SSteven Rostedt 	 * But if you register one func with multiple commands,
3331f6180773SSteven Rostedt 	 * you can tell which command was used by the cmd
3332f6180773SSteven Rostedt 	 * parameter.
3333f6180773SSteven Rostedt 	 */
3334f6180773SSteven Rostedt 
3335f6180773SSteven Rostedt 	/* we must have a module name */
3336f6180773SSteven Rostedt 	if (!param)
3337b448c4e3SSteven Rostedt 		return ret;
3338f6180773SSteven Rostedt 
3339f6180773SSteven Rostedt 	mod = strsep(&param, ":");
3340f6180773SSteven Rostedt 	if (!strlen(mod))
3341b448c4e3SSteven Rostedt 		return ret;
3342f6180773SSteven Rostedt 
33431cf41dd7SSteven Rostedt 	ret = ftrace_match_module_records(hash, func, mod);
3344b448c4e3SSteven Rostedt 	if (!ret)
3345b448c4e3SSteven Rostedt 		ret = -EINVAL;
3346b448c4e3SSteven Rostedt 	if (ret < 0)
3347b448c4e3SSteven Rostedt 		return ret;
3348b448c4e3SSteven Rostedt 
3349f6180773SSteven Rostedt 	return 0;
3350f6180773SSteven Rostedt }
3351f6180773SSteven Rostedt 
3352f6180773SSteven Rostedt static struct ftrace_func_command ftrace_mod_cmd = {
3353f6180773SSteven Rostedt 	.name			= "mod",
3354f6180773SSteven Rostedt 	.func			= ftrace_mod_callback,
3355f6180773SSteven Rostedt };
3356f6180773SSteven Rostedt 
3357f6180773SSteven Rostedt static int __init ftrace_mod_cmd_init(void)
3358f6180773SSteven Rostedt {
3359f6180773SSteven Rostedt 	return register_ftrace_command(&ftrace_mod_cmd);
3360f6180773SSteven Rostedt }
33616f415672SSteven Rostedt core_initcall(ftrace_mod_cmd_init);
3362f6180773SSteven Rostedt 
33632f5f6ad9SSteven Rostedt static void function_trace_probe_call(unsigned long ip, unsigned long parent_ip,
3364a1e2e31dSSteven Rostedt 				      struct ftrace_ops *op, struct pt_regs *pt_regs)
336559df055fSSteven Rostedt {
3366b6887d79SSteven Rostedt 	struct ftrace_func_probe *entry;
336759df055fSSteven Rostedt 	struct hlist_head *hhd;
336859df055fSSteven Rostedt 	unsigned long key;
336959df055fSSteven Rostedt 
337059df055fSSteven Rostedt 	key = hash_long(ip, FTRACE_HASH_BITS);
337159df055fSSteven Rostedt 
337259df055fSSteven Rostedt 	hhd = &ftrace_func_hash[key];
337359df055fSSteven Rostedt 
337459df055fSSteven Rostedt 	if (hlist_empty(hhd))
337559df055fSSteven Rostedt 		return;
337659df055fSSteven Rostedt 
337759df055fSSteven Rostedt 	/*
337859df055fSSteven Rostedt 	 * Disable preemption for these calls to prevent a RCU grace
337959df055fSSteven Rostedt 	 * period. This syncs the hash iteration and freeing of items
338059df055fSSteven Rostedt 	 * on the hash. rcu_read_lock is too dangerous here.
338159df055fSSteven Rostedt 	 */
33825168ae50SSteven Rostedt 	preempt_disable_notrace();
33831bb539caSSteven Rostedt 	hlist_for_each_entry_rcu_notrace(entry, hhd, node) {
338459df055fSSteven Rostedt 		if (entry->ip == ip)
338559df055fSSteven Rostedt 			entry->ops->func(ip, parent_ip, &entry->data);
338659df055fSSteven Rostedt 	}
33875168ae50SSteven Rostedt 	preempt_enable_notrace();
338859df055fSSteven Rostedt }
338959df055fSSteven Rostedt 
3390b6887d79SSteven Rostedt static struct ftrace_ops trace_probe_ops __read_mostly =
339159df055fSSteven Rostedt {
3392b6887d79SSteven Rostedt 	.func		= function_trace_probe_call,
3393f04f24fbSMasami Hiramatsu 	.flags		= FTRACE_OPS_FL_INITIALIZED,
339433b7f99cSSteven Rostedt (Red Hat) 	INIT_OPS_HASH(trace_probe_ops)
339559df055fSSteven Rostedt };
339659df055fSSteven Rostedt 
3397b6887d79SSteven Rostedt static int ftrace_probe_registered;
339859df055fSSteven Rostedt 
3399b6887d79SSteven Rostedt static void __enable_ftrace_function_probe(void)
340059df055fSSteven Rostedt {
3401b848914cSSteven Rostedt 	int ret;
340259df055fSSteven Rostedt 	int i;
340359df055fSSteven Rostedt 
340419dd603eSSteven Rostedt (Red Hat) 	if (ftrace_probe_registered) {
340519dd603eSSteven Rostedt (Red Hat) 		/* still need to update the function call sites */
340619dd603eSSteven Rostedt (Red Hat) 		if (ftrace_enabled)
3407*e1effa01SSteven Rostedt (Red Hat) 			ftrace_run_modify_code(&trace_probe_ops, FTRACE_UPDATE_CALLS);
340859df055fSSteven Rostedt 		return;
340919dd603eSSteven Rostedt (Red Hat) 	}
341059df055fSSteven Rostedt 
341159df055fSSteven Rostedt 	for (i = 0; i < FTRACE_FUNC_HASHSIZE; i++) {
341259df055fSSteven Rostedt 		struct hlist_head *hhd = &ftrace_func_hash[i];
341359df055fSSteven Rostedt 		if (hhd->first)
341459df055fSSteven Rostedt 			break;
341559df055fSSteven Rostedt 	}
341659df055fSSteven Rostedt 	/* Nothing registered? */
341759df055fSSteven Rostedt 	if (i == FTRACE_FUNC_HASHSIZE)
341859df055fSSteven Rostedt 		return;
341959df055fSSteven Rostedt 
3420a1cd6173SSteven Rostedt 	ret = ftrace_startup(&trace_probe_ops, 0);
3421b848914cSSteven Rostedt 
3422b6887d79SSteven Rostedt 	ftrace_probe_registered = 1;
342359df055fSSteven Rostedt }
342459df055fSSteven Rostedt 
3425b6887d79SSteven Rostedt static void __disable_ftrace_function_probe(void)
342659df055fSSteven Rostedt {
342759df055fSSteven Rostedt 	int i;
342859df055fSSteven Rostedt 
3429b6887d79SSteven Rostedt 	if (!ftrace_probe_registered)
343059df055fSSteven Rostedt 		return;
343159df055fSSteven Rostedt 
343259df055fSSteven Rostedt 	for (i = 0; i < FTRACE_FUNC_HASHSIZE; i++) {
343359df055fSSteven Rostedt 		struct hlist_head *hhd = &ftrace_func_hash[i];
343459df055fSSteven Rostedt 		if (hhd->first)
343559df055fSSteven Rostedt 			return;
343659df055fSSteven Rostedt 	}
343759df055fSSteven Rostedt 
343859df055fSSteven Rostedt 	/* no more funcs left */
3439b848914cSSteven Rostedt 	ftrace_shutdown(&trace_probe_ops, 0);
3440b848914cSSteven Rostedt 
3441b6887d79SSteven Rostedt 	ftrace_probe_registered = 0;
344259df055fSSteven Rostedt }
344359df055fSSteven Rostedt 
344459df055fSSteven Rostedt 
34457818b388SSteven Rostedt (Red Hat) static void ftrace_free_entry(struct ftrace_func_probe *entry)
344659df055fSSteven Rostedt {
344759df055fSSteven Rostedt 	if (entry->ops->free)
3448e67efb93SSteven Rostedt (Red Hat) 		entry->ops->free(entry->ops, entry->ip, &entry->data);
344959df055fSSteven Rostedt 	kfree(entry);
345059df055fSSteven Rostedt }
345159df055fSSteven Rostedt 
345259df055fSSteven Rostedt int
3453b6887d79SSteven Rostedt register_ftrace_function_probe(char *glob, struct ftrace_probe_ops *ops,
345459df055fSSteven Rostedt 			      void *data)
345559df055fSSteven Rostedt {
3456b6887d79SSteven Rostedt 	struct ftrace_func_probe *entry;
345733b7f99cSSteven Rostedt (Red Hat) 	struct ftrace_hash **orig_hash = &trace_probe_ops.func_hash->filter_hash;
34583296fc4eSSteven Rostedt (Red Hat) 	struct ftrace_hash *old_hash = *orig_hash;
3459e1df4cb6SSteven Rostedt (Red Hat) 	struct ftrace_hash *hash;
346059df055fSSteven Rostedt 	struct ftrace_page *pg;
346159df055fSSteven Rostedt 	struct dyn_ftrace *rec;
346259df055fSSteven Rostedt 	int type, len, not;
34636a24a244SSteven Rostedt 	unsigned long key;
346459df055fSSteven Rostedt 	int count = 0;
346559df055fSSteven Rostedt 	char *search;
3466e1df4cb6SSteven Rostedt (Red Hat) 	int ret;
346759df055fSSteven Rostedt 
34683f6fe06dSFrederic Weisbecker 	type = filter_parse_regex(glob, strlen(glob), &search, &not);
346959df055fSSteven Rostedt 	len = strlen(search);
347059df055fSSteven Rostedt 
3471b6887d79SSteven Rostedt 	/* we do not support '!' for function probes */
347259df055fSSteven Rostedt 	if (WARN_ON(not))
347359df055fSSteven Rostedt 		return -EINVAL;
347459df055fSSteven Rostedt 
347533b7f99cSSteven Rostedt (Red Hat) 	mutex_lock(&trace_probe_ops.func_hash->regex_lock);
347659df055fSSteven Rostedt 
34773296fc4eSSteven Rostedt (Red Hat) 	hash = alloc_and_copy_ftrace_hash(FTRACE_HASH_DEFAULT_BITS, old_hash);
3478e1df4cb6SSteven Rostedt (Red Hat) 	if (!hash) {
3479e1df4cb6SSteven Rostedt (Red Hat) 		count = -ENOMEM;
34805ae0bf59SSteven Rostedt (Red Hat) 		goto out;
3481e1df4cb6SSteven Rostedt (Red Hat) 	}
3482e1df4cb6SSteven Rostedt (Red Hat) 
3483e1df4cb6SSteven Rostedt (Red Hat) 	if (unlikely(ftrace_disabled)) {
3484e1df4cb6SSteven Rostedt (Red Hat) 		count = -ENODEV;
34855ae0bf59SSteven Rostedt (Red Hat) 		goto out;
3486e1df4cb6SSteven Rostedt (Red Hat) 	}
348745a4a237SSteven Rostedt 
34885ae0bf59SSteven Rostedt (Red Hat) 	mutex_lock(&ftrace_lock);
34895ae0bf59SSteven Rostedt (Red Hat) 
349059df055fSSteven Rostedt 	do_for_each_ftrace_rec(pg, rec) {
349159df055fSSteven Rostedt 
3492b9df92d2SSteven Rostedt 		if (!ftrace_match_record(rec, NULL, search, len, type))
349359df055fSSteven Rostedt 			continue;
349459df055fSSteven Rostedt 
349559df055fSSteven Rostedt 		entry = kmalloc(sizeof(*entry), GFP_KERNEL);
349659df055fSSteven Rostedt 		if (!entry) {
3497b6887d79SSteven Rostedt 			/* If we did not process any, then return error */
349859df055fSSteven Rostedt 			if (!count)
349959df055fSSteven Rostedt 				count = -ENOMEM;
350059df055fSSteven Rostedt 			goto out_unlock;
350159df055fSSteven Rostedt 		}
350259df055fSSteven Rostedt 
350359df055fSSteven Rostedt 		count++;
350459df055fSSteven Rostedt 
350559df055fSSteven Rostedt 		entry->data = data;
350659df055fSSteven Rostedt 
350759df055fSSteven Rostedt 		/*
350859df055fSSteven Rostedt 		 * The caller might want to do something special
350959df055fSSteven Rostedt 		 * for each function we find. We call the callback
351059df055fSSteven Rostedt 		 * to give the caller an opportunity to do so.
351159df055fSSteven Rostedt 		 */
3512e67efb93SSteven Rostedt (Red Hat) 		if (ops->init) {
3513e67efb93SSteven Rostedt (Red Hat) 			if (ops->init(ops, rec->ip, &entry->data) < 0) {
351459df055fSSteven Rostedt 				/* caller does not like this func */
351559df055fSSteven Rostedt 				kfree(entry);
351659df055fSSteven Rostedt 				continue;
351759df055fSSteven Rostedt 			}
351859df055fSSteven Rostedt 		}
351959df055fSSteven Rostedt 
3520e1df4cb6SSteven Rostedt (Red Hat) 		ret = enter_record(hash, rec, 0);
3521e1df4cb6SSteven Rostedt (Red Hat) 		if (ret < 0) {
3522e1df4cb6SSteven Rostedt (Red Hat) 			kfree(entry);
3523e1df4cb6SSteven Rostedt (Red Hat) 			count = ret;
3524e1df4cb6SSteven Rostedt (Red Hat) 			goto out_unlock;
3525e1df4cb6SSteven Rostedt (Red Hat) 		}
3526e1df4cb6SSteven Rostedt (Red Hat) 
352759df055fSSteven Rostedt 		entry->ops = ops;
352859df055fSSteven Rostedt 		entry->ip = rec->ip;
352959df055fSSteven Rostedt 
353059df055fSSteven Rostedt 		key = hash_long(entry->ip, FTRACE_HASH_BITS);
353159df055fSSteven Rostedt 		hlist_add_head_rcu(&entry->node, &ftrace_func_hash[key]);
353259df055fSSteven Rostedt 
353359df055fSSteven Rostedt 	} while_for_each_ftrace_rec();
3534e1df4cb6SSteven Rostedt (Red Hat) 
3535e1df4cb6SSteven Rostedt (Red Hat) 	ret = ftrace_hash_move(&trace_probe_ops, 1, orig_hash, hash);
35363296fc4eSSteven Rostedt (Red Hat) 	if (!ret)
35373296fc4eSSteven Rostedt (Red Hat) 		free_ftrace_hash_rcu(old_hash);
35383296fc4eSSteven Rostedt (Red Hat) 	else
3539e1df4cb6SSteven Rostedt (Red Hat) 		count = ret;
3540e1df4cb6SSteven Rostedt (Red Hat) 
3541b6887d79SSteven Rostedt 	__enable_ftrace_function_probe();
354259df055fSSteven Rostedt 
354359df055fSSteven Rostedt  out_unlock:
35445ae0bf59SSteven Rostedt (Red Hat) 	mutex_unlock(&ftrace_lock);
35455ae0bf59SSteven Rostedt (Red Hat)  out:
354633b7f99cSSteven Rostedt (Red Hat) 	mutex_unlock(&trace_probe_ops.func_hash->regex_lock);
3547e1df4cb6SSteven Rostedt (Red Hat) 	free_ftrace_hash(hash);
354859df055fSSteven Rostedt 
354959df055fSSteven Rostedt 	return count;
355059df055fSSteven Rostedt }
355159df055fSSteven Rostedt 
355259df055fSSteven Rostedt enum {
3553b6887d79SSteven Rostedt 	PROBE_TEST_FUNC		= 1,
3554b6887d79SSteven Rostedt 	PROBE_TEST_DATA		= 2
355559df055fSSteven Rostedt };
355659df055fSSteven Rostedt 
355759df055fSSteven Rostedt static void
3558b6887d79SSteven Rostedt __unregister_ftrace_function_probe(char *glob, struct ftrace_probe_ops *ops,
355959df055fSSteven Rostedt 				  void *data, int flags)
356059df055fSSteven Rostedt {
3561e1df4cb6SSteven Rostedt (Red Hat) 	struct ftrace_func_entry *rec_entry;
3562b6887d79SSteven Rostedt 	struct ftrace_func_probe *entry;
35637818b388SSteven Rostedt (Red Hat) 	struct ftrace_func_probe *p;
356433b7f99cSSteven Rostedt (Red Hat) 	struct ftrace_hash **orig_hash = &trace_probe_ops.func_hash->filter_hash;
35653296fc4eSSteven Rostedt (Red Hat) 	struct ftrace_hash *old_hash = *orig_hash;
35667818b388SSteven Rostedt (Red Hat) 	struct list_head free_list;
3567e1df4cb6SSteven Rostedt (Red Hat) 	struct ftrace_hash *hash;
3568b67bfe0dSSasha Levin 	struct hlist_node *tmp;
356959df055fSSteven Rostedt 	char str[KSYM_SYMBOL_LEN];
357059df055fSSteven Rostedt 	int type = MATCH_FULL;
357159df055fSSteven Rostedt 	int i, len = 0;
357259df055fSSteven Rostedt 	char *search;
35733296fc4eSSteven Rostedt (Red Hat) 	int ret;
357459df055fSSteven Rostedt 
3575b36461daSAtsushi Tsuji 	if (glob && (strcmp(glob, "*") == 0 || !strlen(glob)))
357659df055fSSteven Rostedt 		glob = NULL;
3577b36461daSAtsushi Tsuji 	else if (glob) {
357859df055fSSteven Rostedt 		int not;
357959df055fSSteven Rostedt 
35803f6fe06dSFrederic Weisbecker 		type = filter_parse_regex(glob, strlen(glob), &search, &not);
358159df055fSSteven Rostedt 		len = strlen(search);
358259df055fSSteven Rostedt 
3583b6887d79SSteven Rostedt 		/* we do not support '!' for function probes */
358459df055fSSteven Rostedt 		if (WARN_ON(not))
358559df055fSSteven Rostedt 			return;
358659df055fSSteven Rostedt 	}
358759df055fSSteven Rostedt 
358833b7f99cSSteven Rostedt (Red Hat) 	mutex_lock(&trace_probe_ops.func_hash->regex_lock);
3589e1df4cb6SSteven Rostedt (Red Hat) 
3590e1df4cb6SSteven Rostedt (Red Hat) 	hash = alloc_and_copy_ftrace_hash(FTRACE_HASH_DEFAULT_BITS, *orig_hash);
3591e1df4cb6SSteven Rostedt (Red Hat) 	if (!hash)
3592e1df4cb6SSteven Rostedt (Red Hat) 		/* Hmm, should report this somehow */
3593e1df4cb6SSteven Rostedt (Red Hat) 		goto out_unlock;
3594e1df4cb6SSteven Rostedt (Red Hat) 
35957818b388SSteven Rostedt (Red Hat) 	INIT_LIST_HEAD(&free_list);
35967818b388SSteven Rostedt (Red Hat) 
359759df055fSSteven Rostedt 	for (i = 0; i < FTRACE_FUNC_HASHSIZE; i++) {
359859df055fSSteven Rostedt 		struct hlist_head *hhd = &ftrace_func_hash[i];
359959df055fSSteven Rostedt 
3600b67bfe0dSSasha Levin 		hlist_for_each_entry_safe(entry, tmp, hhd, node) {
360159df055fSSteven Rostedt 
360259df055fSSteven Rostedt 			/* break up if statements for readability */
3603b6887d79SSteven Rostedt 			if ((flags & PROBE_TEST_FUNC) && entry->ops != ops)
360459df055fSSteven Rostedt 				continue;
360559df055fSSteven Rostedt 
3606b6887d79SSteven Rostedt 			if ((flags & PROBE_TEST_DATA) && entry->data != data)
360759df055fSSteven Rostedt 				continue;
360859df055fSSteven Rostedt 
360959df055fSSteven Rostedt 			/* do this last, since it is the most expensive */
361059df055fSSteven Rostedt 			if (glob) {
361159df055fSSteven Rostedt 				kallsyms_lookup(entry->ip, NULL, NULL,
361259df055fSSteven Rostedt 						NULL, str);
361359df055fSSteven Rostedt 				if (!ftrace_match(str, glob, len, type))
361459df055fSSteven Rostedt 					continue;
361559df055fSSteven Rostedt 			}
361659df055fSSteven Rostedt 
3617e1df4cb6SSteven Rostedt (Red Hat) 			rec_entry = ftrace_lookup_ip(hash, entry->ip);
3618e1df4cb6SSteven Rostedt (Red Hat) 			/* It is possible more than one entry had this ip */
3619e1df4cb6SSteven Rostedt (Red Hat) 			if (rec_entry)
3620e1df4cb6SSteven Rostedt (Red Hat) 				free_hash_entry(hash, rec_entry);
3621e1df4cb6SSteven Rostedt (Red Hat) 
3622740466bcSSteven Rostedt (Red Hat) 			hlist_del_rcu(&entry->node);
36237818b388SSteven Rostedt (Red Hat) 			list_add(&entry->free_list, &free_list);
362459df055fSSteven Rostedt 		}
362559df055fSSteven Rostedt 	}
36263f2367baSMasami Hiramatsu 	mutex_lock(&ftrace_lock);
3627b6887d79SSteven Rostedt 	__disable_ftrace_function_probe();
3628e1df4cb6SSteven Rostedt (Red Hat) 	/*
3629e1df4cb6SSteven Rostedt (Red Hat) 	 * Remove after the disable is called. Otherwise, if the last
3630e1df4cb6SSteven Rostedt (Red Hat) 	 * probe is removed, a null hash means *all enabled*.
3631e1df4cb6SSteven Rostedt (Red Hat) 	 */
36323296fc4eSSteven Rostedt (Red Hat) 	ret = ftrace_hash_move(&trace_probe_ops, 1, orig_hash, hash);
36337818b388SSteven Rostedt (Red Hat) 	synchronize_sched();
36343296fc4eSSteven Rostedt (Red Hat) 	if (!ret)
36353296fc4eSSteven Rostedt (Red Hat) 		free_ftrace_hash_rcu(old_hash);
36363296fc4eSSteven Rostedt (Red Hat) 
36377818b388SSteven Rostedt (Red Hat) 	list_for_each_entry_safe(entry, p, &free_list, free_list) {
36387818b388SSteven Rostedt (Red Hat) 		list_del(&entry->free_list);
36397818b388SSteven Rostedt (Red Hat) 		ftrace_free_entry(entry);
36407818b388SSteven Rostedt (Red Hat) 	}
36413f2367baSMasami Hiramatsu 	mutex_unlock(&ftrace_lock);
36427818b388SSteven Rostedt (Red Hat) 
3643e1df4cb6SSteven Rostedt (Red Hat)  out_unlock:
364433b7f99cSSteven Rostedt (Red Hat) 	mutex_unlock(&trace_probe_ops.func_hash->regex_lock);
3645e1df4cb6SSteven Rostedt (Red Hat) 	free_ftrace_hash(hash);
364659df055fSSteven Rostedt }
364759df055fSSteven Rostedt 
364859df055fSSteven Rostedt void
3649b6887d79SSteven Rostedt unregister_ftrace_function_probe(char *glob, struct ftrace_probe_ops *ops,
365059df055fSSteven Rostedt 				void *data)
365159df055fSSteven Rostedt {
3652b6887d79SSteven Rostedt 	__unregister_ftrace_function_probe(glob, ops, data,
3653b6887d79SSteven Rostedt 					  PROBE_TEST_FUNC | PROBE_TEST_DATA);
365459df055fSSteven Rostedt }
365559df055fSSteven Rostedt 
365659df055fSSteven Rostedt void
3657b6887d79SSteven Rostedt unregister_ftrace_function_probe_func(char *glob, struct ftrace_probe_ops *ops)
365859df055fSSteven Rostedt {
3659b6887d79SSteven Rostedt 	__unregister_ftrace_function_probe(glob, ops, NULL, PROBE_TEST_FUNC);
366059df055fSSteven Rostedt }
366159df055fSSteven Rostedt 
3662b6887d79SSteven Rostedt void unregister_ftrace_function_probe_all(char *glob)
366359df055fSSteven Rostedt {
3664b6887d79SSteven Rostedt 	__unregister_ftrace_function_probe(glob, NULL, NULL, 0);
366559df055fSSteven Rostedt }
366659df055fSSteven Rostedt 
3667f6180773SSteven Rostedt static LIST_HEAD(ftrace_commands);
3668f6180773SSteven Rostedt static DEFINE_MUTEX(ftrace_cmd_mutex);
3669f6180773SSteven Rostedt 
367038de93abSTom Zanussi /*
367138de93abSTom Zanussi  * Currently we only register ftrace commands from __init, so mark this
367238de93abSTom Zanussi  * __init too.
367338de93abSTom Zanussi  */
367438de93abSTom Zanussi __init int register_ftrace_command(struct ftrace_func_command *cmd)
3675f6180773SSteven Rostedt {
3676f6180773SSteven Rostedt 	struct ftrace_func_command *p;
3677f6180773SSteven Rostedt 	int ret = 0;
3678f6180773SSteven Rostedt 
3679f6180773SSteven Rostedt 	mutex_lock(&ftrace_cmd_mutex);
3680f6180773SSteven Rostedt 	list_for_each_entry(p, &ftrace_commands, list) {
3681f6180773SSteven Rostedt 		if (strcmp(cmd->name, p->name) == 0) {
3682f6180773SSteven Rostedt 			ret = -EBUSY;
3683f6180773SSteven Rostedt 			goto out_unlock;
3684f6180773SSteven Rostedt 		}
3685f6180773SSteven Rostedt 	}
3686f6180773SSteven Rostedt 	list_add(&cmd->list, &ftrace_commands);
3687f6180773SSteven Rostedt  out_unlock:
3688f6180773SSteven Rostedt 	mutex_unlock(&ftrace_cmd_mutex);
3689f6180773SSteven Rostedt 
3690f6180773SSteven Rostedt 	return ret;
3691f6180773SSteven Rostedt }
3692f6180773SSteven Rostedt 
369338de93abSTom Zanussi /*
369438de93abSTom Zanussi  * Currently we only unregister ftrace commands from __init, so mark
369538de93abSTom Zanussi  * this __init too.
369638de93abSTom Zanussi  */
369738de93abSTom Zanussi __init int unregister_ftrace_command(struct ftrace_func_command *cmd)
3698f6180773SSteven Rostedt {
3699f6180773SSteven Rostedt 	struct ftrace_func_command *p, *n;
3700f6180773SSteven Rostedt 	int ret = -ENODEV;
3701f6180773SSteven Rostedt 
3702f6180773SSteven Rostedt 	mutex_lock(&ftrace_cmd_mutex);
3703f6180773SSteven Rostedt 	list_for_each_entry_safe(p, n, &ftrace_commands, list) {
3704f6180773SSteven Rostedt 		if (strcmp(cmd->name, p->name) == 0) {
3705f6180773SSteven Rostedt 			ret = 0;
3706f6180773SSteven Rostedt 			list_del_init(&p->list);
3707f6180773SSteven Rostedt 			goto out_unlock;
3708f6180773SSteven Rostedt 		}
3709f6180773SSteven Rostedt 	}
3710f6180773SSteven Rostedt  out_unlock:
3711f6180773SSteven Rostedt 	mutex_unlock(&ftrace_cmd_mutex);
3712f6180773SSteven Rostedt 
3713f6180773SSteven Rostedt 	return ret;
3714f6180773SSteven Rostedt }
3715f6180773SSteven Rostedt 
371633dc9b12SSteven Rostedt static int ftrace_process_regex(struct ftrace_hash *hash,
371733dc9b12SSteven Rostedt 				char *buff, int len, int enable)
371864e7c440SSteven Rostedt {
3719f6180773SSteven Rostedt 	char *func, *command, *next = buff;
37206a24a244SSteven Rostedt 	struct ftrace_func_command *p;
37210aff1c0cSGuoWen Li 	int ret = -EINVAL;
372264e7c440SSteven Rostedt 
372364e7c440SSteven Rostedt 	func = strsep(&next, ":");
372464e7c440SSteven Rostedt 
372564e7c440SSteven Rostedt 	if (!next) {
37261cf41dd7SSteven Rostedt 		ret = ftrace_match_records(hash, func, len);
3727b448c4e3SSteven Rostedt 		if (!ret)
3728b448c4e3SSteven Rostedt 			ret = -EINVAL;
3729b448c4e3SSteven Rostedt 		if (ret < 0)
3730311d16daSLi Zefan 			return ret;
3731b448c4e3SSteven Rostedt 		return 0;
373264e7c440SSteven Rostedt 	}
373364e7c440SSteven Rostedt 
3734f6180773SSteven Rostedt 	/* command found */
373564e7c440SSteven Rostedt 
373664e7c440SSteven Rostedt 	command = strsep(&next, ":");
373764e7c440SSteven Rostedt 
3738f6180773SSteven Rostedt 	mutex_lock(&ftrace_cmd_mutex);
3739f6180773SSteven Rostedt 	list_for_each_entry(p, &ftrace_commands, list) {
3740f6180773SSteven Rostedt 		if (strcmp(p->name, command) == 0) {
374143dd61c9SSteven Rostedt 			ret = p->func(hash, func, command, next, enable);
3742f6180773SSteven Rostedt 			goto out_unlock;
374364e7c440SSteven Rostedt 		}
3744f6180773SSteven Rostedt 	}
3745f6180773SSteven Rostedt  out_unlock:
3746f6180773SSteven Rostedt 	mutex_unlock(&ftrace_cmd_mutex);
374764e7c440SSteven Rostedt 
3748f6180773SSteven Rostedt 	return ret;
374964e7c440SSteven Rostedt }
375064e7c440SSteven Rostedt 
3751e309b41dSIngo Molnar static ssize_t
375241c52c0dSSteven Rostedt ftrace_regex_write(struct file *file, const char __user *ubuf,
375341c52c0dSSteven Rostedt 		   size_t cnt, loff_t *ppos, int enable)
37545072c59fSSteven Rostedt {
37555072c59fSSteven Rostedt 	struct ftrace_iterator *iter;
3756689fd8b6S[email protected] 	struct trace_parser *parser;
3757689fd8b6S[email protected] 	ssize_t ret, read;
37585072c59fSSteven Rostedt 
37594ba7978eSLi Zefan 	if (!cnt)
37605072c59fSSteven Rostedt 		return 0;
37615072c59fSSteven Rostedt 
37625072c59fSSteven Rostedt 	if (file->f_mode & FMODE_READ) {
37635072c59fSSteven Rostedt 		struct seq_file *m = file->private_data;
37645072c59fSSteven Rostedt 		iter = m->private;
37655072c59fSSteven Rostedt 	} else
37665072c59fSSteven Rostedt 		iter = file->private_data;
37675072c59fSSteven Rostedt 
3768f04f24fbSMasami Hiramatsu 	if (unlikely(ftrace_disabled))
37693f2367baSMasami Hiramatsu 		return -ENODEV;
37703f2367baSMasami Hiramatsu 
37713f2367baSMasami Hiramatsu 	/* iter->hash is a local copy, so we don't need regex_lock */
3772f04f24fbSMasami Hiramatsu 
3773689fd8b6S[email protected] 	parser = &iter->parser;
3774689fd8b6S[email protected] 	read = trace_get_user(parser, ubuf, cnt, ppos);
37755072c59fSSteven Rostedt 
37764ba7978eSLi Zefan 	if (read >= 0 && trace_parser_loaded(parser) &&
3777689fd8b6S[email protected] 	    !trace_parser_cont(parser)) {
377833dc9b12SSteven Rostedt 		ret = ftrace_process_regex(iter->hash, parser->buffer,
3779689fd8b6S[email protected] 					   parser->idx, enable);
3780313254a9SLi Zefan 		trace_parser_clear(parser);
37817c088b51SSteven Rostedt (Red Hat) 		if (ret < 0)
37823f2367baSMasami Hiramatsu 			goto out;
37835072c59fSSteven Rostedt 	}
37845072c59fSSteven Rostedt 
37855072c59fSSteven Rostedt 	ret = read;
37863f2367baSMasami Hiramatsu  out:
37875072c59fSSteven Rostedt 	return ret;
37885072c59fSSteven Rostedt }
37895072c59fSSteven Rostedt 
3790fc13cb0cSSteven Rostedt ssize_t
379141c52c0dSSteven Rostedt ftrace_filter_write(struct file *file, const char __user *ubuf,
379241c52c0dSSteven Rostedt 		    size_t cnt, loff_t *ppos)
379341c52c0dSSteven Rostedt {
379441c52c0dSSteven Rostedt 	return ftrace_regex_write(file, ubuf, cnt, ppos, 1);
379541c52c0dSSteven Rostedt }
379641c52c0dSSteven Rostedt 
3797fc13cb0cSSteven Rostedt ssize_t
379841c52c0dSSteven Rostedt ftrace_notrace_write(struct file *file, const char __user *ubuf,
379941c52c0dSSteven Rostedt 		     size_t cnt, loff_t *ppos)
380041c52c0dSSteven Rostedt {
380141c52c0dSSteven Rostedt 	return ftrace_regex_write(file, ubuf, cnt, ppos, 0);
380241c52c0dSSteven Rostedt }
380341c52c0dSSteven Rostedt 
380433dc9b12SSteven Rostedt static int
3805647664eaSMasami Hiramatsu ftrace_match_addr(struct ftrace_hash *hash, unsigned long ip, int remove)
3806647664eaSMasami Hiramatsu {
3807647664eaSMasami Hiramatsu 	struct ftrace_func_entry *entry;
3808647664eaSMasami Hiramatsu 
3809647664eaSMasami Hiramatsu 	if (!ftrace_location(ip))
3810647664eaSMasami Hiramatsu 		return -EINVAL;
3811647664eaSMasami Hiramatsu 
3812647664eaSMasami Hiramatsu 	if (remove) {
3813647664eaSMasami Hiramatsu 		entry = ftrace_lookup_ip(hash, ip);
3814647664eaSMasami Hiramatsu 		if (!entry)
3815647664eaSMasami Hiramatsu 			return -ENOENT;
3816647664eaSMasami Hiramatsu 		free_hash_entry(hash, entry);
3817647664eaSMasami Hiramatsu 		return 0;
3818647664eaSMasami Hiramatsu 	}
3819647664eaSMasami Hiramatsu 
3820647664eaSMasami Hiramatsu 	return add_hash_entry(hash, ip);
3821647664eaSMasami Hiramatsu }
3822647664eaSMasami Hiramatsu 
38231c80c432SSteven Rostedt (Red Hat) static void ftrace_ops_update_code(struct ftrace_ops *ops)
38241c80c432SSteven Rostedt (Red Hat) {
38251c80c432SSteven Rostedt (Red Hat) 	if (ops->flags & FTRACE_OPS_FL_ENABLED && ftrace_enabled)
3826*e1effa01SSteven Rostedt (Red Hat) 		ftrace_run_modify_code(ops, FTRACE_UPDATE_CALLS);
38271c80c432SSteven Rostedt (Red Hat) }
38281c80c432SSteven Rostedt (Red Hat) 
3829647664eaSMasami Hiramatsu static int
3830647664eaSMasami Hiramatsu ftrace_set_hash(struct ftrace_ops *ops, unsigned char *buf, int len,
3831647664eaSMasami Hiramatsu 		unsigned long ip, int remove, int reset, int enable)
383241c52c0dSSteven Rostedt {
383333dc9b12SSteven Rostedt 	struct ftrace_hash **orig_hash;
38343296fc4eSSteven Rostedt (Red Hat) 	struct ftrace_hash *old_hash;
3835f45948e8SSteven Rostedt 	struct ftrace_hash *hash;
383633dc9b12SSteven Rostedt 	int ret;
3837f45948e8SSteven Rostedt 
383841c52c0dSSteven Rostedt 	if (unlikely(ftrace_disabled))
383933dc9b12SSteven Rostedt 		return -ENODEV;
384041c52c0dSSteven Rostedt 
384133b7f99cSSteven Rostedt (Red Hat) 	mutex_lock(&ops->func_hash->regex_lock);
38423f2367baSMasami Hiramatsu 
3843f45948e8SSteven Rostedt 	if (enable)
384433b7f99cSSteven Rostedt (Red Hat) 		orig_hash = &ops->func_hash->filter_hash;
3845f45948e8SSteven Rostedt 	else
384633b7f99cSSteven Rostedt (Red Hat) 		orig_hash = &ops->func_hash->notrace_hash;
384733dc9b12SSteven Rostedt 
3848b972cc58SWang Nan 	if (reset)
3849b972cc58SWang Nan 		hash = alloc_ftrace_hash(FTRACE_HASH_DEFAULT_BITS);
3850b972cc58SWang Nan 	else
385133dc9b12SSteven Rostedt 		hash = alloc_and_copy_ftrace_hash(FTRACE_HASH_DEFAULT_BITS, *orig_hash);
3852b972cc58SWang Nan 
38533f2367baSMasami Hiramatsu 	if (!hash) {
38543f2367baSMasami Hiramatsu 		ret = -ENOMEM;
38553f2367baSMasami Hiramatsu 		goto out_regex_unlock;
38563f2367baSMasami Hiramatsu 	}
3857f45948e8SSteven Rostedt 
3858ac483c44SJiri Olsa 	if (buf && !ftrace_match_records(hash, buf, len)) {
3859ac483c44SJiri Olsa 		ret = -EINVAL;
3860ac483c44SJiri Olsa 		goto out_regex_unlock;
3861ac483c44SJiri Olsa 	}
3862647664eaSMasami Hiramatsu 	if (ip) {
3863647664eaSMasami Hiramatsu 		ret = ftrace_match_addr(hash, ip, remove);
3864647664eaSMasami Hiramatsu 		if (ret < 0)
3865647664eaSMasami Hiramatsu 			goto out_regex_unlock;
3866647664eaSMasami Hiramatsu 	}
386733dc9b12SSteven Rostedt 
386833dc9b12SSteven Rostedt 	mutex_lock(&ftrace_lock);
38693296fc4eSSteven Rostedt (Red Hat) 	old_hash = *orig_hash;
387041fb61c2SSteven Rostedt 	ret = ftrace_hash_move(ops, enable, orig_hash, hash);
38713296fc4eSSteven Rostedt (Red Hat) 	if (!ret) {
38721c80c432SSteven Rostedt (Red Hat) 		ftrace_ops_update_code(ops);
38733296fc4eSSteven Rostedt (Red Hat) 		free_ftrace_hash_rcu(old_hash);
38743296fc4eSSteven Rostedt (Red Hat) 	}
387533dc9b12SSteven Rostedt 	mutex_unlock(&ftrace_lock);
387633dc9b12SSteven Rostedt 
3877ac483c44SJiri Olsa  out_regex_unlock:
387833b7f99cSSteven Rostedt (Red Hat) 	mutex_unlock(&ops->func_hash->regex_lock);
387933dc9b12SSteven Rostedt 
388033dc9b12SSteven Rostedt 	free_ftrace_hash(hash);
388133dc9b12SSteven Rostedt 	return ret;
388241c52c0dSSteven Rostedt }
388341c52c0dSSteven Rostedt 
3884647664eaSMasami Hiramatsu static int
3885647664eaSMasami Hiramatsu ftrace_set_addr(struct ftrace_ops *ops, unsigned long ip, int remove,
3886647664eaSMasami Hiramatsu 		int reset, int enable)
3887647664eaSMasami Hiramatsu {
3888647664eaSMasami Hiramatsu 	return ftrace_set_hash(ops, 0, 0, ip, remove, reset, enable);
3889647664eaSMasami Hiramatsu }
3890647664eaSMasami Hiramatsu 
3891647664eaSMasami Hiramatsu /**
3892647664eaSMasami Hiramatsu  * ftrace_set_filter_ip - set a function to filter on in ftrace by address
3893647664eaSMasami Hiramatsu  * @ops - the ops to set the filter with
3894647664eaSMasami Hiramatsu  * @ip - the address to add to or remove from the filter.
3895647664eaSMasami Hiramatsu  * @remove - non zero to remove the ip from the filter
3896647664eaSMasami Hiramatsu  * @reset - non zero to reset all filters before applying this filter.
3897647664eaSMasami Hiramatsu  *
3898647664eaSMasami Hiramatsu  * Filters denote which functions should be enabled when tracing is enabled
3899647664eaSMasami Hiramatsu  * If @ip is NULL, it failes to update filter.
3900647664eaSMasami Hiramatsu  */
3901647664eaSMasami Hiramatsu int ftrace_set_filter_ip(struct ftrace_ops *ops, unsigned long ip,
3902647664eaSMasami Hiramatsu 			 int remove, int reset)
3903647664eaSMasami Hiramatsu {
3904f04f24fbSMasami Hiramatsu 	ftrace_ops_init(ops);
3905647664eaSMasami Hiramatsu 	return ftrace_set_addr(ops, ip, remove, reset, 1);
3906647664eaSMasami Hiramatsu }
3907647664eaSMasami Hiramatsu EXPORT_SYMBOL_GPL(ftrace_set_filter_ip);
3908647664eaSMasami Hiramatsu 
3909647664eaSMasami Hiramatsu static int
3910647664eaSMasami Hiramatsu ftrace_set_regex(struct ftrace_ops *ops, unsigned char *buf, int len,
3911647664eaSMasami Hiramatsu 		 int reset, int enable)
3912647664eaSMasami Hiramatsu {
3913647664eaSMasami Hiramatsu 	return ftrace_set_hash(ops, buf, len, 0, 0, reset, enable);
3914647664eaSMasami Hiramatsu }
3915647664eaSMasami Hiramatsu 
391677a2b37dSSteven Rostedt /**
391777a2b37dSSteven Rostedt  * ftrace_set_filter - set a function to filter on in ftrace
3918936e074bSSteven Rostedt  * @ops - the ops to set the filter with
391977a2b37dSSteven Rostedt  * @buf - the string that holds the function filter text.
392077a2b37dSSteven Rostedt  * @len - the length of the string.
392177a2b37dSSteven Rostedt  * @reset - non zero to reset all filters before applying this filter.
392277a2b37dSSteven Rostedt  *
392377a2b37dSSteven Rostedt  * Filters denote which functions should be enabled when tracing is enabled.
392477a2b37dSSteven Rostedt  * If @buf is NULL and reset is set, all functions will be enabled for tracing.
392577a2b37dSSteven Rostedt  */
3926ac483c44SJiri Olsa int ftrace_set_filter(struct ftrace_ops *ops, unsigned char *buf,
3927936e074bSSteven Rostedt 		       int len, int reset)
392877a2b37dSSteven Rostedt {
3929f04f24fbSMasami Hiramatsu 	ftrace_ops_init(ops);
3930ac483c44SJiri Olsa 	return ftrace_set_regex(ops, buf, len, reset, 1);
393141c52c0dSSteven Rostedt }
3932936e074bSSteven Rostedt EXPORT_SYMBOL_GPL(ftrace_set_filter);
39334eebcc81SSteven Rostedt 
393441c52c0dSSteven Rostedt /**
393541c52c0dSSteven Rostedt  * ftrace_set_notrace - set a function to not trace in ftrace
3936936e074bSSteven Rostedt  * @ops - the ops to set the notrace filter with
393741c52c0dSSteven Rostedt  * @buf - the string that holds the function notrace text.
393841c52c0dSSteven Rostedt  * @len - the length of the string.
393941c52c0dSSteven Rostedt  * @reset - non zero to reset all filters before applying this filter.
394041c52c0dSSteven Rostedt  *
394141c52c0dSSteven Rostedt  * Notrace Filters denote which functions should not be enabled when tracing
394241c52c0dSSteven Rostedt  * is enabled. If @buf is NULL and reset is set, all functions will be enabled
394341c52c0dSSteven Rostedt  * for tracing.
394441c52c0dSSteven Rostedt  */
3945ac483c44SJiri Olsa int ftrace_set_notrace(struct ftrace_ops *ops, unsigned char *buf,
3946936e074bSSteven Rostedt 			int len, int reset)
3947936e074bSSteven Rostedt {
3948f04f24fbSMasami Hiramatsu 	ftrace_ops_init(ops);
3949ac483c44SJiri Olsa 	return ftrace_set_regex(ops, buf, len, reset, 0);
3950936e074bSSteven Rostedt }
3951936e074bSSteven Rostedt EXPORT_SYMBOL_GPL(ftrace_set_notrace);
3952936e074bSSteven Rostedt /**
39538d1b065dSJiaxing Wang  * ftrace_set_global_filter - set a function to filter on with global tracers
3954936e074bSSteven Rostedt  * @buf - the string that holds the function filter text.
3955936e074bSSteven Rostedt  * @len - the length of the string.
3956936e074bSSteven Rostedt  * @reset - non zero to reset all filters before applying this filter.
3957936e074bSSteven Rostedt  *
3958936e074bSSteven Rostedt  * Filters denote which functions should be enabled when tracing is enabled.
3959936e074bSSteven Rostedt  * If @buf is NULL and reset is set, all functions will be enabled for tracing.
3960936e074bSSteven Rostedt  */
3961936e074bSSteven Rostedt void ftrace_set_global_filter(unsigned char *buf, int len, int reset)
3962936e074bSSteven Rostedt {
3963936e074bSSteven Rostedt 	ftrace_set_regex(&global_ops, buf, len, reset, 1);
3964936e074bSSteven Rostedt }
3965936e074bSSteven Rostedt EXPORT_SYMBOL_GPL(ftrace_set_global_filter);
3966936e074bSSteven Rostedt 
3967936e074bSSteven Rostedt /**
39688d1b065dSJiaxing Wang  * ftrace_set_global_notrace - set a function to not trace with global tracers
3969936e074bSSteven Rostedt  * @buf - the string that holds the function notrace text.
3970936e074bSSteven Rostedt  * @len - the length of the string.
3971936e074bSSteven Rostedt  * @reset - non zero to reset all filters before applying this filter.
3972936e074bSSteven Rostedt  *
3973936e074bSSteven Rostedt  * Notrace Filters denote which functions should not be enabled when tracing
3974936e074bSSteven Rostedt  * is enabled. If @buf is NULL and reset is set, all functions will be enabled
3975936e074bSSteven Rostedt  * for tracing.
3976936e074bSSteven Rostedt  */
3977936e074bSSteven Rostedt void ftrace_set_global_notrace(unsigned char *buf, int len, int reset)
397841c52c0dSSteven Rostedt {
3979f45948e8SSteven Rostedt 	ftrace_set_regex(&global_ops, buf, len, reset, 0);
398077a2b37dSSteven Rostedt }
3981936e074bSSteven Rostedt EXPORT_SYMBOL_GPL(ftrace_set_global_notrace);
398277a2b37dSSteven Rostedt 
39832af15d6aSSteven Rostedt /*
39842af15d6aSSteven Rostedt  * command line interface to allow users to set filters on boot up.
39852af15d6aSSteven Rostedt  */
39862af15d6aSSteven Rostedt #define FTRACE_FILTER_SIZE		COMMAND_LINE_SIZE
39872af15d6aSSteven Rostedt static char ftrace_notrace_buf[FTRACE_FILTER_SIZE] __initdata;
39882af15d6aSSteven Rostedt static char ftrace_filter_buf[FTRACE_FILTER_SIZE] __initdata;
39892af15d6aSSteven Rostedt 
3990f1ed7c74SSteven Rostedt (Red Hat) /* Used by function selftest to not test if filter is set */
3991f1ed7c74SSteven Rostedt (Red Hat) bool ftrace_filter_param __initdata;
3992f1ed7c74SSteven Rostedt (Red Hat) 
39932af15d6aSSteven Rostedt static int __init set_ftrace_notrace(char *str)
39942af15d6aSSteven Rostedt {
3995f1ed7c74SSteven Rostedt (Red Hat) 	ftrace_filter_param = true;
399675761cc1SChen Gang 	strlcpy(ftrace_notrace_buf, str, FTRACE_FILTER_SIZE);
39972af15d6aSSteven Rostedt 	return 1;
39982af15d6aSSteven Rostedt }
39992af15d6aSSteven Rostedt __setup("ftrace_notrace=", set_ftrace_notrace);
40002af15d6aSSteven Rostedt 
40012af15d6aSSteven Rostedt static int __init set_ftrace_filter(char *str)
40022af15d6aSSteven Rostedt {
4003f1ed7c74SSteven Rostedt (Red Hat) 	ftrace_filter_param = true;
400475761cc1SChen Gang 	strlcpy(ftrace_filter_buf, str, FTRACE_FILTER_SIZE);
40052af15d6aSSteven Rostedt 	return 1;
40062af15d6aSSteven Rostedt }
40072af15d6aSSteven Rostedt __setup("ftrace_filter=", set_ftrace_filter);
40082af15d6aSSteven Rostedt 
4009369bc18fSStefan Assmann #ifdef CONFIG_FUNCTION_GRAPH_TRACER
4010f6060f46SLai Jiangshan static char ftrace_graph_buf[FTRACE_FILTER_SIZE] __initdata;
40110d7d9a16SNamhyung Kim static char ftrace_graph_notrace_buf[FTRACE_FILTER_SIZE] __initdata;
4012faf982a6SNamhyung Kim static int ftrace_set_func(unsigned long *array, int *idx, int size, char *buffer);
4013801c29fdSSteven Rostedt 
4014369bc18fSStefan Assmann static int __init set_graph_function(char *str)
4015369bc18fSStefan Assmann {
401606f43d66SFrederic Weisbecker 	strlcpy(ftrace_graph_buf, str, FTRACE_FILTER_SIZE);
4017369bc18fSStefan Assmann 	return 1;
4018369bc18fSStefan Assmann }
4019369bc18fSStefan Assmann __setup("ftrace_graph_filter=", set_graph_function);
4020369bc18fSStefan Assmann 
40210d7d9a16SNamhyung Kim static int __init set_graph_notrace_function(char *str)
40220d7d9a16SNamhyung Kim {
40230d7d9a16SNamhyung Kim 	strlcpy(ftrace_graph_notrace_buf, str, FTRACE_FILTER_SIZE);
40240d7d9a16SNamhyung Kim 	return 1;
40250d7d9a16SNamhyung Kim }
40260d7d9a16SNamhyung Kim __setup("ftrace_graph_notrace=", set_graph_notrace_function);
40270d7d9a16SNamhyung Kim 
40280d7d9a16SNamhyung Kim static void __init set_ftrace_early_graph(char *buf, int enable)
4029369bc18fSStefan Assmann {
4030369bc18fSStefan Assmann 	int ret;
4031369bc18fSStefan Assmann 	char *func;
40320d7d9a16SNamhyung Kim 	unsigned long *table = ftrace_graph_funcs;
40330d7d9a16SNamhyung Kim 	int *count = &ftrace_graph_count;
40340d7d9a16SNamhyung Kim 
40350d7d9a16SNamhyung Kim 	if (!enable) {
40360d7d9a16SNamhyung Kim 		table = ftrace_graph_notrace_funcs;
40370d7d9a16SNamhyung Kim 		count = &ftrace_graph_notrace_count;
40380d7d9a16SNamhyung Kim 	}
4039369bc18fSStefan Assmann 
4040369bc18fSStefan Assmann 	while (buf) {
4041369bc18fSStefan Assmann 		func = strsep(&buf, ",");
4042369bc18fSStefan Assmann 		/* we allow only one expression at a time */
40430d7d9a16SNamhyung Kim 		ret = ftrace_set_func(table, count, FTRACE_GRAPH_MAX_FUNCS, func);
4044369bc18fSStefan Assmann 		if (ret)
4045369bc18fSStefan Assmann 			printk(KERN_DEBUG "ftrace: function %s not "
4046369bc18fSStefan Assmann 					  "traceable\n", func);
4047369bc18fSStefan Assmann 	}
4048369bc18fSStefan Assmann }
4049369bc18fSStefan Assmann #endif /* CONFIG_FUNCTION_GRAPH_TRACER */
4050369bc18fSStefan Assmann 
40512a85a37fSSteven Rostedt void __init
40522a85a37fSSteven Rostedt ftrace_set_early_filter(struct ftrace_ops *ops, char *buf, int enable)
40532af15d6aSSteven Rostedt {
40542af15d6aSSteven Rostedt 	char *func;
40552af15d6aSSteven Rostedt 
4056f04f24fbSMasami Hiramatsu 	ftrace_ops_init(ops);
4057f04f24fbSMasami Hiramatsu 
40582af15d6aSSteven Rostedt 	while (buf) {
40592af15d6aSSteven Rostedt 		func = strsep(&buf, ",");
4060f45948e8SSteven Rostedt 		ftrace_set_regex(ops, func, strlen(func), 0, enable);
40612af15d6aSSteven Rostedt 	}
40622af15d6aSSteven Rostedt }
40632af15d6aSSteven Rostedt 
40642af15d6aSSteven Rostedt static void __init set_ftrace_early_filters(void)
40652af15d6aSSteven Rostedt {
40662af15d6aSSteven Rostedt 	if (ftrace_filter_buf[0])
40672a85a37fSSteven Rostedt 		ftrace_set_early_filter(&global_ops, ftrace_filter_buf, 1);
40682af15d6aSSteven Rostedt 	if (ftrace_notrace_buf[0])
40692a85a37fSSteven Rostedt 		ftrace_set_early_filter(&global_ops, ftrace_notrace_buf, 0);
4070369bc18fSStefan Assmann #ifdef CONFIG_FUNCTION_GRAPH_TRACER
4071369bc18fSStefan Assmann 	if (ftrace_graph_buf[0])
40720d7d9a16SNamhyung Kim 		set_ftrace_early_graph(ftrace_graph_buf, 1);
40730d7d9a16SNamhyung Kim 	if (ftrace_graph_notrace_buf[0])
40740d7d9a16SNamhyung Kim 		set_ftrace_early_graph(ftrace_graph_notrace_buf, 0);
4075369bc18fSStefan Assmann #endif /* CONFIG_FUNCTION_GRAPH_TRACER */
40762af15d6aSSteven Rostedt }
40772af15d6aSSteven Rostedt 
4078fc13cb0cSSteven Rostedt int ftrace_regex_release(struct inode *inode, struct file *file)
40795072c59fSSteven Rostedt {
40805072c59fSSteven Rostedt 	struct seq_file *m = (struct seq_file *)file->private_data;
40815072c59fSSteven Rostedt 	struct ftrace_iterator *iter;
408233dc9b12SSteven Rostedt 	struct ftrace_hash **orig_hash;
40833296fc4eSSteven Rostedt (Red Hat) 	struct ftrace_hash *old_hash;
4084689fd8b6S[email protected] 	struct trace_parser *parser;
4085ed926f9bSSteven Rostedt 	int filter_hash;
408633dc9b12SSteven Rostedt 	int ret;
40875072c59fSSteven Rostedt 
40885072c59fSSteven Rostedt 	if (file->f_mode & FMODE_READ) {
40895072c59fSSteven Rostedt 		iter = m->private;
40905072c59fSSteven Rostedt 		seq_release(inode, file);
40915072c59fSSteven Rostedt 	} else
40925072c59fSSteven Rostedt 		iter = file->private_data;
40935072c59fSSteven Rostedt 
4094689fd8b6S[email protected] 	parser = &iter->parser;
4095689fd8b6S[email protected] 	if (trace_parser_loaded(parser)) {
4096689fd8b6S[email protected] 		parser->buffer[parser->idx] = 0;
40971cf41dd7SSteven Rostedt 		ftrace_match_records(iter->hash, parser->buffer, parser->idx);
40985072c59fSSteven Rostedt 	}
40995072c59fSSteven Rostedt 
4100058e297dSSteven Rostedt 	trace_parser_put(parser);
4101058e297dSSteven Rostedt 
410233b7f99cSSteven Rostedt (Red Hat) 	mutex_lock(&iter->ops->func_hash->regex_lock);
41033f2367baSMasami Hiramatsu 
4104058e297dSSteven Rostedt 	if (file->f_mode & FMODE_WRITE) {
4105ed926f9bSSteven Rostedt 		filter_hash = !!(iter->flags & FTRACE_ITER_FILTER);
4106ed926f9bSSteven Rostedt 
4107ed926f9bSSteven Rostedt 		if (filter_hash)
410833b7f99cSSteven Rostedt (Red Hat) 			orig_hash = &iter->ops->func_hash->filter_hash;
4109ed926f9bSSteven Rostedt 		else
411033b7f99cSSteven Rostedt (Red Hat) 			orig_hash = &iter->ops->func_hash->notrace_hash;
411133dc9b12SSteven Rostedt 
4112e6ea44e9SSteven Rostedt 		mutex_lock(&ftrace_lock);
41133296fc4eSSteven Rostedt (Red Hat) 		old_hash = *orig_hash;
411441fb61c2SSteven Rostedt 		ret = ftrace_hash_move(iter->ops, filter_hash,
411541fb61c2SSteven Rostedt 				       orig_hash, iter->hash);
41163296fc4eSSteven Rostedt (Red Hat) 		if (!ret) {
41171c80c432SSteven Rostedt (Red Hat) 			ftrace_ops_update_code(iter->ops);
41183296fc4eSSteven Rostedt (Red Hat) 			free_ftrace_hash_rcu(old_hash);
41193296fc4eSSteven Rostedt (Red Hat) 		}
4120e6ea44e9SSteven Rostedt 		mutex_unlock(&ftrace_lock);
4121058e297dSSteven Rostedt 	}
41223f2367baSMasami Hiramatsu 
412333b7f99cSSteven Rostedt (Red Hat) 	mutex_unlock(&iter->ops->func_hash->regex_lock);
412433dc9b12SSteven Rostedt 	free_ftrace_hash(iter->hash);
412533dc9b12SSteven Rostedt 	kfree(iter);
4126689fd8b6S[email protected] 
41275072c59fSSteven Rostedt 	return 0;
41285072c59fSSteven Rostedt }
41295072c59fSSteven Rostedt 
41305e2336a0SSteven Rostedt static const struct file_operations ftrace_avail_fops = {
41315072c59fSSteven Rostedt 	.open = ftrace_avail_open,
41325072c59fSSteven Rostedt 	.read = seq_read,
41335072c59fSSteven Rostedt 	.llseek = seq_lseek,
41343be04b47SLi Zefan 	.release = seq_release_private,
41355072c59fSSteven Rostedt };
41365072c59fSSteven Rostedt 
4137647bcd03SSteven Rostedt static const struct file_operations ftrace_enabled_fops = {
4138647bcd03SSteven Rostedt 	.open = ftrace_enabled_open,
4139647bcd03SSteven Rostedt 	.read = seq_read,
4140647bcd03SSteven Rostedt 	.llseek = seq_lseek,
4141647bcd03SSteven Rostedt 	.release = seq_release_private,
4142647bcd03SSteven Rostedt };
4143647bcd03SSteven Rostedt 
41445e2336a0SSteven Rostedt static const struct file_operations ftrace_filter_fops = {
41455072c59fSSteven Rostedt 	.open = ftrace_filter_open,
4146850a80cfSLai Jiangshan 	.read = seq_read,
41475072c59fSSteven Rostedt 	.write = ftrace_filter_write,
4148098c879eSSteven Rostedt (Red Hat) 	.llseek = tracing_lseek,
41491cf41dd7SSteven Rostedt 	.release = ftrace_regex_release,
41505072c59fSSteven Rostedt };
41515072c59fSSteven Rostedt 
41525e2336a0SSteven Rostedt static const struct file_operations ftrace_notrace_fops = {
415341c52c0dSSteven Rostedt 	.open = ftrace_notrace_open,
4154850a80cfSLai Jiangshan 	.read = seq_read,
415541c52c0dSSteven Rostedt 	.write = ftrace_notrace_write,
4156098c879eSSteven Rostedt (Red Hat) 	.llseek = tracing_lseek,
41571cf41dd7SSteven Rostedt 	.release = ftrace_regex_release,
415841c52c0dSSteven Rostedt };
415941c52c0dSSteven Rostedt 
4160ea4e2bc4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
4161ea4e2bc4SSteven Rostedt 
4162ea4e2bc4SSteven Rostedt static DEFINE_MUTEX(graph_lock);
4163ea4e2bc4SSteven Rostedt 
4164ea4e2bc4SSteven Rostedt int ftrace_graph_count;
416529ad23b0SNamhyung Kim int ftrace_graph_notrace_count;
4166ea4e2bc4SSteven Rostedt unsigned long ftrace_graph_funcs[FTRACE_GRAPH_MAX_FUNCS] __read_mostly;
416729ad23b0SNamhyung Kim unsigned long ftrace_graph_notrace_funcs[FTRACE_GRAPH_MAX_FUNCS] __read_mostly;
4168ea4e2bc4SSteven Rostedt 
4169faf982a6SNamhyung Kim struct ftrace_graph_data {
4170faf982a6SNamhyung Kim 	unsigned long *table;
4171faf982a6SNamhyung Kim 	size_t size;
4172faf982a6SNamhyung Kim 	int *count;
4173faf982a6SNamhyung Kim 	const struct seq_operations *seq_ops;
4174faf982a6SNamhyung Kim };
4175faf982a6SNamhyung Kim 
4176ea4e2bc4SSteven Rostedt static void *
417785951842SLi Zefan __g_next(struct seq_file *m, loff_t *pos)
4178ea4e2bc4SSteven Rostedt {
4179faf982a6SNamhyung Kim 	struct ftrace_graph_data *fgd = m->private;
4180faf982a6SNamhyung Kim 
4181faf982a6SNamhyung Kim 	if (*pos >= *fgd->count)
4182ea4e2bc4SSteven Rostedt 		return NULL;
4183faf982a6SNamhyung Kim 	return &fgd->table[*pos];
418485951842SLi Zefan }
4185ea4e2bc4SSteven Rostedt 
418685951842SLi Zefan static void *
418785951842SLi Zefan g_next(struct seq_file *m, void *v, loff_t *pos)
418885951842SLi Zefan {
418985951842SLi Zefan 	(*pos)++;
419085951842SLi Zefan 	return __g_next(m, pos);
4191ea4e2bc4SSteven Rostedt }
4192ea4e2bc4SSteven Rostedt 
4193ea4e2bc4SSteven Rostedt static void *g_start(struct seq_file *m, loff_t *pos)
4194ea4e2bc4SSteven Rostedt {
4195faf982a6SNamhyung Kim 	struct ftrace_graph_data *fgd = m->private;
4196faf982a6SNamhyung Kim 
4197ea4e2bc4SSteven Rostedt 	mutex_lock(&graph_lock);
4198ea4e2bc4SSteven Rostedt 
4199f9349a8fSFrederic Weisbecker 	/* Nothing, tell g_show to print all functions are enabled */
4200faf982a6SNamhyung Kim 	if (!*fgd->count && !*pos)
4201f9349a8fSFrederic Weisbecker 		return (void *)1;
4202f9349a8fSFrederic Weisbecker 
420385951842SLi Zefan 	return __g_next(m, pos);
4204ea4e2bc4SSteven Rostedt }
4205ea4e2bc4SSteven Rostedt 
4206ea4e2bc4SSteven Rostedt static void g_stop(struct seq_file *m, void *p)
4207ea4e2bc4SSteven Rostedt {
4208ea4e2bc4SSteven Rostedt 	mutex_unlock(&graph_lock);
4209ea4e2bc4SSteven Rostedt }
4210ea4e2bc4SSteven Rostedt 
4211ea4e2bc4SSteven Rostedt static int g_show(struct seq_file *m, void *v)
4212ea4e2bc4SSteven Rostedt {
4213ea4e2bc4SSteven Rostedt 	unsigned long *ptr = v;
4214ea4e2bc4SSteven Rostedt 
4215ea4e2bc4SSteven Rostedt 	if (!ptr)
4216ea4e2bc4SSteven Rostedt 		return 0;
4217ea4e2bc4SSteven Rostedt 
4218f9349a8fSFrederic Weisbecker 	if (ptr == (unsigned long *)1) {
4219280d1429SNamhyung Kim 		struct ftrace_graph_data *fgd = m->private;
4220280d1429SNamhyung Kim 
4221280d1429SNamhyung Kim 		if (fgd->table == ftrace_graph_funcs)
4222f9349a8fSFrederic Weisbecker 			seq_printf(m, "#### all functions enabled ####\n");
4223280d1429SNamhyung Kim 		else
4224280d1429SNamhyung Kim 			seq_printf(m, "#### no functions disabled ####\n");
4225f9349a8fSFrederic Weisbecker 		return 0;
4226f9349a8fSFrederic Weisbecker 	}
4227f9349a8fSFrederic Weisbecker 
4228b375a11aSSteven Rostedt 	seq_printf(m, "%ps\n", (void *)*ptr);
4229ea4e2bc4SSteven Rostedt 
4230ea4e2bc4SSteven Rostedt 	return 0;
4231ea4e2bc4SSteven Rostedt }
4232ea4e2bc4SSteven Rostedt 
423388e9d34cSJames Morris static const struct seq_operations ftrace_graph_seq_ops = {
4234ea4e2bc4SSteven Rostedt 	.start = g_start,
4235ea4e2bc4SSteven Rostedt 	.next = g_next,
4236ea4e2bc4SSteven Rostedt 	.stop = g_stop,
4237ea4e2bc4SSteven Rostedt 	.show = g_show,
4238ea4e2bc4SSteven Rostedt };
4239ea4e2bc4SSteven Rostedt 
4240ea4e2bc4SSteven Rostedt static int
4241faf982a6SNamhyung Kim __ftrace_graph_open(struct inode *inode, struct file *file,
4242faf982a6SNamhyung Kim 		    struct ftrace_graph_data *fgd)
4243ea4e2bc4SSteven Rostedt {
4244ea4e2bc4SSteven Rostedt 	int ret = 0;
4245ea4e2bc4SSteven Rostedt 
4246ea4e2bc4SSteven Rostedt 	mutex_lock(&graph_lock);
4247ea4e2bc4SSteven Rostedt 	if ((file->f_mode & FMODE_WRITE) &&
42488650ae32SSteven Rostedt 	    (file->f_flags & O_TRUNC)) {
4249faf982a6SNamhyung Kim 		*fgd->count = 0;
4250faf982a6SNamhyung Kim 		memset(fgd->table, 0, fgd->size * sizeof(*fgd->table));
4251ea4e2bc4SSteven Rostedt 	}
4252ea4e2bc4SSteven Rostedt 	mutex_unlock(&graph_lock);
4253ea4e2bc4SSteven Rostedt 
4254faf982a6SNamhyung Kim 	if (file->f_mode & FMODE_READ) {
4255faf982a6SNamhyung Kim 		ret = seq_open(file, fgd->seq_ops);
4256faf982a6SNamhyung Kim 		if (!ret) {
4257faf982a6SNamhyung Kim 			struct seq_file *m = file->private_data;
4258faf982a6SNamhyung Kim 			m->private = fgd;
4259faf982a6SNamhyung Kim 		}
4260faf982a6SNamhyung Kim 	} else
4261faf982a6SNamhyung Kim 		file->private_data = fgd;
4262a4ec5e0cSLi Zefan 
4263ea4e2bc4SSteven Rostedt 	return ret;
4264ea4e2bc4SSteven Rostedt }
4265ea4e2bc4SSteven Rostedt 
4266ea4e2bc4SSteven Rostedt static int
4267faf982a6SNamhyung Kim ftrace_graph_open(struct inode *inode, struct file *file)
4268faf982a6SNamhyung Kim {
4269faf982a6SNamhyung Kim 	struct ftrace_graph_data *fgd;
4270faf982a6SNamhyung Kim 
4271faf982a6SNamhyung Kim 	if (unlikely(ftrace_disabled))
4272faf982a6SNamhyung Kim 		return -ENODEV;
4273faf982a6SNamhyung Kim 
4274faf982a6SNamhyung Kim 	fgd = kmalloc(sizeof(*fgd), GFP_KERNEL);
4275faf982a6SNamhyung Kim 	if (fgd == NULL)
4276faf982a6SNamhyung Kim 		return -ENOMEM;
4277faf982a6SNamhyung Kim 
4278faf982a6SNamhyung Kim 	fgd->table = ftrace_graph_funcs;
4279faf982a6SNamhyung Kim 	fgd->size = FTRACE_GRAPH_MAX_FUNCS;
4280faf982a6SNamhyung Kim 	fgd->count = &ftrace_graph_count;
4281faf982a6SNamhyung Kim 	fgd->seq_ops = &ftrace_graph_seq_ops;
4282faf982a6SNamhyung Kim 
4283faf982a6SNamhyung Kim 	return __ftrace_graph_open(inode, file, fgd);
4284faf982a6SNamhyung Kim }
4285faf982a6SNamhyung Kim 
4286faf982a6SNamhyung Kim static int
428729ad23b0SNamhyung Kim ftrace_graph_notrace_open(struct inode *inode, struct file *file)
428829ad23b0SNamhyung Kim {
428929ad23b0SNamhyung Kim 	struct ftrace_graph_data *fgd;
429029ad23b0SNamhyung Kim 
429129ad23b0SNamhyung Kim 	if (unlikely(ftrace_disabled))
429229ad23b0SNamhyung Kim 		return -ENODEV;
429329ad23b0SNamhyung Kim 
429429ad23b0SNamhyung Kim 	fgd = kmalloc(sizeof(*fgd), GFP_KERNEL);
429529ad23b0SNamhyung Kim 	if (fgd == NULL)
429629ad23b0SNamhyung Kim 		return -ENOMEM;
429729ad23b0SNamhyung Kim 
429829ad23b0SNamhyung Kim 	fgd->table = ftrace_graph_notrace_funcs;
429929ad23b0SNamhyung Kim 	fgd->size = FTRACE_GRAPH_MAX_FUNCS;
430029ad23b0SNamhyung Kim 	fgd->count = &ftrace_graph_notrace_count;
430129ad23b0SNamhyung Kim 	fgd->seq_ops = &ftrace_graph_seq_ops;
430229ad23b0SNamhyung Kim 
430329ad23b0SNamhyung Kim 	return __ftrace_graph_open(inode, file, fgd);
430429ad23b0SNamhyung Kim }
430529ad23b0SNamhyung Kim 
430629ad23b0SNamhyung Kim static int
430787827111SLi Zefan ftrace_graph_release(struct inode *inode, struct file *file)
430887827111SLi Zefan {
4309faf982a6SNamhyung Kim 	if (file->f_mode & FMODE_READ) {
4310faf982a6SNamhyung Kim 		struct seq_file *m = file->private_data;
4311faf982a6SNamhyung Kim 
4312faf982a6SNamhyung Kim 		kfree(m->private);
431387827111SLi Zefan 		seq_release(inode, file);
4314faf982a6SNamhyung Kim 	} else {
4315faf982a6SNamhyung Kim 		kfree(file->private_data);
4316faf982a6SNamhyung Kim 	}
4317faf982a6SNamhyung Kim 
431887827111SLi Zefan 	return 0;
431987827111SLi Zefan }
432087827111SLi Zefan 
432187827111SLi Zefan static int
4322faf982a6SNamhyung Kim ftrace_set_func(unsigned long *array, int *idx, int size, char *buffer)
4323ea4e2bc4SSteven Rostedt {
4324ea4e2bc4SSteven Rostedt 	struct dyn_ftrace *rec;
4325ea4e2bc4SSteven Rostedt 	struct ftrace_page *pg;
4326f9349a8fSFrederic Weisbecker 	int search_len;
4327c7c6b1feSLi Zefan 	int fail = 1;
4328f9349a8fSFrederic Weisbecker 	int type, not;
4329f9349a8fSFrederic Weisbecker 	char *search;
4330f9349a8fSFrederic Weisbecker 	bool exists;
4331f9349a8fSFrederic Weisbecker 	int i;
4332ea4e2bc4SSteven Rostedt 
4333f9349a8fSFrederic Weisbecker 	/* decode regex */
43343f6fe06dSFrederic Weisbecker 	type = filter_parse_regex(buffer, strlen(buffer), &search, &not);
4335faf982a6SNamhyung Kim 	if (!not && *idx >= size)
4336c7c6b1feSLi Zefan 		return -EBUSY;
4337f9349a8fSFrederic Weisbecker 
4338f9349a8fSFrederic Weisbecker 	search_len = strlen(search);
4339f9349a8fSFrederic Weisbecker 
434052baf119SSteven Rostedt 	mutex_lock(&ftrace_lock);
434145a4a237SSteven Rostedt 
434245a4a237SSteven Rostedt 	if (unlikely(ftrace_disabled)) {
434345a4a237SSteven Rostedt 		mutex_unlock(&ftrace_lock);
434445a4a237SSteven Rostedt 		return -ENODEV;
434545a4a237SSteven Rostedt 	}
434645a4a237SSteven Rostedt 
4347265c831cSSteven Rostedt 	do_for_each_ftrace_rec(pg, rec) {
4348ea4e2bc4SSteven Rostedt 
4349b9df92d2SSteven Rostedt 		if (ftrace_match_record(rec, NULL, search, search_len, type)) {
4350c7c6b1feSLi Zefan 			/* if it is in the array */
4351f9349a8fSFrederic Weisbecker 			exists = false;
4352c7c6b1feSLi Zefan 			for (i = 0; i < *idx; i++) {
4353f9349a8fSFrederic Weisbecker 				if (array[i] == rec->ip) {
4354f9349a8fSFrederic Weisbecker 					exists = true;
4355faec2ec5SLiming Wang 					break;
4356faec2ec5SLiming Wang 				}
4357c7c6b1feSLi Zefan 			}
4358c7c6b1feSLi Zefan 
4359c7c6b1feSLi Zefan 			if (!not) {
4360c7c6b1feSLi Zefan 				fail = 0;
4361c7c6b1feSLi Zefan 				if (!exists) {
4362f9349a8fSFrederic Weisbecker 					array[(*idx)++] = rec->ip;
4363faf982a6SNamhyung Kim 					if (*idx >= size)
4364c7c6b1feSLi Zefan 						goto out;
4365c7c6b1feSLi Zefan 				}
4366c7c6b1feSLi Zefan 			} else {
4367c7c6b1feSLi Zefan 				if (exists) {
4368c7c6b1feSLi Zefan 					array[i] = array[--(*idx)];
4369c7c6b1feSLi Zefan 					array[*idx] = 0;
4370c7c6b1feSLi Zefan 					fail = 0;
4371c7c6b1feSLi Zefan 				}
4372c7c6b1feSLi Zefan 			}
4373f9349a8fSFrederic Weisbecker 		}
4374265c831cSSteven Rostedt 	} while_for_each_ftrace_rec();
4375c7c6b1feSLi Zefan out:
437652baf119SSteven Rostedt 	mutex_unlock(&ftrace_lock);
4377ea4e2bc4SSteven Rostedt 
4378c7c6b1feSLi Zefan 	if (fail)
4379c7c6b1feSLi Zefan 		return -EINVAL;
4380c7c6b1feSLi Zefan 
4381c7c6b1feSLi Zefan 	return 0;
4382ea4e2bc4SSteven Rostedt }
4383ea4e2bc4SSteven Rostedt 
4384ea4e2bc4SSteven Rostedt static ssize_t
4385ea4e2bc4SSteven Rostedt ftrace_graph_write(struct file *file, const char __user *ubuf,
4386ea4e2bc4SSteven Rostedt 		   size_t cnt, loff_t *ppos)
4387ea4e2bc4SSteven Rostedt {
4388689fd8b6S[email protected] 	struct trace_parser parser;
43896a10108bSNamhyung Kim 	ssize_t read, ret = 0;
4390faf982a6SNamhyung Kim 	struct ftrace_graph_data *fgd = file->private_data;
4391ea4e2bc4SSteven Rostedt 
4392c7c6b1feSLi Zefan 	if (!cnt)
4393ea4e2bc4SSteven Rostedt 		return 0;
4394ea4e2bc4SSteven Rostedt 
43956a10108bSNamhyung Kim 	if (trace_parser_get_init(&parser, FTRACE_BUFF_MAX))
43966a10108bSNamhyung Kim 		return -ENOMEM;
4397ea4e2bc4SSteven Rostedt 
4398689fd8b6S[email protected] 	read = trace_get_user(&parser, ubuf, cnt, ppos);
4399689fd8b6S[email protected] 
44004ba7978eSLi Zefan 	if (read >= 0 && trace_parser_loaded((&parser))) {
4401689fd8b6S[email protected] 		parser.buffer[parser.idx] = 0;
4402ea4e2bc4SSteven Rostedt 
44036a10108bSNamhyung Kim 		mutex_lock(&graph_lock);
44046a10108bSNamhyung Kim 
4405f9349a8fSFrederic Weisbecker 		/* we allow only one expression at a time */
4406faf982a6SNamhyung Kim 		ret = ftrace_set_func(fgd->table, fgd->count, fgd->size,
4407689fd8b6S[email protected] 				      parser.buffer);
44086a10108bSNamhyung Kim 
44096a10108bSNamhyung Kim 		mutex_unlock(&graph_lock);
4410689fd8b6S[email protected] 	}
4411ea4e2bc4SSteven Rostedt 
44126a10108bSNamhyung Kim 	if (!ret)
4413ea4e2bc4SSteven Rostedt 		ret = read;
44141eb90f13SLi Zefan 
4415689fd8b6S[email protected] 	trace_parser_put(&parser);
4416ea4e2bc4SSteven Rostedt 
4417ea4e2bc4SSteven Rostedt 	return ret;
4418ea4e2bc4SSteven Rostedt }
4419ea4e2bc4SSteven Rostedt 
4420ea4e2bc4SSteven Rostedt static const struct file_operations ftrace_graph_fops = {
4421ea4e2bc4SSteven Rostedt 	.open		= ftrace_graph_open,
4422850a80cfSLai Jiangshan 	.read		= seq_read,
4423ea4e2bc4SSteven Rostedt 	.write		= ftrace_graph_write,
4424098c879eSSteven Rostedt (Red Hat) 	.llseek		= tracing_lseek,
442587827111SLi Zefan 	.release	= ftrace_graph_release,
4426ea4e2bc4SSteven Rostedt };
442729ad23b0SNamhyung Kim 
442829ad23b0SNamhyung Kim static const struct file_operations ftrace_graph_notrace_fops = {
442929ad23b0SNamhyung Kim 	.open		= ftrace_graph_notrace_open,
443029ad23b0SNamhyung Kim 	.read		= seq_read,
443129ad23b0SNamhyung Kim 	.write		= ftrace_graph_write,
4432098c879eSSteven Rostedt (Red Hat) 	.llseek		= tracing_lseek,
443329ad23b0SNamhyung Kim 	.release	= ftrace_graph_release,
443429ad23b0SNamhyung Kim };
4435ea4e2bc4SSteven Rostedt #endif /* CONFIG_FUNCTION_GRAPH_TRACER */
4436ea4e2bc4SSteven Rostedt 
4437591dffdaSSteven Rostedt (Red Hat) void ftrace_create_filter_files(struct ftrace_ops *ops,
4438591dffdaSSteven Rostedt (Red Hat) 				struct dentry *parent)
4439591dffdaSSteven Rostedt (Red Hat) {
4440591dffdaSSteven Rostedt (Red Hat) 
4441591dffdaSSteven Rostedt (Red Hat) 	trace_create_file("set_ftrace_filter", 0644, parent,
4442591dffdaSSteven Rostedt (Red Hat) 			  ops, &ftrace_filter_fops);
4443591dffdaSSteven Rostedt (Red Hat) 
4444591dffdaSSteven Rostedt (Red Hat) 	trace_create_file("set_ftrace_notrace", 0644, parent,
4445591dffdaSSteven Rostedt (Red Hat) 			  ops, &ftrace_notrace_fops);
4446591dffdaSSteven Rostedt (Red Hat) }
4447591dffdaSSteven Rostedt (Red Hat) 
4448591dffdaSSteven Rostedt (Red Hat) /*
4449591dffdaSSteven Rostedt (Red Hat)  * The name "destroy_filter_files" is really a misnomer. Although
4450591dffdaSSteven Rostedt (Red Hat)  * in the future, it may actualy delete the files, but this is
4451591dffdaSSteven Rostedt (Red Hat)  * really intended to make sure the ops passed in are disabled
4452591dffdaSSteven Rostedt (Red Hat)  * and that when this function returns, the caller is free to
4453591dffdaSSteven Rostedt (Red Hat)  * free the ops.
4454591dffdaSSteven Rostedt (Red Hat)  *
4455591dffdaSSteven Rostedt (Red Hat)  * The "destroy" name is only to match the "create" name that this
4456591dffdaSSteven Rostedt (Red Hat)  * should be paired with.
4457591dffdaSSteven Rostedt (Red Hat)  */
4458591dffdaSSteven Rostedt (Red Hat) void ftrace_destroy_filter_files(struct ftrace_ops *ops)
4459591dffdaSSteven Rostedt (Red Hat) {
4460591dffdaSSteven Rostedt (Red Hat) 	mutex_lock(&ftrace_lock);
4461591dffdaSSteven Rostedt (Red Hat) 	if (ops->flags & FTRACE_OPS_FL_ENABLED)
4462591dffdaSSteven Rostedt (Red Hat) 		ftrace_shutdown(ops, 0);
4463591dffdaSSteven Rostedt (Red Hat) 	ops->flags |= FTRACE_OPS_FL_DELETED;
4464591dffdaSSteven Rostedt (Red Hat) 	mutex_unlock(&ftrace_lock);
4465591dffdaSSteven Rostedt (Red Hat) }
4466591dffdaSSteven Rostedt (Red Hat) 
4467df4fc315SSteven Rostedt static __init int ftrace_init_dyn_debugfs(struct dentry *d_tracer)
44685072c59fSSteven Rostedt {
44695072c59fSSteven Rostedt 
44705452af66SFrederic Weisbecker 	trace_create_file("available_filter_functions", 0444,
44715072c59fSSteven Rostedt 			d_tracer, NULL, &ftrace_avail_fops);
44725072c59fSSteven Rostedt 
4473647bcd03SSteven Rostedt 	trace_create_file("enabled_functions", 0444,
4474647bcd03SSteven Rostedt 			d_tracer, NULL, &ftrace_enabled_fops);
4475647bcd03SSteven Rostedt 
4476591dffdaSSteven Rostedt (Red Hat) 	ftrace_create_filter_files(&global_ops, d_tracer);
4477ad90c0e3SSteven Rostedt 
4478ea4e2bc4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
44795452af66SFrederic Weisbecker 	trace_create_file("set_graph_function", 0444, d_tracer,
4480ea4e2bc4SSteven Rostedt 				    NULL,
4481ea4e2bc4SSteven Rostedt 				    &ftrace_graph_fops);
448229ad23b0SNamhyung Kim 	trace_create_file("set_graph_notrace", 0444, d_tracer,
448329ad23b0SNamhyung Kim 				    NULL,
448429ad23b0SNamhyung Kim 				    &ftrace_graph_notrace_fops);
4485ea4e2bc4SSteven Rostedt #endif /* CONFIG_FUNCTION_GRAPH_TRACER */
4486ea4e2bc4SSteven Rostedt 
44875072c59fSSteven Rostedt 	return 0;
44885072c59fSSteven Rostedt }
44895072c59fSSteven Rostedt 
44909fd49328SSteven Rostedt static int ftrace_cmp_ips(const void *a, const void *b)
449168950619SSteven Rostedt {
44929fd49328SSteven Rostedt 	const unsigned long *ipa = a;
44939fd49328SSteven Rostedt 	const unsigned long *ipb = b;
449468950619SSteven Rostedt 
44959fd49328SSteven Rostedt 	if (*ipa > *ipb)
44969fd49328SSteven Rostedt 		return 1;
44979fd49328SSteven Rostedt 	if (*ipa < *ipb)
44989fd49328SSteven Rostedt 		return -1;
44999fd49328SSteven Rostedt 	return 0;
45009fd49328SSteven Rostedt }
45019fd49328SSteven Rostedt 
45029fd49328SSteven Rostedt static void ftrace_swap_ips(void *a, void *b, int size)
45039fd49328SSteven Rostedt {
45049fd49328SSteven Rostedt 	unsigned long *ipa = a;
45059fd49328SSteven Rostedt 	unsigned long *ipb = b;
45069fd49328SSteven Rostedt 	unsigned long t;
45079fd49328SSteven Rostedt 
45089fd49328SSteven Rostedt 	t = *ipa;
45099fd49328SSteven Rostedt 	*ipa = *ipb;
45109fd49328SSteven Rostedt 	*ipb = t;
451168950619SSteven Rostedt }
451268950619SSteven Rostedt 
45135cb084bbSJiri Olsa static int ftrace_process_locs(struct module *mod,
451431e88909SSteven Rostedt 			       unsigned long *start,
451568bf21aaSSteven Rostedt 			       unsigned long *end)
451668bf21aaSSteven Rostedt {
4517706c81f8SSteven Rostedt 	struct ftrace_page *start_pg;
4518a7900875SSteven Rostedt 	struct ftrace_page *pg;
4519706c81f8SSteven Rostedt 	struct dyn_ftrace *rec;
4520a7900875SSteven Rostedt 	unsigned long count;
452168bf21aaSSteven Rostedt 	unsigned long *p;
452268bf21aaSSteven Rostedt 	unsigned long addr;
45234376cac6SSteven Rostedt 	unsigned long flags = 0; /* Shut up gcc */
4524a7900875SSteven Rostedt 	int ret = -ENOMEM;
4525a7900875SSteven Rostedt 
4526a7900875SSteven Rostedt 	count = end - start;
4527a7900875SSteven Rostedt 
4528a7900875SSteven Rostedt 	if (!count)
4529a7900875SSteven Rostedt 		return 0;
4530a7900875SSteven Rostedt 
45319fd49328SSteven Rostedt 	sort(start, count, sizeof(*start),
45329fd49328SSteven Rostedt 	     ftrace_cmp_ips, ftrace_swap_ips);
45339fd49328SSteven Rostedt 
4534706c81f8SSteven Rostedt 	start_pg = ftrace_allocate_pages(count);
4535706c81f8SSteven Rostedt 	if (!start_pg)
4536a7900875SSteven Rostedt 		return -ENOMEM;
453768bf21aaSSteven Rostedt 
4538e6ea44e9SSteven Rostedt 	mutex_lock(&ftrace_lock);
4539a7900875SSteven Rostedt 
454032082309SSteven Rostedt 	/*
454132082309SSteven Rostedt 	 * Core and each module needs their own pages, as
454232082309SSteven Rostedt 	 * modules will free them when they are removed.
454332082309SSteven Rostedt 	 * Force a new page to be allocated for modules.
454432082309SSteven Rostedt 	 */
4545a7900875SSteven Rostedt 	if (!mod) {
4546a7900875SSteven Rostedt 		WARN_ON(ftrace_pages || ftrace_pages_start);
4547a7900875SSteven Rostedt 		/* First initialization */
4548706c81f8SSteven Rostedt 		ftrace_pages = ftrace_pages_start = start_pg;
4549a7900875SSteven Rostedt 	} else {
455032082309SSteven Rostedt 		if (!ftrace_pages)
4551a7900875SSteven Rostedt 			goto out;
455232082309SSteven Rostedt 
4553a7900875SSteven Rostedt 		if (WARN_ON(ftrace_pages->next)) {
4554a7900875SSteven Rostedt 			/* Hmm, we have free pages? */
4555a7900875SSteven Rostedt 			while (ftrace_pages->next)
455632082309SSteven Rostedt 				ftrace_pages = ftrace_pages->next;
455732082309SSteven Rostedt 		}
4558a7900875SSteven Rostedt 
4559706c81f8SSteven Rostedt 		ftrace_pages->next = start_pg;
456032082309SSteven Rostedt 	}
456132082309SSteven Rostedt 
456268bf21aaSSteven Rostedt 	p = start;
4563706c81f8SSteven Rostedt 	pg = start_pg;
456468bf21aaSSteven Rostedt 	while (p < end) {
456568bf21aaSSteven Rostedt 		addr = ftrace_call_adjust(*p++);
456620e5227eSSteven Rostedt 		/*
456720e5227eSSteven Rostedt 		 * Some architecture linkers will pad between
456820e5227eSSteven Rostedt 		 * the different mcount_loc sections of different
456920e5227eSSteven Rostedt 		 * object files to satisfy alignments.
457020e5227eSSteven Rostedt 		 * Skip any NULL pointers.
457120e5227eSSteven Rostedt 		 */
457220e5227eSSteven Rostedt 		if (!addr)
457320e5227eSSteven Rostedt 			continue;
4574706c81f8SSteven Rostedt 
4575706c81f8SSteven Rostedt 		if (pg->index == pg->size) {
4576706c81f8SSteven Rostedt 			/* We should have allocated enough */
4577706c81f8SSteven Rostedt 			if (WARN_ON(!pg->next))
4578a7900875SSteven Rostedt 				break;
4579706c81f8SSteven Rostedt 			pg = pg->next;
458068bf21aaSSteven Rostedt 		}
458168bf21aaSSteven Rostedt 
4582706c81f8SSteven Rostedt 		rec = &pg->records[pg->index++];
4583706c81f8SSteven Rostedt 		rec->ip = addr;
4584706c81f8SSteven Rostedt 	}
4585706c81f8SSteven Rostedt 
4586706c81f8SSteven Rostedt 	/* We should have used all pages */
4587706c81f8SSteven Rostedt 	WARN_ON(pg->next);
4588706c81f8SSteven Rostedt 
4589706c81f8SSteven Rostedt 	/* Assign the last page to ftrace_pages */
4590706c81f8SSteven Rostedt 	ftrace_pages = pg;
4591706c81f8SSteven Rostedt 
4592a4f18ed1SSteven Rostedt 	/*
45934376cac6SSteven Rostedt 	 * We only need to disable interrupts on start up
45944376cac6SSteven Rostedt 	 * because we are modifying code that an interrupt
45954376cac6SSteven Rostedt 	 * may execute, and the modification is not atomic.
45964376cac6SSteven Rostedt 	 * But for modules, nothing runs the code we modify
45974376cac6SSteven Rostedt 	 * until we are finished with it, and there's no
45984376cac6SSteven Rostedt 	 * reason to cause large interrupt latencies while we do it.
4599a4f18ed1SSteven Rostedt 	 */
46004376cac6SSteven Rostedt 	if (!mod)
4601a4f18ed1SSteven Rostedt 		local_irq_save(flags);
46021dc43cf0SJiri Slaby 	ftrace_update_code(mod, start_pg);
46034376cac6SSteven Rostedt 	if (!mod)
4604a4f18ed1SSteven Rostedt 		local_irq_restore(flags);
4605a7900875SSteven Rostedt 	ret = 0;
4606a7900875SSteven Rostedt  out:
4607e6ea44e9SSteven Rostedt 	mutex_unlock(&ftrace_lock);
460868bf21aaSSteven Rostedt 
4609a7900875SSteven Rostedt 	return ret;
461068bf21aaSSteven Rostedt }
461168bf21aaSSteven Rostedt 
461293eb677dSSteven Rostedt #ifdef CONFIG_MODULES
461332082309SSteven Rostedt 
461432082309SSteven Rostedt #define next_to_ftrace_page(p) container_of(p, struct ftrace_page, next)
461532082309SSteven Rostedt 
4616e7247a15S[email protected] void ftrace_release_mod(struct module *mod)
461793eb677dSSteven Rostedt {
461893eb677dSSteven Rostedt 	struct dyn_ftrace *rec;
461932082309SSteven Rostedt 	struct ftrace_page **last_pg;
462093eb677dSSteven Rostedt 	struct ftrace_page *pg;
4621a7900875SSteven Rostedt 	int order;
462293eb677dSSteven Rostedt 
462393eb677dSSteven Rostedt 	mutex_lock(&ftrace_lock);
462445a4a237SSteven Rostedt 
462545a4a237SSteven Rostedt 	if (ftrace_disabled)
462645a4a237SSteven Rostedt 		goto out_unlock;
462745a4a237SSteven Rostedt 
462832082309SSteven Rostedt 	/*
462932082309SSteven Rostedt 	 * Each module has its own ftrace_pages, remove
463032082309SSteven Rostedt 	 * them from the list.
463132082309SSteven Rostedt 	 */
463232082309SSteven Rostedt 	last_pg = &ftrace_pages_start;
463332082309SSteven Rostedt 	for (pg = ftrace_pages_start; pg; pg = *last_pg) {
463432082309SSteven Rostedt 		rec = &pg->records[0];
4635e7247a15S[email protected] 		if (within_module_core(rec->ip, mod)) {
463693eb677dSSteven Rostedt 			/*
463732082309SSteven Rostedt 			 * As core pages are first, the first
463832082309SSteven Rostedt 			 * page should never be a module page.
463993eb677dSSteven Rostedt 			 */
464032082309SSteven Rostedt 			if (WARN_ON(pg == ftrace_pages_start))
464132082309SSteven Rostedt 				goto out_unlock;
464232082309SSteven Rostedt 
464332082309SSteven Rostedt 			/* Check if we are deleting the last page */
464432082309SSteven Rostedt 			if (pg == ftrace_pages)
464532082309SSteven Rostedt 				ftrace_pages = next_to_ftrace_page(last_pg);
464632082309SSteven Rostedt 
464732082309SSteven Rostedt 			*last_pg = pg->next;
4648a7900875SSteven Rostedt 			order = get_count_order(pg->size / ENTRIES_PER_PAGE);
4649a7900875SSteven Rostedt 			free_pages((unsigned long)pg->records, order);
4650a7900875SSteven Rostedt 			kfree(pg);
465132082309SSteven Rostedt 		} else
465232082309SSteven Rostedt 			last_pg = &pg->next;
465393eb677dSSteven Rostedt 	}
465445a4a237SSteven Rostedt  out_unlock:
465593eb677dSSteven Rostedt 	mutex_unlock(&ftrace_lock);
465693eb677dSSteven Rostedt }
465793eb677dSSteven Rostedt 
465893eb677dSSteven Rostedt static void ftrace_init_module(struct module *mod,
465931e88909SSteven Rostedt 			       unsigned long *start, unsigned long *end)
466090d595feSSteven Rostedt {
466100fd61aeSSteven Rostedt 	if (ftrace_disabled || start == end)
4662fed1939cSSteven Rostedt 		return;
46635cb084bbSJiri Olsa 	ftrace_process_locs(mod, start, end);
466490d595feSSteven Rostedt }
466590d595feSSteven Rostedt 
4666a949ae56SSteven Rostedt (Red Hat) void ftrace_module_init(struct module *mod)
466793eb677dSSteven Rostedt {
466893eb677dSSteven Rostedt 	ftrace_init_module(mod, mod->ftrace_callsites,
466993eb677dSSteven Rostedt 			   mod->ftrace_callsites +
467093eb677dSSteven Rostedt 			   mod->num_ftrace_callsites);
467193eb677dSSteven Rostedt }
467293eb677dSSteven Rostedt 
46738c189ea6SSteven Rostedt (Red Hat) static int ftrace_module_notify_exit(struct notifier_block *self,
46748c189ea6SSteven Rostedt (Red Hat) 				     unsigned long val, void *data)
46758c189ea6SSteven Rostedt (Red Hat) {
46768c189ea6SSteven Rostedt (Red Hat) 	struct module *mod = data;
46778c189ea6SSteven Rostedt (Red Hat) 
46788c189ea6SSteven Rostedt (Red Hat) 	if (val == MODULE_STATE_GOING)
46798c189ea6SSteven Rostedt (Red Hat) 		ftrace_release_mod(mod);
46808c189ea6SSteven Rostedt (Red Hat) 
468193eb677dSSteven Rostedt 	return 0;
468293eb677dSSteven Rostedt }
468393eb677dSSteven Rostedt #else
46848c189ea6SSteven Rostedt (Red Hat) static int ftrace_module_notify_exit(struct notifier_block *self,
468593eb677dSSteven Rostedt 				     unsigned long val, void *data)
468693eb677dSSteven Rostedt {
468793eb677dSSteven Rostedt 	return 0;
468893eb677dSSteven Rostedt }
468993eb677dSSteven Rostedt #endif /* CONFIG_MODULES */
469093eb677dSSteven Rostedt 
46918c189ea6SSteven Rostedt (Red Hat) struct notifier_block ftrace_module_exit_nb = {
46928c189ea6SSteven Rostedt (Red Hat) 	.notifier_call = ftrace_module_notify_exit,
46938c189ea6SSteven Rostedt (Red Hat) 	.priority = INT_MIN,	/* Run after anything that can remove kprobes */
46948c189ea6SSteven Rostedt (Red Hat) };
46958c189ea6SSteven Rostedt (Red Hat) 
469668bf21aaSSteven Rostedt void __init ftrace_init(void)
469768bf21aaSSteven Rostedt {
46981dc43cf0SJiri Slaby 	extern unsigned long __start_mcount_loc[];
46991dc43cf0SJiri Slaby 	extern unsigned long __stop_mcount_loc[];
47003a36cb11SJiri Slaby 	unsigned long count, flags;
470168bf21aaSSteven Rostedt 	int ret;
470268bf21aaSSteven Rostedt 
470368bf21aaSSteven Rostedt 	local_irq_save(flags);
47043a36cb11SJiri Slaby 	ret = ftrace_dyn_arch_init();
470568bf21aaSSteven Rostedt 	local_irq_restore(flags);
4706af64a7cbSJiri Slaby 	if (ret)
470768bf21aaSSteven Rostedt 		goto failed;
470868bf21aaSSteven Rostedt 
470968bf21aaSSteven Rostedt 	count = __stop_mcount_loc - __start_mcount_loc;
4710c867ccd8SJiri Slaby 	if (!count) {
4711c867ccd8SJiri Slaby 		pr_info("ftrace: No functions to be traced?\n");
471268bf21aaSSteven Rostedt 		goto failed;
4713c867ccd8SJiri Slaby 	}
4714c867ccd8SJiri Slaby 
4715c867ccd8SJiri Slaby 	pr_info("ftrace: allocating %ld entries in %ld pages\n",
4716c867ccd8SJiri Slaby 		count, count / ENTRIES_PER_PAGE + 1);
471768bf21aaSSteven Rostedt 
471868bf21aaSSteven Rostedt 	last_ftrace_enabled = ftrace_enabled = 1;
471968bf21aaSSteven Rostedt 
47205cb084bbSJiri Olsa 	ret = ftrace_process_locs(NULL,
472131e88909SSteven Rostedt 				  __start_mcount_loc,
472268bf21aaSSteven Rostedt 				  __stop_mcount_loc);
472368bf21aaSSteven Rostedt 
47248c189ea6SSteven Rostedt (Red Hat) 	ret = register_module_notifier(&ftrace_module_exit_nb);
47258c189ea6SSteven Rostedt (Red Hat) 	if (ret)
47268c189ea6SSteven Rostedt (Red Hat) 		pr_warning("Failed to register trace ftrace module exit notifier\n");
472793eb677dSSteven Rostedt 
47282af15d6aSSteven Rostedt 	set_ftrace_early_filters();
47292af15d6aSSteven Rostedt 
473068bf21aaSSteven Rostedt 	return;
473168bf21aaSSteven Rostedt  failed:
473268bf21aaSSteven Rostedt 	ftrace_disabled = 1;
473368bf21aaSSteven Rostedt }
473468bf21aaSSteven Rostedt 
47353d083395SSteven Rostedt #else
47360b6e4d56SFrederic Weisbecker 
47372b499381SSteven Rostedt static struct ftrace_ops global_ops = {
4738bd69c30bSSteven Rostedt 	.func			= ftrace_stub,
4739f04f24fbSMasami Hiramatsu 	.flags			= FTRACE_OPS_FL_RECURSION_SAFE | FTRACE_OPS_FL_INITIALIZED,
4740bd69c30bSSteven Rostedt };
4741bd69c30bSSteven Rostedt 
47420b6e4d56SFrederic Weisbecker static int __init ftrace_nodyn_init(void)
47430b6e4d56SFrederic Weisbecker {
47440b6e4d56SFrederic Weisbecker 	ftrace_enabled = 1;
47450b6e4d56SFrederic Weisbecker 	return 0;
47460b6e4d56SFrederic Weisbecker }
47476f415672SSteven Rostedt core_initcall(ftrace_nodyn_init);
47480b6e4d56SFrederic Weisbecker 
4749df4fc315SSteven Rostedt static inline int ftrace_init_dyn_debugfs(struct dentry *d_tracer) { return 0; }
4750df4fc315SSteven Rostedt static inline void ftrace_startup_enable(int command) { }
4751*e1effa01SSteven Rostedt (Red Hat) static inline void ftrace_startup_all(int command) { }
47525a45cfe1SSteven Rostedt /* Keep as macros so we do not need to define the commands */
47533b6cfdb1SSteven Rostedt # define ftrace_startup(ops, command)					\
47543b6cfdb1SSteven Rostedt 	({								\
47558a56d776SSteven Rostedt (Red Hat) 		int ___ret = __register_ftrace_function(ops);		\
47568a56d776SSteven Rostedt (Red Hat) 		if (!___ret)						\
47573b6cfdb1SSteven Rostedt 			(ops)->flags |= FTRACE_OPS_FL_ENABLED;		\
47588a56d776SSteven Rostedt (Red Hat) 		___ret;							\
47593b6cfdb1SSteven Rostedt 	})
47601fcc1553SSteven Rostedt (Red Hat) # define ftrace_shutdown(ops, command)					\
47611fcc1553SSteven Rostedt (Red Hat) 	({								\
47621fcc1553SSteven Rostedt (Red Hat) 		int ___ret = __unregister_ftrace_function(ops);		\
47631fcc1553SSteven Rostedt (Red Hat) 		if (!___ret)						\
47641fcc1553SSteven Rostedt (Red Hat) 			(ops)->flags &= ~FTRACE_OPS_FL_ENABLED;		\
47651fcc1553SSteven Rostedt (Red Hat) 		___ret;							\
47661fcc1553SSteven Rostedt (Red Hat) 	})
47678a56d776SSteven Rostedt (Red Hat) 
4768b0fc494fSSteven Rostedt # define ftrace_startup_sysctl()	do { } while (0)
4769b0fc494fSSteven Rostedt # define ftrace_shutdown_sysctl()	do { } while (0)
4770b848914cSSteven Rostedt 
4771b848914cSSteven Rostedt static inline int
4772195a8afcSSteven Rostedt (Red Hat) ftrace_ops_test(struct ftrace_ops *ops, unsigned long ip, void *regs)
4773b848914cSSteven Rostedt {
4774b848914cSSteven Rostedt 	return 1;
4775b848914cSSteven Rostedt }
4776b848914cSSteven Rostedt 
47773d083395SSteven Rostedt #endif /* CONFIG_DYNAMIC_FTRACE */
47783d083395SSteven Rostedt 
47794104d326SSteven Rostedt (Red Hat) __init void ftrace_init_global_array_ops(struct trace_array *tr)
47804104d326SSteven Rostedt (Red Hat) {
47814104d326SSteven Rostedt (Red Hat) 	tr->ops = &global_ops;
47824104d326SSteven Rostedt (Red Hat) 	tr->ops->private = tr;
47834104d326SSteven Rostedt (Red Hat) }
47844104d326SSteven Rostedt (Red Hat) 
47854104d326SSteven Rostedt (Red Hat) void ftrace_init_array_ops(struct trace_array *tr, ftrace_func_t func)
47864104d326SSteven Rostedt (Red Hat) {
47874104d326SSteven Rostedt (Red Hat) 	/* If we filter on pids, update to use the pid function */
47884104d326SSteven Rostedt (Red Hat) 	if (tr->flags & TRACE_ARRAY_FL_GLOBAL) {
47894104d326SSteven Rostedt (Red Hat) 		if (WARN_ON(tr->ops->func != ftrace_stub))
47904104d326SSteven Rostedt (Red Hat) 			printk("ftrace ops had %pS for function\n",
47914104d326SSteven Rostedt (Red Hat) 			       tr->ops->func);
47924104d326SSteven Rostedt (Red Hat) 		/* Only the top level instance does pid tracing */
47934104d326SSteven Rostedt (Red Hat) 		if (!list_empty(&ftrace_pids)) {
47944104d326SSteven Rostedt (Red Hat) 			set_ftrace_pid_function(func);
47954104d326SSteven Rostedt (Red Hat) 			func = ftrace_pid_func;
47964104d326SSteven Rostedt (Red Hat) 		}
47974104d326SSteven Rostedt (Red Hat) 	}
47984104d326SSteven Rostedt (Red Hat) 	tr->ops->func = func;
47994104d326SSteven Rostedt (Red Hat) 	tr->ops->private = tr;
48004104d326SSteven Rostedt (Red Hat) }
48014104d326SSteven Rostedt (Red Hat) 
48024104d326SSteven Rostedt (Red Hat) void ftrace_reset_array_ops(struct trace_array *tr)
48034104d326SSteven Rostedt (Red Hat) {
48044104d326SSteven Rostedt (Red Hat) 	tr->ops->func = ftrace_stub;
48054104d326SSteven Rostedt (Red Hat) }
48064104d326SSteven Rostedt (Red Hat) 
4807b848914cSSteven Rostedt static void
48082f5f6ad9SSteven Rostedt ftrace_ops_control_func(unsigned long ip, unsigned long parent_ip,
4809a1e2e31dSSteven Rostedt 			struct ftrace_ops *op, struct pt_regs *regs)
4810e248491aSJiri Olsa {
4811e248491aSJiri Olsa 	if (unlikely(trace_recursion_test(TRACE_CONTROL_BIT)))
4812e248491aSJiri Olsa 		return;
4813e248491aSJiri Olsa 
4814e248491aSJiri Olsa 	/*
4815e248491aSJiri Olsa 	 * Some of the ops may be dynamically allocated,
4816e248491aSJiri Olsa 	 * they must be freed after a synchronize_sched().
4817e248491aSJiri Olsa 	 */
4818e248491aSJiri Olsa 	preempt_disable_notrace();
4819e248491aSJiri Olsa 	trace_recursion_set(TRACE_CONTROL_BIT);
4820b5aa3a47SSteven Rostedt (Red Hat) 
4821b5aa3a47SSteven Rostedt (Red Hat) 	/*
4822b5aa3a47SSteven Rostedt (Red Hat) 	 * Control funcs (perf) uses RCU. Only trace if
4823b5aa3a47SSteven Rostedt (Red Hat) 	 * RCU is currently active.
4824b5aa3a47SSteven Rostedt (Red Hat) 	 */
4825b5aa3a47SSteven Rostedt (Red Hat) 	if (!rcu_is_watching())
4826b5aa3a47SSteven Rostedt (Red Hat) 		goto out;
4827b5aa3a47SSteven Rostedt (Red Hat) 
48280a016409SSteven Rostedt 	do_for_each_ftrace_op(op, ftrace_control_list) {
4829395b97a3SSteven Rostedt (Red Hat) 		if (!(op->flags & FTRACE_OPS_FL_STUB) &&
4830395b97a3SSteven Rostedt (Red Hat) 		    !ftrace_function_local_disabled(op) &&
4831195a8afcSSteven Rostedt (Red Hat) 		    ftrace_ops_test(op, ip, regs))
4832a1e2e31dSSteven Rostedt 			op->func(ip, parent_ip, op, regs);
48330a016409SSteven Rostedt 	} while_for_each_ftrace_op(op);
4834b5aa3a47SSteven Rostedt (Red Hat)  out:
4835e248491aSJiri Olsa 	trace_recursion_clear(TRACE_CONTROL_BIT);
4836e248491aSJiri Olsa 	preempt_enable_notrace();
4837e248491aSJiri Olsa }
4838e248491aSJiri Olsa 
4839e248491aSJiri Olsa static struct ftrace_ops control_ops = {
4840e248491aSJiri Olsa 	.func	= ftrace_ops_control_func,
4841f04f24fbSMasami Hiramatsu 	.flags	= FTRACE_OPS_FL_RECURSION_SAFE | FTRACE_OPS_FL_INITIALIZED,
484233b7f99cSSteven Rostedt (Red Hat) 	INIT_OPS_HASH(control_ops)
4843e248491aSJiri Olsa };
4844e248491aSJiri Olsa 
48452f5f6ad9SSteven Rostedt static inline void
48462f5f6ad9SSteven Rostedt __ftrace_ops_list_func(unsigned long ip, unsigned long parent_ip,
4847a1e2e31dSSteven Rostedt 		       struct ftrace_ops *ignored, struct pt_regs *regs)
4848b848914cSSteven Rostedt {
4849cdbe61bfSSteven Rostedt 	struct ftrace_ops *op;
4850edc15cafSSteven Rostedt 	int bit;
4851b848914cSSteven Rostedt 
4852edc15cafSSteven Rostedt 	bit = trace_test_and_set_recursion(TRACE_LIST_START, TRACE_LIST_MAX);
4853edc15cafSSteven Rostedt 	if (bit < 0)
4854b1cff0adSSteven Rostedt 		return;
4855b1cff0adSSteven Rostedt 
4856cdbe61bfSSteven Rostedt 	/*
4857cdbe61bfSSteven Rostedt 	 * Some of the ops may be dynamically allocated,
4858cdbe61bfSSteven Rostedt 	 * they must be freed after a synchronize_sched().
4859cdbe61bfSSteven Rostedt 	 */
4860cdbe61bfSSteven Rostedt 	preempt_disable_notrace();
48610a016409SSteven Rostedt 	do_for_each_ftrace_op(op, ftrace_ops_list) {
48624104d326SSteven Rostedt (Red Hat) 		if (ftrace_ops_test(op, ip, regs)) {
48631d48d596SSteven Rostedt (Red Hat) 			if (FTRACE_WARN_ON(!op->func)) {
48641d48d596SSteven Rostedt (Red Hat) 				pr_warn("op=%p %pS\n", op, op);
48654104d326SSteven Rostedt (Red Hat) 				goto out;
48664104d326SSteven Rostedt (Red Hat) 			}
4867a1e2e31dSSteven Rostedt 			op->func(ip, parent_ip, op, regs);
48684104d326SSteven Rostedt (Red Hat) 		}
48690a016409SSteven Rostedt 	} while_for_each_ftrace_op(op);
48704104d326SSteven Rostedt (Red Hat) out:
4871cdbe61bfSSteven Rostedt 	preempt_enable_notrace();
4872edc15cafSSteven Rostedt 	trace_clear_recursion(bit);
4873b848914cSSteven Rostedt }
4874b848914cSSteven Rostedt 
48752f5f6ad9SSteven Rostedt /*
48762f5f6ad9SSteven Rostedt  * Some archs only support passing ip and parent_ip. Even though
48772f5f6ad9SSteven Rostedt  * the list function ignores the op parameter, we do not want any
48782f5f6ad9SSteven Rostedt  * C side effects, where a function is called without the caller
48792f5f6ad9SSteven Rostedt  * sending a third parameter.
4880a1e2e31dSSteven Rostedt  * Archs are to support both the regs and ftrace_ops at the same time.
4881a1e2e31dSSteven Rostedt  * If they support ftrace_ops, it is assumed they support regs.
4882a1e2e31dSSteven Rostedt  * If call backs want to use regs, they must either check for regs
488306aeaaeaSMasami Hiramatsu  * being NULL, or CONFIG_DYNAMIC_FTRACE_WITH_REGS.
488406aeaaeaSMasami Hiramatsu  * Note, CONFIG_DYNAMIC_FTRACE_WITH_REGS expects a full regs to be saved.
4885a1e2e31dSSteven Rostedt  * An architecture can pass partial regs with ftrace_ops and still
4886a1e2e31dSSteven Rostedt  * set the ARCH_SUPPORT_FTARCE_OPS.
48872f5f6ad9SSteven Rostedt  */
48882f5f6ad9SSteven Rostedt #if ARCH_SUPPORTS_FTRACE_OPS
48892f5f6ad9SSteven Rostedt static void ftrace_ops_list_func(unsigned long ip, unsigned long parent_ip,
4890a1e2e31dSSteven Rostedt 				 struct ftrace_ops *op, struct pt_regs *regs)
48912f5f6ad9SSteven Rostedt {
4892a1e2e31dSSteven Rostedt 	__ftrace_ops_list_func(ip, parent_ip, NULL, regs);
48932f5f6ad9SSteven Rostedt }
48942f5f6ad9SSteven Rostedt #else
48952f5f6ad9SSteven Rostedt static void ftrace_ops_no_ops(unsigned long ip, unsigned long parent_ip)
48962f5f6ad9SSteven Rostedt {
4897a1e2e31dSSteven Rostedt 	__ftrace_ops_list_func(ip, parent_ip, NULL, NULL);
48982f5f6ad9SSteven Rostedt }
48992f5f6ad9SSteven Rostedt #endif
49002f5f6ad9SSteven Rostedt 
4901f1ff6348SSteven Rostedt (Red Hat) /*
4902f1ff6348SSteven Rostedt (Red Hat)  * If there's only one function registered but it does not support
4903f1ff6348SSteven Rostedt (Red Hat)  * recursion, this function will be called by the mcount trampoline.
4904f1ff6348SSteven Rostedt (Red Hat)  * This function will handle recursion protection.
4905f1ff6348SSteven Rostedt (Red Hat)  */
4906f1ff6348SSteven Rostedt (Red Hat) static void ftrace_ops_recurs_func(unsigned long ip, unsigned long parent_ip,
4907f1ff6348SSteven Rostedt (Red Hat) 				   struct ftrace_ops *op, struct pt_regs *regs)
4908f1ff6348SSteven Rostedt (Red Hat) {
4909f1ff6348SSteven Rostedt (Red Hat) 	int bit;
4910f1ff6348SSteven Rostedt (Red Hat) 
4911f1ff6348SSteven Rostedt (Red Hat) 	bit = trace_test_and_set_recursion(TRACE_LIST_START, TRACE_LIST_MAX);
4912f1ff6348SSteven Rostedt (Red Hat) 	if (bit < 0)
4913f1ff6348SSteven Rostedt (Red Hat) 		return;
4914f1ff6348SSteven Rostedt (Red Hat) 
4915f1ff6348SSteven Rostedt (Red Hat) 	op->func(ip, parent_ip, op, regs);
4916f1ff6348SSteven Rostedt (Red Hat) 
4917f1ff6348SSteven Rostedt (Red Hat) 	trace_clear_recursion(bit);
4918f1ff6348SSteven Rostedt (Red Hat) }
4919f1ff6348SSteven Rostedt (Red Hat) 
492087354059SSteven Rostedt (Red Hat) /**
492187354059SSteven Rostedt (Red Hat)  * ftrace_ops_get_func - get the function a trampoline should call
492287354059SSteven Rostedt (Red Hat)  * @ops: the ops to get the function for
492387354059SSteven Rostedt (Red Hat)  *
492487354059SSteven Rostedt (Red Hat)  * Normally the mcount trampoline will call the ops->func, but there
492587354059SSteven Rostedt (Red Hat)  * are times that it should not. For example, if the ops does not
492687354059SSteven Rostedt (Red Hat)  * have its own recursion protection, then it should call the
492787354059SSteven Rostedt (Red Hat)  * ftrace_ops_recurs_func() instead.
492887354059SSteven Rostedt (Red Hat)  *
492987354059SSteven Rostedt (Red Hat)  * Returns the function that the trampoline should call for @ops.
493087354059SSteven Rostedt (Red Hat)  */
493187354059SSteven Rostedt (Red Hat) ftrace_func_t ftrace_ops_get_func(struct ftrace_ops *ops)
493287354059SSteven Rostedt (Red Hat) {
493387354059SSteven Rostedt (Red Hat) 	/*
493487354059SSteven Rostedt (Red Hat) 	 * If this is a dynamic ops or we force list func,
493587354059SSteven Rostedt (Red Hat) 	 * then it needs to call the list anyway.
493687354059SSteven Rostedt (Red Hat) 	 */
493787354059SSteven Rostedt (Red Hat) 	if (ops->flags & FTRACE_OPS_FL_DYNAMIC || FTRACE_FORCE_LIST_FUNC)
493887354059SSteven Rostedt (Red Hat) 		return ftrace_ops_list_func;
493987354059SSteven Rostedt (Red Hat) 
494087354059SSteven Rostedt (Red Hat) 	/*
494187354059SSteven Rostedt (Red Hat) 	 * If the func handles its own recursion, call it directly.
494287354059SSteven Rostedt (Red Hat) 	 * Otherwise call the recursion protected function that
494387354059SSteven Rostedt (Red Hat) 	 * will call the ftrace ops function.
494487354059SSteven Rostedt (Red Hat) 	 */
494587354059SSteven Rostedt (Red Hat) 	if (!(ops->flags & FTRACE_OPS_FL_RECURSION_SAFE))
494687354059SSteven Rostedt (Red Hat) 		return ftrace_ops_recurs_func;
494787354059SSteven Rostedt (Red Hat) 
494887354059SSteven Rostedt (Red Hat) 	return ops->func;
494987354059SSteven Rostedt (Red Hat) }
495087354059SSteven Rostedt (Red Hat) 
4951e32d8956SSteven Rostedt static void clear_ftrace_swapper(void)
4952e32d8956SSteven Rostedt {
4953e32d8956SSteven Rostedt 	struct task_struct *p;
4954e32d8956SSteven Rostedt 	int cpu;
4955e32d8956SSteven Rostedt 
4956e32d8956SSteven Rostedt 	get_online_cpus();
4957e32d8956SSteven Rostedt 	for_each_online_cpu(cpu) {
4958e32d8956SSteven Rostedt 		p = idle_task(cpu);
4959e32d8956SSteven Rostedt 		clear_tsk_trace_trace(p);
4960e32d8956SSteven Rostedt 	}
4961e32d8956SSteven Rostedt 	put_online_cpus();
4962e32d8956SSteven Rostedt }
4963e32d8956SSteven Rostedt 
4964e32d8956SSteven Rostedt static void set_ftrace_swapper(void)
4965e32d8956SSteven Rostedt {
4966e32d8956SSteven Rostedt 	struct task_struct *p;
4967e32d8956SSteven Rostedt 	int cpu;
4968e32d8956SSteven Rostedt 
4969e32d8956SSteven Rostedt 	get_online_cpus();
4970e32d8956SSteven Rostedt 	for_each_online_cpu(cpu) {
4971e32d8956SSteven Rostedt 		p = idle_task(cpu);
4972e32d8956SSteven Rostedt 		set_tsk_trace_trace(p);
4973e32d8956SSteven Rostedt 	}
4974e32d8956SSteven Rostedt 	put_online_cpus();
4975e32d8956SSteven Rostedt }
4976e32d8956SSteven Rostedt 
4977e32d8956SSteven Rostedt static void clear_ftrace_pid(struct pid *pid)
4978978f3a45SSteven Rostedt {
4979978f3a45SSteven Rostedt 	struct task_struct *p;
4980978f3a45SSteven Rostedt 
4981229c4ef8SOleg Nesterov 	rcu_read_lock();
4982e32d8956SSteven Rostedt 	do_each_pid_task(pid, PIDTYPE_PID, p) {
4983978f3a45SSteven Rostedt 		clear_tsk_trace_trace(p);
4984e32d8956SSteven Rostedt 	} while_each_pid_task(pid, PIDTYPE_PID, p);
4985229c4ef8SOleg Nesterov 	rcu_read_unlock();
4986229c4ef8SOleg Nesterov 
4987e32d8956SSteven Rostedt 	put_pid(pid);
4988978f3a45SSteven Rostedt }
4989978f3a45SSteven Rostedt 
4990e32d8956SSteven Rostedt static void set_ftrace_pid(struct pid *pid)
4991978f3a45SSteven Rostedt {
4992978f3a45SSteven Rostedt 	struct task_struct *p;
4993978f3a45SSteven Rostedt 
4994229c4ef8SOleg Nesterov 	rcu_read_lock();
4995978f3a45SSteven Rostedt 	do_each_pid_task(pid, PIDTYPE_PID, p) {
4996978f3a45SSteven Rostedt 		set_tsk_trace_trace(p);
4997978f3a45SSteven Rostedt 	} while_each_pid_task(pid, PIDTYPE_PID, p);
4998229c4ef8SOleg Nesterov 	rcu_read_unlock();
4999978f3a45SSteven Rostedt }
5000978f3a45SSteven Rostedt 
5001756d17eeS[email protected] static void clear_ftrace_pid_task(struct pid *pid)
5002e32d8956SSteven Rostedt {
5003756d17eeS[email protected] 	if (pid == ftrace_swapper_pid)
5004e32d8956SSteven Rostedt 		clear_ftrace_swapper();
5005e32d8956SSteven Rostedt 	else
5006756d17eeS[email protected] 		clear_ftrace_pid(pid);
5007e32d8956SSteven Rostedt }
5008e32d8956SSteven Rostedt 
5009e32d8956SSteven Rostedt static void set_ftrace_pid_task(struct pid *pid)
5010e32d8956SSteven Rostedt {
5011e32d8956SSteven Rostedt 	if (pid == ftrace_swapper_pid)
5012e32d8956SSteven Rostedt 		set_ftrace_swapper();
5013e32d8956SSteven Rostedt 	else
5014e32d8956SSteven Rostedt 		set_ftrace_pid(pid);
5015e32d8956SSteven Rostedt }
5016e32d8956SSteven Rostedt 
5017756d17eeS[email protected] static int ftrace_pid_add(int p)
5018756d17eeS[email protected] {
5019756d17eeS[email protected] 	struct pid *pid;
5020756d17eeS[email protected] 	struct ftrace_pid *fpid;
5021756d17eeS[email protected] 	int ret = -EINVAL;
5022756d17eeS[email protected] 
5023756d17eeS[email protected] 	mutex_lock(&ftrace_lock);
5024756d17eeS[email protected] 
5025756d17eeS[email protected] 	if (!p)
5026756d17eeS[email protected] 		pid = ftrace_swapper_pid;
5027756d17eeS[email protected] 	else
5028756d17eeS[email protected] 		pid = find_get_pid(p);
5029756d17eeS[email protected] 
5030756d17eeS[email protected] 	if (!pid)
5031756d17eeS[email protected] 		goto out;
5032756d17eeS[email protected] 
5033756d17eeS[email protected] 	ret = 0;
5034756d17eeS[email protected] 
5035756d17eeS[email protected] 	list_for_each_entry(fpid, &ftrace_pids, list)
5036756d17eeS[email protected] 		if (fpid->pid == pid)
5037756d17eeS[email protected] 			goto out_put;
5038756d17eeS[email protected] 
5039756d17eeS[email protected] 	ret = -ENOMEM;
5040756d17eeS[email protected] 
5041756d17eeS[email protected] 	fpid = kmalloc(sizeof(*fpid), GFP_KERNEL);
5042756d17eeS[email protected] 	if (!fpid)
5043756d17eeS[email protected] 		goto out_put;
5044756d17eeS[email protected] 
5045756d17eeS[email protected] 	list_add(&fpid->list, &ftrace_pids);
5046756d17eeS[email protected] 	fpid->pid = pid;
5047756d17eeS[email protected] 
5048756d17eeS[email protected] 	set_ftrace_pid_task(pid);
5049756d17eeS[email protected] 
5050756d17eeS[email protected] 	ftrace_update_pid_func();
5051*e1effa01SSteven Rostedt (Red Hat) 
5052*e1effa01SSteven Rostedt (Red Hat) 	ftrace_startup_all(0);
5053756d17eeS[email protected] 
5054756d17eeS[email protected] 	mutex_unlock(&ftrace_lock);
5055756d17eeS[email protected] 	return 0;
5056756d17eeS[email protected] 
5057756d17eeS[email protected] out_put:
5058756d17eeS[email protected] 	if (pid != ftrace_swapper_pid)
5059756d17eeS[email protected] 		put_pid(pid);
5060756d17eeS[email protected] 
5061756d17eeS[email protected] out:
5062756d17eeS[email protected] 	mutex_unlock(&ftrace_lock);
5063756d17eeS[email protected] 	return ret;
5064756d17eeS[email protected] }
5065756d17eeS[email protected] 
5066756d17eeS[email protected] static void ftrace_pid_reset(void)
5067756d17eeS[email protected] {
5068756d17eeS[email protected] 	struct ftrace_pid *fpid, *safe;
5069756d17eeS[email protected] 
5070756d17eeS[email protected] 	mutex_lock(&ftrace_lock);
5071756d17eeS[email protected] 	list_for_each_entry_safe(fpid, safe, &ftrace_pids, list) {
5072756d17eeS[email protected] 		struct pid *pid = fpid->pid;
5073756d17eeS[email protected] 
5074756d17eeS[email protected] 		clear_ftrace_pid_task(pid);
5075756d17eeS[email protected] 
5076756d17eeS[email protected] 		list_del(&fpid->list);
5077756d17eeS[email protected] 		kfree(fpid);
5078756d17eeS[email protected] 	}
5079756d17eeS[email protected] 
5080756d17eeS[email protected] 	ftrace_update_pid_func();
5081*e1effa01SSteven Rostedt (Red Hat) 	ftrace_startup_all(0);
5082756d17eeS[email protected] 
5083756d17eeS[email protected] 	mutex_unlock(&ftrace_lock);
5084756d17eeS[email protected] }
5085756d17eeS[email protected] 
5086756d17eeS[email protected] static void *fpid_start(struct seq_file *m, loff_t *pos)
5087756d17eeS[email protected] {
5088756d17eeS[email protected] 	mutex_lock(&ftrace_lock);
5089756d17eeS[email protected] 
5090756d17eeS[email protected] 	if (list_empty(&ftrace_pids) && (!*pos))
5091756d17eeS[email protected] 		return (void *) 1;
5092756d17eeS[email protected] 
5093756d17eeS[email protected] 	return seq_list_start(&ftrace_pids, *pos);
5094756d17eeS[email protected] }
5095756d17eeS[email protected] 
5096756d17eeS[email protected] static void *fpid_next(struct seq_file *m, void *v, loff_t *pos)
5097756d17eeS[email protected] {
5098756d17eeS[email protected] 	if (v == (void *)1)
5099756d17eeS[email protected] 		return NULL;
5100756d17eeS[email protected] 
5101756d17eeS[email protected] 	return seq_list_next(v, &ftrace_pids, pos);
5102756d17eeS[email protected] }
5103756d17eeS[email protected] 
5104756d17eeS[email protected] static void fpid_stop(struct seq_file *m, void *p)
5105756d17eeS[email protected] {
5106756d17eeS[email protected] 	mutex_unlock(&ftrace_lock);
5107756d17eeS[email protected] }
5108756d17eeS[email protected] 
5109756d17eeS[email protected] static int fpid_show(struct seq_file *m, void *v)
5110756d17eeS[email protected] {
5111756d17eeS[email protected] 	const struct ftrace_pid *fpid = list_entry(v, struct ftrace_pid, list);
5112756d17eeS[email protected] 
5113756d17eeS[email protected] 	if (v == (void *)1) {
5114756d17eeS[email protected] 		seq_printf(m, "no pid\n");
5115756d17eeS[email protected] 		return 0;
5116756d17eeS[email protected] 	}
5117756d17eeS[email protected] 
5118756d17eeS[email protected] 	if (fpid->pid == ftrace_swapper_pid)
5119756d17eeS[email protected] 		seq_printf(m, "swapper tasks\n");
5120756d17eeS[email protected] 	else
5121756d17eeS[email protected] 		seq_printf(m, "%u\n", pid_vnr(fpid->pid));
5122756d17eeS[email protected] 
5123756d17eeS[email protected] 	return 0;
5124756d17eeS[email protected] }
5125756d17eeS[email protected] 
5126756d17eeS[email protected] static const struct seq_operations ftrace_pid_sops = {
5127756d17eeS[email protected] 	.start = fpid_start,
5128756d17eeS[email protected] 	.next = fpid_next,
5129756d17eeS[email protected] 	.stop = fpid_stop,
5130756d17eeS[email protected] 	.show = fpid_show,
5131756d17eeS[email protected] };
5132756d17eeS[email protected] 
5133756d17eeS[email protected] static int
5134756d17eeS[email protected] ftrace_pid_open(struct inode *inode, struct file *file)
5135756d17eeS[email protected] {
5136756d17eeS[email protected] 	int ret = 0;
5137756d17eeS[email protected] 
5138756d17eeS[email protected] 	if ((file->f_mode & FMODE_WRITE) &&
5139756d17eeS[email protected] 	    (file->f_flags & O_TRUNC))
5140756d17eeS[email protected] 		ftrace_pid_reset();
5141756d17eeS[email protected] 
5142756d17eeS[email protected] 	if (file->f_mode & FMODE_READ)
5143756d17eeS[email protected] 		ret = seq_open(file, &ftrace_pid_sops);
5144756d17eeS[email protected] 
5145756d17eeS[email protected] 	return ret;
5146756d17eeS[email protected] }
5147756d17eeS[email protected] 
5148df4fc315SSteven Rostedt static ssize_t
5149df4fc315SSteven Rostedt ftrace_pid_write(struct file *filp, const char __user *ubuf,
5150df4fc315SSteven Rostedt 		   size_t cnt, loff_t *ppos)
5151df4fc315SSteven Rostedt {
5152457dc928SIngo Molnar 	char buf[64], *tmp;
5153df4fc315SSteven Rostedt 	long val;
5154df4fc315SSteven Rostedt 	int ret;
5155df4fc315SSteven Rostedt 
5156df4fc315SSteven Rostedt 	if (cnt >= sizeof(buf))
5157df4fc315SSteven Rostedt 		return -EINVAL;
5158df4fc315SSteven Rostedt 
5159df4fc315SSteven Rostedt 	if (copy_from_user(&buf, ubuf, cnt))
5160df4fc315SSteven Rostedt 		return -EFAULT;
5161df4fc315SSteven Rostedt 
5162df4fc315SSteven Rostedt 	buf[cnt] = 0;
5163df4fc315SSteven Rostedt 
5164756d17eeS[email protected] 	/*
5165756d17eeS[email protected] 	 * Allow "echo > set_ftrace_pid" or "echo -n '' > set_ftrace_pid"
5166756d17eeS[email protected] 	 * to clean the filter quietly.
5167756d17eeS[email protected] 	 */
5168457dc928SIngo Molnar 	tmp = strstrip(buf);
5169457dc928SIngo Molnar 	if (strlen(tmp) == 0)
5170756d17eeS[email protected] 		return 1;
5171756d17eeS[email protected] 
5172bcd83ea6SDaniel Walter 	ret = kstrtol(tmp, 10, &val);
5173df4fc315SSteven Rostedt 	if (ret < 0)
5174df4fc315SSteven Rostedt 		return ret;
5175df4fc315SSteven Rostedt 
5176756d17eeS[email protected] 	ret = ftrace_pid_add(val);
5177978f3a45SSteven Rostedt 
5178756d17eeS[email protected] 	return ret ? ret : cnt;
5179e32d8956SSteven Rostedt }
5180978f3a45SSteven Rostedt 
5181756d17eeS[email protected] static int
5182756d17eeS[email protected] ftrace_pid_release(struct inode *inode, struct file *file)
5183756d17eeS[email protected] {
5184756d17eeS[email protected] 	if (file->f_mode & FMODE_READ)
5185756d17eeS[email protected] 		seq_release(inode, file);
5186978f3a45SSteven Rostedt 
5187756d17eeS[email protected] 	return 0;
5188df4fc315SSteven Rostedt }
5189df4fc315SSteven Rostedt 
51905e2336a0SSteven Rostedt static const struct file_operations ftrace_pid_fops = {
5191756d17eeS[email protected] 	.open		= ftrace_pid_open,
5192df4fc315SSteven Rostedt 	.write		= ftrace_pid_write,
5193756d17eeS[email protected] 	.read		= seq_read,
5194098c879eSSteven Rostedt (Red Hat) 	.llseek		= tracing_lseek,
5195756d17eeS[email protected] 	.release	= ftrace_pid_release,
5196df4fc315SSteven Rostedt };
5197df4fc315SSteven Rostedt 
5198df4fc315SSteven Rostedt static __init int ftrace_init_debugfs(void)
5199df4fc315SSteven Rostedt {
5200df4fc315SSteven Rostedt 	struct dentry *d_tracer;
5201df4fc315SSteven Rostedt 
5202df4fc315SSteven Rostedt 	d_tracer = tracing_init_dentry();
5203df4fc315SSteven Rostedt 	if (!d_tracer)
5204df4fc315SSteven Rostedt 		return 0;
5205df4fc315SSteven Rostedt 
5206df4fc315SSteven Rostedt 	ftrace_init_dyn_debugfs(d_tracer);
5207df4fc315SSteven Rostedt 
52085452af66SFrederic Weisbecker 	trace_create_file("set_ftrace_pid", 0644, d_tracer,
5209df4fc315SSteven Rostedt 			    NULL, &ftrace_pid_fops);
5210493762fcSSteven Rostedt 
5211493762fcSSteven Rostedt 	ftrace_profile_debugfs(d_tracer);
5212493762fcSSteven Rostedt 
5213df4fc315SSteven Rostedt 	return 0;
5214df4fc315SSteven Rostedt }
5215df4fc315SSteven Rostedt fs_initcall(ftrace_init_debugfs);
5216df4fc315SSteven Rostedt 
52173d083395SSteven Rostedt /**
521881adbdc0SSteven Rostedt  * ftrace_kill - kill ftrace
5219a2bb6a3dSSteven Rostedt  *
5220a2bb6a3dSSteven Rostedt  * This function should be used by panic code. It stops ftrace
5221a2bb6a3dSSteven Rostedt  * but in a not so nice way. If you need to simply kill ftrace
5222a2bb6a3dSSteven Rostedt  * from a non-atomic section, use ftrace_kill.
5223a2bb6a3dSSteven Rostedt  */
522481adbdc0SSteven Rostedt void ftrace_kill(void)
5225a2bb6a3dSSteven Rostedt {
5226a2bb6a3dSSteven Rostedt 	ftrace_disabled = 1;
5227a2bb6a3dSSteven Rostedt 	ftrace_enabled = 0;
5228a2bb6a3dSSteven Rostedt 	clear_ftrace_function();
5229a2bb6a3dSSteven Rostedt }
5230a2bb6a3dSSteven Rostedt 
5231a2bb6a3dSSteven Rostedt /**
5232e0a413f6SSteven Rostedt  * Test if ftrace is dead or not.
5233e0a413f6SSteven Rostedt  */
5234e0a413f6SSteven Rostedt int ftrace_is_dead(void)
5235e0a413f6SSteven Rostedt {
5236e0a413f6SSteven Rostedt 	return ftrace_disabled;
5237e0a413f6SSteven Rostedt }
5238e0a413f6SSteven Rostedt 
5239e0a413f6SSteven Rostedt /**
52403d083395SSteven Rostedt  * register_ftrace_function - register a function for profiling
52413d083395SSteven Rostedt  * @ops - ops structure that holds the function for profiling.
52423d083395SSteven Rostedt  *
52433d083395SSteven Rostedt  * Register a function to be called by all functions in the
52443d083395SSteven Rostedt  * kernel.
52453d083395SSteven Rostedt  *
52463d083395SSteven Rostedt  * Note: @ops->func and all the functions it calls must be labeled
52473d083395SSteven Rostedt  *       with "notrace", otherwise it will go into a
52483d083395SSteven Rostedt  *       recursive loop.
52493d083395SSteven Rostedt  */
52503d083395SSteven Rostedt int register_ftrace_function(struct ftrace_ops *ops)
52513d083395SSteven Rostedt {
525245a4a237SSteven Rostedt 	int ret = -1;
52534eebcc81SSteven Rostedt 
5254f04f24fbSMasami Hiramatsu 	ftrace_ops_init(ops);
5255f04f24fbSMasami Hiramatsu 
5256e6ea44e9SSteven Rostedt 	mutex_lock(&ftrace_lock);
5257e7d3737eSFrederic Weisbecker 
5258a1cd6173SSteven Rostedt 	ret = ftrace_startup(ops, 0);
5259b848914cSSteven Rostedt 
5260e6ea44e9SSteven Rostedt 	mutex_unlock(&ftrace_lock);
52618d240dd8SBorislav Petkov 
5262b0fc494fSSteven Rostedt 	return ret;
52633d083395SSteven Rostedt }
5264cdbe61bfSSteven Rostedt EXPORT_SYMBOL_GPL(register_ftrace_function);
52653d083395SSteven Rostedt 
52663d083395SSteven Rostedt /**
526732632920SUwe Kleine-Koenig  * unregister_ftrace_function - unregister a function for profiling.
52683d083395SSteven Rostedt  * @ops - ops structure that holds the function to unregister
52693d083395SSteven Rostedt  *
52703d083395SSteven Rostedt  * Unregister a function that was added to be called by ftrace profiling.
52713d083395SSteven Rostedt  */
52723d083395SSteven Rostedt int unregister_ftrace_function(struct ftrace_ops *ops)
52733d083395SSteven Rostedt {
52743d083395SSteven Rostedt 	int ret;
52753d083395SSteven Rostedt 
5276e6ea44e9SSteven Rostedt 	mutex_lock(&ftrace_lock);
52778a56d776SSteven Rostedt (Red Hat) 	ret = ftrace_shutdown(ops, 0);
5278e6ea44e9SSteven Rostedt 	mutex_unlock(&ftrace_lock);
5279b0fc494fSSteven Rostedt 
5280b0fc494fSSteven Rostedt 	return ret;
5281b0fc494fSSteven Rostedt }
5282cdbe61bfSSteven Rostedt EXPORT_SYMBOL_GPL(unregister_ftrace_function);
5283b0fc494fSSteven Rostedt 
5284e309b41dSIngo Molnar int
5285b0fc494fSSteven Rostedt ftrace_enable_sysctl(struct ctl_table *table, int write,
52868d65af78SAlexey Dobriyan 		     void __user *buffer, size_t *lenp,
5287b0fc494fSSteven Rostedt 		     loff_t *ppos)
5288b0fc494fSSteven Rostedt {
528945a4a237SSteven Rostedt 	int ret = -ENODEV;
52904eebcc81SSteven Rostedt 
5291e6ea44e9SSteven Rostedt 	mutex_lock(&ftrace_lock);
5292b0fc494fSSteven Rostedt 
529345a4a237SSteven Rostedt 	if (unlikely(ftrace_disabled))
529445a4a237SSteven Rostedt 		goto out;
529545a4a237SSteven Rostedt 
52968d65af78SAlexey Dobriyan 	ret = proc_dointvec(table, write, buffer, lenp, ppos);
5297b0fc494fSSteven Rostedt 
5298a32c7765SLi Zefan 	if (ret || !write || (last_ftrace_enabled == !!ftrace_enabled))
5299b0fc494fSSteven Rostedt 		goto out;
5300b0fc494fSSteven Rostedt 
5301a32c7765SLi Zefan 	last_ftrace_enabled = !!ftrace_enabled;
5302b0fc494fSSteven Rostedt 
5303b0fc494fSSteven Rostedt 	if (ftrace_enabled) {
5304b0fc494fSSteven Rostedt 
5305b0fc494fSSteven Rostedt 		ftrace_startup_sysctl();
5306b0fc494fSSteven Rostedt 
5307b0fc494fSSteven Rostedt 		/* we are starting ftrace again */
53085000c418SJan Kiszka 		if (ftrace_ops_list != &ftrace_list_end)
53095000c418SJan Kiszka 			update_ftrace_function();
5310b0fc494fSSteven Rostedt 
5311b0fc494fSSteven Rostedt 	} else {
5312b0fc494fSSteven Rostedt 		/* stopping ftrace calls (just send to ftrace_stub) */
5313b0fc494fSSteven Rostedt 		ftrace_trace_function = ftrace_stub;
5314b0fc494fSSteven Rostedt 
5315b0fc494fSSteven Rostedt 		ftrace_shutdown_sysctl();
5316b0fc494fSSteven Rostedt 	}
5317b0fc494fSSteven Rostedt 
5318b0fc494fSSteven Rostedt  out:
5319e6ea44e9SSteven Rostedt 	mutex_unlock(&ftrace_lock);
53203d083395SSteven Rostedt 	return ret;
532116444a8aSArnaldo Carvalho de Melo }
5322f17845e5SIngo Molnar 
5323fb52607aSFrederic Weisbecker #ifdef CONFIG_FUNCTION_GRAPH_TRACER
5324e7d3737eSFrederic Weisbecker 
53255f151b24SSteven Rostedt (Red Hat) static struct ftrace_ops graph_ops = {
53265f151b24SSteven Rostedt (Red Hat) 	.func			= ftrace_stub,
53275f151b24SSteven Rostedt (Red Hat) 	.flags			= FTRACE_OPS_FL_RECURSION_SAFE |
53285f151b24SSteven Rostedt (Red Hat) 				   FTRACE_OPS_FL_INITIALIZED |
53295f151b24SSteven Rostedt (Red Hat) 				   FTRACE_OPS_FL_STUB,
53305f151b24SSteven Rostedt (Red Hat) #ifdef FTRACE_GRAPH_TRAMP_ADDR
53315f151b24SSteven Rostedt (Red Hat) 	.trampoline		= FTRACE_GRAPH_TRAMP_ADDR,
53325f151b24SSteven Rostedt (Red Hat) #endif
53335f151b24SSteven Rostedt (Red Hat) 	ASSIGN_OPS_HASH(graph_ops, &global_ops.local_hash)
53345f151b24SSteven Rostedt (Red Hat) };
53355f151b24SSteven Rostedt (Red Hat) 
5336597af815SSteven Rostedt static int ftrace_graph_active;
5337f201ae23SFrederic Weisbecker 
5338e49dc19cSSteven Rostedt int ftrace_graph_entry_stub(struct ftrace_graph_ent *trace)
5339e49dc19cSSteven Rostedt {
5340e49dc19cSSteven Rostedt 	return 0;
5341e49dc19cSSteven Rostedt }
5342e49dc19cSSteven Rostedt 
5343287b6e68SFrederic Weisbecker /* The callbacks that hook a function */
5344287b6e68SFrederic Weisbecker trace_func_graph_ret_t ftrace_graph_return =
5345287b6e68SFrederic Weisbecker 			(trace_func_graph_ret_t)ftrace_stub;
5346e49dc19cSSteven Rostedt trace_func_graph_ent_t ftrace_graph_entry = ftrace_graph_entry_stub;
534723a8e844SSteven Rostedt (Red Hat) static trace_func_graph_ent_t __ftrace_graph_entry = ftrace_graph_entry_stub;
5348f201ae23SFrederic Weisbecker 
5349f201ae23SFrederic Weisbecker /* Try to assign a return stack array on FTRACE_RETSTACK_ALLOC_SIZE tasks. */
5350f201ae23SFrederic Weisbecker static int alloc_retstack_tasklist(struct ftrace_ret_stack **ret_stack_list)
5351f201ae23SFrederic Weisbecker {
5352f201ae23SFrederic Weisbecker 	int i;
5353f201ae23SFrederic Weisbecker 	int ret = 0;
5354f201ae23SFrederic Weisbecker 	unsigned long flags;
5355f201ae23SFrederic Weisbecker 	int start = 0, end = FTRACE_RETSTACK_ALLOC_SIZE;
5356f201ae23SFrederic Weisbecker 	struct task_struct *g, *t;
5357f201ae23SFrederic Weisbecker 
5358f201ae23SFrederic Weisbecker 	for (i = 0; i < FTRACE_RETSTACK_ALLOC_SIZE; i++) {
5359f201ae23SFrederic Weisbecker 		ret_stack_list[i] = kmalloc(FTRACE_RETFUNC_DEPTH
5360f201ae23SFrederic Weisbecker 					* sizeof(struct ftrace_ret_stack),
5361f201ae23SFrederic Weisbecker 					GFP_KERNEL);
5362f201ae23SFrederic Weisbecker 		if (!ret_stack_list[i]) {
5363f201ae23SFrederic Weisbecker 			start = 0;
5364f201ae23SFrederic Weisbecker 			end = i;
5365f201ae23SFrederic Weisbecker 			ret = -ENOMEM;
5366f201ae23SFrederic Weisbecker 			goto free;
5367f201ae23SFrederic Weisbecker 		}
5368f201ae23SFrederic Weisbecker 	}
5369f201ae23SFrederic Weisbecker 
5370f201ae23SFrederic Weisbecker 	read_lock_irqsave(&tasklist_lock, flags);
5371f201ae23SFrederic Weisbecker 	do_each_thread(g, t) {
5372f201ae23SFrederic Weisbecker 		if (start == end) {
5373f201ae23SFrederic Weisbecker 			ret = -EAGAIN;
5374f201ae23SFrederic Weisbecker 			goto unlock;
5375f201ae23SFrederic Weisbecker 		}
5376f201ae23SFrederic Weisbecker 
5377f201ae23SFrederic Weisbecker 		if (t->ret_stack == NULL) {
5378380c4b14SFrederic Weisbecker 			atomic_set(&t->tracing_graph_pause, 0);
5379f201ae23SFrederic Weisbecker 			atomic_set(&t->trace_overrun, 0);
538026c01624SSteven Rostedt 			t->curr_ret_stack = -1;
538126c01624SSteven Rostedt 			/* Make sure the tasks see the -1 first: */
538226c01624SSteven Rostedt 			smp_wmb();
538326c01624SSteven Rostedt 			t->ret_stack = ret_stack_list[start++];
5384f201ae23SFrederic Weisbecker 		}
5385f201ae23SFrederic Weisbecker 	} while_each_thread(g, t);
5386f201ae23SFrederic Weisbecker 
5387f201ae23SFrederic Weisbecker unlock:
5388f201ae23SFrederic Weisbecker 	read_unlock_irqrestore(&tasklist_lock, flags);
5389f201ae23SFrederic Weisbecker free:
5390f201ae23SFrederic Weisbecker 	for (i = start; i < end; i++)
5391f201ae23SFrederic Weisbecker 		kfree(ret_stack_list[i]);
5392f201ae23SFrederic Weisbecker 	return ret;
5393f201ae23SFrederic Weisbecker }
5394f201ae23SFrederic Weisbecker 
53958aef2d28SSteven Rostedt static void
539638516ab5SSteven Rostedt ftrace_graph_probe_sched_switch(void *ignore,
539738516ab5SSteven Rostedt 			struct task_struct *prev, struct task_struct *next)
53988aef2d28SSteven Rostedt {
53998aef2d28SSteven Rostedt 	unsigned long long timestamp;
54008aef2d28SSteven Rostedt 	int index;
54018aef2d28SSteven Rostedt 
5402be6f164aSSteven Rostedt 	/*
5403be6f164aSSteven Rostedt 	 * Does the user want to count the time a function was asleep.
5404be6f164aSSteven Rostedt 	 * If so, do not update the time stamps.
5405be6f164aSSteven Rostedt 	 */
5406be6f164aSSteven Rostedt 	if (trace_flags & TRACE_ITER_SLEEP_TIME)
5407be6f164aSSteven Rostedt 		return;
5408be6f164aSSteven Rostedt 
54098aef2d28SSteven Rostedt 	timestamp = trace_clock_local();
54108aef2d28SSteven Rostedt 
54118aef2d28SSteven Rostedt 	prev->ftrace_timestamp = timestamp;
54128aef2d28SSteven Rostedt 
54138aef2d28SSteven Rostedt 	/* only process tasks that we timestamped */
54148aef2d28SSteven Rostedt 	if (!next->ftrace_timestamp)
54158aef2d28SSteven Rostedt 		return;
54168aef2d28SSteven Rostedt 
54178aef2d28SSteven Rostedt 	/*
54188aef2d28SSteven Rostedt 	 * Update all the counters in next to make up for the
54198aef2d28SSteven Rostedt 	 * time next was sleeping.
54208aef2d28SSteven Rostedt 	 */
54218aef2d28SSteven Rostedt 	timestamp -= next->ftrace_timestamp;
54228aef2d28SSteven Rostedt 
54238aef2d28SSteven Rostedt 	for (index = next->curr_ret_stack; index >= 0; index--)
54248aef2d28SSteven Rostedt 		next->ret_stack[index].calltime += timestamp;
54258aef2d28SSteven Rostedt }
54268aef2d28SSteven Rostedt 
5427f201ae23SFrederic Weisbecker /* Allocate a return stack for each task */
5428fb52607aSFrederic Weisbecker static int start_graph_tracing(void)
5429f201ae23SFrederic Weisbecker {
5430f201ae23SFrederic Weisbecker 	struct ftrace_ret_stack **ret_stack_list;
54315b058bcdSFrederic Weisbecker 	int ret, cpu;
5432f201ae23SFrederic Weisbecker 
5433f201ae23SFrederic Weisbecker 	ret_stack_list = kmalloc(FTRACE_RETSTACK_ALLOC_SIZE *
5434f201ae23SFrederic Weisbecker 				sizeof(struct ftrace_ret_stack *),
5435f201ae23SFrederic Weisbecker 				GFP_KERNEL);
5436f201ae23SFrederic Weisbecker 
5437f201ae23SFrederic Weisbecker 	if (!ret_stack_list)
5438f201ae23SFrederic Weisbecker 		return -ENOMEM;
5439f201ae23SFrederic Weisbecker 
54405b058bcdSFrederic Weisbecker 	/* The cpu_boot init_task->ret_stack will never be freed */
5441179c498aSSteven Rostedt 	for_each_online_cpu(cpu) {
5442179c498aSSteven Rostedt 		if (!idle_task(cpu)->ret_stack)
5443868baf07SSteven Rostedt 			ftrace_graph_init_idle_task(idle_task(cpu), cpu);
5444179c498aSSteven Rostedt 	}
54455b058bcdSFrederic Weisbecker 
5446f201ae23SFrederic Weisbecker 	do {
5447f201ae23SFrederic Weisbecker 		ret = alloc_retstack_tasklist(ret_stack_list);
5448f201ae23SFrederic Weisbecker 	} while (ret == -EAGAIN);
5449f201ae23SFrederic Weisbecker 
54508aef2d28SSteven Rostedt 	if (!ret) {
545138516ab5SSteven Rostedt 		ret = register_trace_sched_switch(ftrace_graph_probe_sched_switch, NULL);
54528aef2d28SSteven Rostedt 		if (ret)
54538aef2d28SSteven Rostedt 			pr_info("ftrace_graph: Couldn't activate tracepoint"
54548aef2d28SSteven Rostedt 				" probe to kernel_sched_switch\n");
54558aef2d28SSteven Rostedt 	}
54568aef2d28SSteven Rostedt 
5457f201ae23SFrederic Weisbecker 	kfree(ret_stack_list);
5458f201ae23SFrederic Weisbecker 	return ret;
5459f201ae23SFrederic Weisbecker }
5460f201ae23SFrederic Weisbecker 
54614a2b8ddaSFrederic Weisbecker /*
54624a2b8ddaSFrederic Weisbecker  * Hibernation protection.
54634a2b8ddaSFrederic Weisbecker  * The state of the current task is too much unstable during
54644a2b8ddaSFrederic Weisbecker  * suspend/restore to disk. We want to protect against that.
54654a2b8ddaSFrederic Weisbecker  */
54664a2b8ddaSFrederic Weisbecker static int
54674a2b8ddaSFrederic Weisbecker ftrace_suspend_notifier_call(struct notifier_block *bl, unsigned long state,
54684a2b8ddaSFrederic Weisbecker 							void *unused)
54694a2b8ddaSFrederic Weisbecker {
54704a2b8ddaSFrederic Weisbecker 	switch (state) {
54714a2b8ddaSFrederic Weisbecker 	case PM_HIBERNATION_PREPARE:
54724a2b8ddaSFrederic Weisbecker 		pause_graph_tracing();
54734a2b8ddaSFrederic Weisbecker 		break;
54744a2b8ddaSFrederic Weisbecker 
54754a2b8ddaSFrederic Weisbecker 	case PM_POST_HIBERNATION:
54764a2b8ddaSFrederic Weisbecker 		unpause_graph_tracing();
54774a2b8ddaSFrederic Weisbecker 		break;
54784a2b8ddaSFrederic Weisbecker 	}
54794a2b8ddaSFrederic Weisbecker 	return NOTIFY_DONE;
54804a2b8ddaSFrederic Weisbecker }
54814a2b8ddaSFrederic Weisbecker 
548223a8e844SSteven Rostedt (Red Hat) static int ftrace_graph_entry_test(struct ftrace_graph_ent *trace)
548323a8e844SSteven Rostedt (Red Hat) {
548423a8e844SSteven Rostedt (Red Hat) 	if (!ftrace_ops_test(&global_ops, trace->func, NULL))
548523a8e844SSteven Rostedt (Red Hat) 		return 0;
548623a8e844SSteven Rostedt (Red Hat) 	return __ftrace_graph_entry(trace);
548723a8e844SSteven Rostedt (Red Hat) }
548823a8e844SSteven Rostedt (Red Hat) 
548923a8e844SSteven Rostedt (Red Hat) /*
549023a8e844SSteven Rostedt (Red Hat)  * The function graph tracer should only trace the functions defined
549123a8e844SSteven Rostedt (Red Hat)  * by set_ftrace_filter and set_ftrace_notrace. If another function
549223a8e844SSteven Rostedt (Red Hat)  * tracer ops is registered, the graph tracer requires testing the
549323a8e844SSteven Rostedt (Red Hat)  * function against the global ops, and not just trace any function
549423a8e844SSteven Rostedt (Red Hat)  * that any ftrace_ops registered.
549523a8e844SSteven Rostedt (Red Hat)  */
549623a8e844SSteven Rostedt (Red Hat) static void update_function_graph_func(void)
549723a8e844SSteven Rostedt (Red Hat) {
54985f151b24SSteven Rostedt (Red Hat) 	struct ftrace_ops *op;
54995f151b24SSteven Rostedt (Red Hat) 	bool do_test = false;
55005f151b24SSteven Rostedt (Red Hat) 
55015f151b24SSteven Rostedt (Red Hat) 	/*
55025f151b24SSteven Rostedt (Red Hat) 	 * The graph and global ops share the same set of functions
55035f151b24SSteven Rostedt (Red Hat) 	 * to test. If any other ops is on the list, then
55045f151b24SSteven Rostedt (Red Hat) 	 * the graph tracing needs to test if its the function
55055f151b24SSteven Rostedt (Red Hat) 	 * it should call.
55065f151b24SSteven Rostedt (Red Hat) 	 */
55075f151b24SSteven Rostedt (Red Hat) 	do_for_each_ftrace_op(op, ftrace_ops_list) {
55085f151b24SSteven Rostedt (Red Hat) 		if (op != &global_ops && op != &graph_ops &&
55095f151b24SSteven Rostedt (Red Hat) 		    op != &ftrace_list_end) {
55105f151b24SSteven Rostedt (Red Hat) 			do_test = true;
55115f151b24SSteven Rostedt (Red Hat) 			/* in double loop, break out with goto */
55125f151b24SSteven Rostedt (Red Hat) 			goto out;
55135f151b24SSteven Rostedt (Red Hat) 		}
55145f151b24SSteven Rostedt (Red Hat) 	} while_for_each_ftrace_op(op);
55155f151b24SSteven Rostedt (Red Hat)  out:
55165f151b24SSteven Rostedt (Red Hat) 	if (do_test)
551723a8e844SSteven Rostedt (Red Hat) 		ftrace_graph_entry = ftrace_graph_entry_test;
55185f151b24SSteven Rostedt (Red Hat) 	else
55195f151b24SSteven Rostedt (Red Hat) 		ftrace_graph_entry = __ftrace_graph_entry;
552023a8e844SSteven Rostedt (Red Hat) }
552123a8e844SSteven Rostedt (Red Hat) 
55228275f69fSMathias Krause static struct notifier_block ftrace_suspend_notifier = {
55238275f69fSMathias Krause 	.notifier_call = ftrace_suspend_notifier_call,
55248275f69fSMathias Krause };
55258275f69fSMathias Krause 
5526287b6e68SFrederic Weisbecker int register_ftrace_graph(trace_func_graph_ret_t retfunc,
5527287b6e68SFrederic Weisbecker 			trace_func_graph_ent_t entryfunc)
552815e6cb36SFrederic Weisbecker {
5529e7d3737eSFrederic Weisbecker 	int ret = 0;
5530e7d3737eSFrederic Weisbecker 
5531e6ea44e9SSteven Rostedt 	mutex_lock(&ftrace_lock);
5532e7d3737eSFrederic Weisbecker 
553305ce5818SSteven Rostedt 	/* we currently allow only one tracer registered at a time */
5534597af815SSteven Rostedt 	if (ftrace_graph_active) {
553505ce5818SSteven Rostedt 		ret = -EBUSY;
553605ce5818SSteven Rostedt 		goto out;
553705ce5818SSteven Rostedt 	}
553805ce5818SSteven Rostedt 
55394a2b8ddaSFrederic Weisbecker 	register_pm_notifier(&ftrace_suspend_notifier);
55404a2b8ddaSFrederic Weisbecker 
5541597af815SSteven Rostedt 	ftrace_graph_active++;
5542fb52607aSFrederic Weisbecker 	ret = start_graph_tracing();
5543f201ae23SFrederic Weisbecker 	if (ret) {
5544597af815SSteven Rostedt 		ftrace_graph_active--;
5545f201ae23SFrederic Weisbecker 		goto out;
5546f201ae23SFrederic Weisbecker 	}
5547e53a6319SSteven Rostedt 
5548287b6e68SFrederic Weisbecker 	ftrace_graph_return = retfunc;
554923a8e844SSteven Rostedt (Red Hat) 
555023a8e844SSteven Rostedt (Red Hat) 	/*
555123a8e844SSteven Rostedt (Red Hat) 	 * Update the indirect function to the entryfunc, and the
555223a8e844SSteven Rostedt (Red Hat) 	 * function that gets called to the entry_test first. Then
555323a8e844SSteven Rostedt (Red Hat) 	 * call the update fgraph entry function to determine if
555423a8e844SSteven Rostedt (Red Hat) 	 * the entryfunc should be called directly or not.
555523a8e844SSteven Rostedt (Red Hat) 	 */
555623a8e844SSteven Rostedt (Red Hat) 	__ftrace_graph_entry = entryfunc;
555723a8e844SSteven Rostedt (Red Hat) 	ftrace_graph_entry = ftrace_graph_entry_test;
555823a8e844SSteven Rostedt (Red Hat) 	update_function_graph_func();
5559e53a6319SSteven Rostedt 
55605f151b24SSteven Rostedt (Red Hat) 	ret = ftrace_startup(&graph_ops, FTRACE_START_FUNC_RET);
5561e7d3737eSFrederic Weisbecker 
5562e7d3737eSFrederic Weisbecker out:
5563e6ea44e9SSteven Rostedt 	mutex_unlock(&ftrace_lock);
5564e7d3737eSFrederic Weisbecker 	return ret;
556515e6cb36SFrederic Weisbecker }
556615e6cb36SFrederic Weisbecker 
5567fb52607aSFrederic Weisbecker void unregister_ftrace_graph(void)
556815e6cb36SFrederic Weisbecker {
5569e6ea44e9SSteven Rostedt 	mutex_lock(&ftrace_lock);
5570e7d3737eSFrederic Weisbecker 
5571597af815SSteven Rostedt 	if (unlikely(!ftrace_graph_active))
55722aad1b76SSteven Rostedt 		goto out;
55732aad1b76SSteven Rostedt 
5574597af815SSteven Rostedt 	ftrace_graph_active--;
5575287b6e68SFrederic Weisbecker 	ftrace_graph_return = (trace_func_graph_ret_t)ftrace_stub;
5576e49dc19cSSteven Rostedt 	ftrace_graph_entry = ftrace_graph_entry_stub;
557723a8e844SSteven Rostedt (Red Hat) 	__ftrace_graph_entry = ftrace_graph_entry_stub;
55785f151b24SSteven Rostedt (Red Hat) 	ftrace_shutdown(&graph_ops, FTRACE_STOP_FUNC_RET);
55794a2b8ddaSFrederic Weisbecker 	unregister_pm_notifier(&ftrace_suspend_notifier);
558038516ab5SSteven Rostedt 	unregister_trace_sched_switch(ftrace_graph_probe_sched_switch, NULL);
5581e7d3737eSFrederic Weisbecker 
55822aad1b76SSteven Rostedt  out:
5583e6ea44e9SSteven Rostedt 	mutex_unlock(&ftrace_lock);
558415e6cb36SFrederic Weisbecker }
5585f201ae23SFrederic Weisbecker 
5586868baf07SSteven Rostedt static DEFINE_PER_CPU(struct ftrace_ret_stack *, idle_ret_stack);
5587868baf07SSteven Rostedt 
5588868baf07SSteven Rostedt static void
5589868baf07SSteven Rostedt graph_init_task(struct task_struct *t, struct ftrace_ret_stack *ret_stack)
5590868baf07SSteven Rostedt {
5591868baf07SSteven Rostedt 	atomic_set(&t->tracing_graph_pause, 0);
5592868baf07SSteven Rostedt 	atomic_set(&t->trace_overrun, 0);
5593868baf07SSteven Rostedt 	t->ftrace_timestamp = 0;
559425985edcSLucas De Marchi 	/* make curr_ret_stack visible before we add the ret_stack */
5595868baf07SSteven Rostedt 	smp_wmb();
5596868baf07SSteven Rostedt 	t->ret_stack = ret_stack;
5597868baf07SSteven Rostedt }
5598868baf07SSteven Rostedt 
5599868baf07SSteven Rostedt /*
5600868baf07SSteven Rostedt  * Allocate a return stack for the idle task. May be the first
5601868baf07SSteven Rostedt  * time through, or it may be done by CPU hotplug online.
5602868baf07SSteven Rostedt  */
5603868baf07SSteven Rostedt void ftrace_graph_init_idle_task(struct task_struct *t, int cpu)
5604868baf07SSteven Rostedt {
5605868baf07SSteven Rostedt 	t->curr_ret_stack = -1;
5606868baf07SSteven Rostedt 	/*
5607868baf07SSteven Rostedt 	 * The idle task has no parent, it either has its own
5608868baf07SSteven Rostedt 	 * stack or no stack at all.
5609868baf07SSteven Rostedt 	 */
5610868baf07SSteven Rostedt 	if (t->ret_stack)
5611868baf07SSteven Rostedt 		WARN_ON(t->ret_stack != per_cpu(idle_ret_stack, cpu));
5612868baf07SSteven Rostedt 
5613868baf07SSteven Rostedt 	if (ftrace_graph_active) {
5614868baf07SSteven Rostedt 		struct ftrace_ret_stack *ret_stack;
5615868baf07SSteven Rostedt 
5616868baf07SSteven Rostedt 		ret_stack = per_cpu(idle_ret_stack, cpu);
5617868baf07SSteven Rostedt 		if (!ret_stack) {
5618868baf07SSteven Rostedt 			ret_stack = kmalloc(FTRACE_RETFUNC_DEPTH
5619868baf07SSteven Rostedt 					    * sizeof(struct ftrace_ret_stack),
5620868baf07SSteven Rostedt 					    GFP_KERNEL);
5621868baf07SSteven Rostedt 			if (!ret_stack)
5622868baf07SSteven Rostedt 				return;
5623868baf07SSteven Rostedt 			per_cpu(idle_ret_stack, cpu) = ret_stack;
5624868baf07SSteven Rostedt 		}
5625868baf07SSteven Rostedt 		graph_init_task(t, ret_stack);
5626868baf07SSteven Rostedt 	}
5627868baf07SSteven Rostedt }
5628868baf07SSteven Rostedt 
5629f201ae23SFrederic Weisbecker /* Allocate a return stack for newly created task */
5630fb52607aSFrederic Weisbecker void ftrace_graph_init_task(struct task_struct *t)
5631f201ae23SFrederic Weisbecker {
563284047e36SSteven Rostedt 	/* Make sure we do not use the parent ret_stack */
563384047e36SSteven Rostedt 	t->ret_stack = NULL;
5634ea14eb71SSteven Rostedt 	t->curr_ret_stack = -1;
563584047e36SSteven Rostedt 
5636597af815SSteven Rostedt 	if (ftrace_graph_active) {
563782310a32SSteven Rostedt 		struct ftrace_ret_stack *ret_stack;
563882310a32SSteven Rostedt 
563982310a32SSteven Rostedt 		ret_stack = kmalloc(FTRACE_RETFUNC_DEPTH
5640f201ae23SFrederic Weisbecker 				* sizeof(struct ftrace_ret_stack),
5641f201ae23SFrederic Weisbecker 				GFP_KERNEL);
564282310a32SSteven Rostedt 		if (!ret_stack)
5643f201ae23SFrederic Weisbecker 			return;
5644868baf07SSteven Rostedt 		graph_init_task(t, ret_stack);
564584047e36SSteven Rostedt 	}
5646f201ae23SFrederic Weisbecker }
5647f201ae23SFrederic Weisbecker 
5648fb52607aSFrederic Weisbecker void ftrace_graph_exit_task(struct task_struct *t)
5649f201ae23SFrederic Weisbecker {
5650eae849caSFrederic Weisbecker 	struct ftrace_ret_stack	*ret_stack = t->ret_stack;
5651eae849caSFrederic Weisbecker 
5652f201ae23SFrederic Weisbecker 	t->ret_stack = NULL;
5653eae849caSFrederic Weisbecker 	/* NULL must become visible to IRQs before we free it: */
5654eae849caSFrederic Weisbecker 	barrier();
5655eae849caSFrederic Weisbecker 
5656eae849caSFrederic Weisbecker 	kfree(ret_stack);
5657f201ae23SFrederic Weisbecker }
565815e6cb36SFrederic Weisbecker #endif
5659