xref: /linux-6.15/kernel/trace/ftrace.c (revision 44925dff)
116444a8aSArnaldo Carvalho de Melo /*
216444a8aSArnaldo Carvalho de Melo  * Infrastructure for profiling code inserted by 'gcc -pg'.
316444a8aSArnaldo Carvalho de Melo  *
416444a8aSArnaldo Carvalho de Melo  * Copyright (C) 2007-2008 Steven Rostedt <[email protected]>
516444a8aSArnaldo Carvalho de Melo  * Copyright (C) 2004-2008 Ingo Molnar <[email protected]>
616444a8aSArnaldo Carvalho de Melo  *
716444a8aSArnaldo Carvalho de Melo  * Originally ported from the -rt patch by:
816444a8aSArnaldo Carvalho de Melo  *   Copyright (C) 2007 Arnaldo Carvalho de Melo <[email protected]>
916444a8aSArnaldo Carvalho de Melo  *
1016444a8aSArnaldo Carvalho de Melo  * Based on code in the latency_tracer, that is:
1116444a8aSArnaldo Carvalho de Melo  *
1216444a8aSArnaldo Carvalho de Melo  *  Copyright (C) 2004-2006 Ingo Molnar
136d49e352SNadia Yvette Chambers  *  Copyright (C) 2004 Nadia Yvette Chambers
1416444a8aSArnaldo Carvalho de Melo  */
1516444a8aSArnaldo Carvalho de Melo 
163d083395SSteven Rostedt #include <linux/stop_machine.h>
173d083395SSteven Rostedt #include <linux/clocksource.h>
1829930025SIngo Molnar #include <linux/sched/task.h>
193d083395SSteven Rostedt #include <linux/kallsyms.h>
205072c59fSSteven Rostedt #include <linux/seq_file.h>
214a2b8ddaSFrederic Weisbecker #include <linux/suspend.h>
228434dc93SSteven Rostedt (Red Hat) #include <linux/tracefs.h>
233d083395SSteven Rostedt #include <linux/hardirq.h>
242d8b820bSIngo Molnar #include <linux/kthread.h>
255072c59fSSteven Rostedt #include <linux/uaccess.h>
265855feadSSteven Rostedt #include <linux/bsearch.h>
2756d82e00SPaul Gortmaker #include <linux/module.h>
282d8b820bSIngo Molnar #include <linux/ftrace.h>
29b0fc494fSSteven Rostedt #include <linux/sysctl.h>
305a0e3ad6STejun Heo #include <linux/slab.h>
315072c59fSSteven Rostedt #include <linux/ctype.h>
3268950619SSteven Rostedt #include <linux/sort.h>
333d083395SSteven Rostedt #include <linux/list.h>
3459df055fSSteven Rostedt #include <linux/hash.h>
353f379b03SPaul E. McKenney #include <linux/rcupdate.h>
3616444a8aSArnaldo Carvalho de Melo 
37ad8d75ffSSteven Rostedt #include <trace/events/sched.h>
388aef2d28SSteven Rostedt 
39b80f0f6cSSteven Rostedt (VMware) #include <asm/sections.h>
402af15d6aSSteven Rostedt #include <asm/setup.h>
41395a59d0SAbhishek Sagar 
420706f1c4SSteven Rostedt #include "trace_output.h"
43bac429f0SSteven Rostedt #include "trace_stat.h"
443d083395SSteven Rostedt 
456912896eSSteven Rostedt #define FTRACE_WARN_ON(cond)			\
460778d9adSSteven Rostedt 	({					\
470778d9adSSteven Rostedt 		int ___r = cond;		\
480778d9adSSteven Rostedt 		if (WARN_ON(___r))		\
496912896eSSteven Rostedt 			ftrace_kill();		\
500778d9adSSteven Rostedt 		___r;				\
510778d9adSSteven Rostedt 	})
526912896eSSteven Rostedt 
536912896eSSteven Rostedt #define FTRACE_WARN_ON_ONCE(cond)		\
540778d9adSSteven Rostedt 	({					\
550778d9adSSteven Rostedt 		int ___r = cond;		\
560778d9adSSteven Rostedt 		if (WARN_ON_ONCE(___r))		\
576912896eSSteven Rostedt 			ftrace_kill();		\
580778d9adSSteven Rostedt 		___r;				\
590778d9adSSteven Rostedt 	})
606912896eSSteven Rostedt 
618fc0c701SSteven Rostedt /* hash bits for specific function selection */
628fc0c701SSteven Rostedt #define FTRACE_HASH_BITS 7
638fc0c701SSteven Rostedt #define FTRACE_FUNC_HASHSIZE (1 << FTRACE_HASH_BITS)
6433dc9b12SSteven Rostedt #define FTRACE_HASH_DEFAULT_BITS 10
6533dc9b12SSteven Rostedt #define FTRACE_HASH_MAX_BITS 12
668fc0c701SSteven Rostedt 
67f04f24fbSMasami Hiramatsu #ifdef CONFIG_DYNAMIC_FTRACE
6833b7f99cSSteven Rostedt (Red Hat) #define INIT_OPS_HASH(opsname)	\
6933b7f99cSSteven Rostedt (Red Hat) 	.func_hash		= &opsname.local_hash,			\
7033b7f99cSSteven Rostedt (Red Hat) 	.local_hash.regex_lock	= __MUTEX_INITIALIZER(opsname.local_hash.regex_lock),
715f151b24SSteven Rostedt (Red Hat) #define ASSIGN_OPS_HASH(opsname, val) \
725f151b24SSteven Rostedt (Red Hat) 	.func_hash		= val, \
735f151b24SSteven Rostedt (Red Hat) 	.local_hash.regex_lock	= __MUTEX_INITIALIZER(opsname.local_hash.regex_lock),
74f04f24fbSMasami Hiramatsu #else
7533b7f99cSSteven Rostedt (Red Hat) #define INIT_OPS_HASH(opsname)
765f151b24SSteven Rostedt (Red Hat) #define ASSIGN_OPS_HASH(opsname, val)
77f04f24fbSMasami Hiramatsu #endif
78f04f24fbSMasami Hiramatsu 
792f5f6ad9SSteven Rostedt static struct ftrace_ops ftrace_list_end __read_mostly = {
802f5f6ad9SSteven Rostedt 	.func		= ftrace_stub,
81395b97a3SSteven Rostedt (Red Hat) 	.flags		= FTRACE_OPS_FL_RECURSION_SAFE | FTRACE_OPS_FL_STUB,
8233b7f99cSSteven Rostedt (Red Hat) 	INIT_OPS_HASH(ftrace_list_end)
832f5f6ad9SSteven Rostedt };
842f5f6ad9SSteven Rostedt 
854eebcc81SSteven Rostedt /* ftrace_enabled is a method to turn ftrace on or off */
864eebcc81SSteven Rostedt int ftrace_enabled __read_mostly;
87d61f82d0SSteven Rostedt static int last_ftrace_enabled;
88b0fc494fSSteven Rostedt 
892f5f6ad9SSteven Rostedt /* Current function tracing op */
902f5f6ad9SSteven Rostedt struct ftrace_ops *function_trace_op __read_mostly = &ftrace_list_end;
91405e1d83SSteven Rostedt (Red Hat) /* What to set function_trace_op to */
92405e1d83SSteven Rostedt (Red Hat) static struct ftrace_ops *set_function_trace_op;
9360a7ecf4SSteven Rostedt 
94345ddcc8SSteven Rostedt (Red Hat) static bool ftrace_pids_enabled(struct ftrace_ops *ops)
95e3eea140SSteven Rostedt (Red Hat) {
96345ddcc8SSteven Rostedt (Red Hat) 	struct trace_array *tr;
97345ddcc8SSteven Rostedt (Red Hat) 
98345ddcc8SSteven Rostedt (Red Hat) 	if (!(ops->flags & FTRACE_OPS_FL_PID) || !ops->private)
99345ddcc8SSteven Rostedt (Red Hat) 		return false;
100345ddcc8SSteven Rostedt (Red Hat) 
101345ddcc8SSteven Rostedt (Red Hat) 	tr = ops->private;
102345ddcc8SSteven Rostedt (Red Hat) 
103345ddcc8SSteven Rostedt (Red Hat) 	return tr->function_pids != NULL;
104e3eea140SSteven Rostedt (Red Hat) }
105e3eea140SSteven Rostedt (Red Hat) 
106e3eea140SSteven Rostedt (Red Hat) static void ftrace_update_trampoline(struct ftrace_ops *ops);
107e3eea140SSteven Rostedt (Red Hat) 
1084eebcc81SSteven Rostedt /*
1094eebcc81SSteven Rostedt  * ftrace_disabled is set when an anomaly is discovered.
1104eebcc81SSteven Rostedt  * ftrace_disabled is much stronger than ftrace_enabled.
1114eebcc81SSteven Rostedt  */
1124eebcc81SSteven Rostedt static int ftrace_disabled __read_mostly;
1134eebcc81SSteven Rostedt 
11452baf119SSteven Rostedt static DEFINE_MUTEX(ftrace_lock);
115b0fc494fSSteven Rostedt 
116b848914cSSteven Rostedt static struct ftrace_ops *ftrace_ops_list __read_mostly = &ftrace_list_end;
11716444a8aSArnaldo Carvalho de Melo ftrace_func_t ftrace_trace_function __read_mostly = ftrace_stub;
1182b499381SSteven Rostedt static struct ftrace_ops global_ops;
11916444a8aSArnaldo Carvalho de Melo 
1202f5f6ad9SSteven Rostedt #if ARCH_SUPPORTS_FTRACE_OPS
1212f5f6ad9SSteven Rostedt static void ftrace_ops_list_func(unsigned long ip, unsigned long parent_ip,
122a1e2e31dSSteven Rostedt 				 struct ftrace_ops *op, struct pt_regs *regs);
1232f5f6ad9SSteven Rostedt #else
1242f5f6ad9SSteven Rostedt /* See comment below, where ftrace_ops_list_func is defined */
1252f5f6ad9SSteven Rostedt static void ftrace_ops_no_ops(unsigned long ip, unsigned long parent_ip);
1262f5f6ad9SSteven Rostedt #define ftrace_ops_list_func ((ftrace_func_t)ftrace_ops_no_ops)
1272f5f6ad9SSteven Rostedt #endif
128b848914cSSteven Rostedt 
1290a016409SSteven Rostedt /*
1300a016409SSteven Rostedt  * Traverse the ftrace_global_list, invoking all entries.  The reason that we
1311bb539caSSteven Rostedt  * can use rcu_dereference_raw_notrace() is that elements removed from this list
1320a016409SSteven Rostedt  * are simply leaked, so there is no need to interact with a grace-period
1331bb539caSSteven Rostedt  * mechanism.  The rcu_dereference_raw_notrace() calls are needed to handle
1340a016409SSteven Rostedt  * concurrent insertions into the ftrace_global_list.
1350a016409SSteven Rostedt  *
1360a016409SSteven Rostedt  * Silly Alpha and silly pointer-speculation compiler optimizations!
1370a016409SSteven Rostedt  */
1380a016409SSteven Rostedt #define do_for_each_ftrace_op(op, list)			\
1391bb539caSSteven Rostedt 	op = rcu_dereference_raw_notrace(list);			\
1400a016409SSteven Rostedt 	do
1410a016409SSteven Rostedt 
1420a016409SSteven Rostedt /*
1430a016409SSteven Rostedt  * Optimized for just a single item in the list (as that is the normal case).
1440a016409SSteven Rostedt  */
1450a016409SSteven Rostedt #define while_for_each_ftrace_op(op)				\
1461bb539caSSteven Rostedt 	while (likely(op = rcu_dereference_raw_notrace((op)->next)) &&	\
1470a016409SSteven Rostedt 	       unlikely((op) != &ftrace_list_end))
1480a016409SSteven Rostedt 
149f04f24fbSMasami Hiramatsu static inline void ftrace_ops_init(struct ftrace_ops *ops)
150f04f24fbSMasami Hiramatsu {
151f04f24fbSMasami Hiramatsu #ifdef CONFIG_DYNAMIC_FTRACE
152f04f24fbSMasami Hiramatsu 	if (!(ops->flags & FTRACE_OPS_FL_INITIALIZED)) {
15333b7f99cSSteven Rostedt (Red Hat) 		mutex_init(&ops->local_hash.regex_lock);
15433b7f99cSSteven Rostedt (Red Hat) 		ops->func_hash = &ops->local_hash;
155f04f24fbSMasami Hiramatsu 		ops->flags |= FTRACE_OPS_FL_INITIALIZED;
156f04f24fbSMasami Hiramatsu 	}
157f04f24fbSMasami Hiramatsu #endif
158f04f24fbSMasami Hiramatsu }
159f04f24fbSMasami Hiramatsu 
160ea701f11SSteven Rostedt /**
161ea701f11SSteven Rostedt  * ftrace_nr_registered_ops - return number of ops registered
162ea701f11SSteven Rostedt  *
163ea701f11SSteven Rostedt  * Returns the number of ftrace_ops registered and tracing functions
164ea701f11SSteven Rostedt  */
165ea701f11SSteven Rostedt int ftrace_nr_registered_ops(void)
166ea701f11SSteven Rostedt {
167ea701f11SSteven Rostedt 	struct ftrace_ops *ops;
168ea701f11SSteven Rostedt 	int cnt = 0;
169ea701f11SSteven Rostedt 
170ea701f11SSteven Rostedt 	mutex_lock(&ftrace_lock);
171ea701f11SSteven Rostedt 
172ea701f11SSteven Rostedt 	for (ops = ftrace_ops_list;
173ea701f11SSteven Rostedt 	     ops != &ftrace_list_end; ops = ops->next)
174ea701f11SSteven Rostedt 		cnt++;
175ea701f11SSteven Rostedt 
176ea701f11SSteven Rostedt 	mutex_unlock(&ftrace_lock);
177ea701f11SSteven Rostedt 
178ea701f11SSteven Rostedt 	return cnt;
179ea701f11SSteven Rostedt }
180ea701f11SSteven Rostedt 
1812f5f6ad9SSteven Rostedt static void ftrace_pid_func(unsigned long ip, unsigned long parent_ip,
182a1e2e31dSSteven Rostedt 			    struct ftrace_ops *op, struct pt_regs *regs)
183df4fc315SSteven Rostedt {
184345ddcc8SSteven Rostedt (Red Hat) 	struct trace_array *tr = op->private;
185345ddcc8SSteven Rostedt (Red Hat) 
186345ddcc8SSteven Rostedt (Red Hat) 	if (tr && this_cpu_read(tr->trace_buffer.data->ftrace_ignore_pid))
187df4fc315SSteven Rostedt 		return;
188df4fc315SSteven Rostedt 
189e3eea140SSteven Rostedt (Red Hat) 	op->saved_func(ip, parent_ip, op, regs);
190df4fc315SSteven Rostedt }
191df4fc315SSteven Rostedt 
19216444a8aSArnaldo Carvalho de Melo /**
1933d083395SSteven Rostedt  * clear_ftrace_function - reset the ftrace function
19416444a8aSArnaldo Carvalho de Melo  *
1953d083395SSteven Rostedt  * This NULLs the ftrace function and in essence stops
1963d083395SSteven Rostedt  * tracing.  There may be lag
19716444a8aSArnaldo Carvalho de Melo  */
1983d083395SSteven Rostedt void clear_ftrace_function(void)
19916444a8aSArnaldo Carvalho de Melo {
2003d083395SSteven Rostedt 	ftrace_trace_function = ftrace_stub;
2013d083395SSteven Rostedt }
20216444a8aSArnaldo Carvalho de Melo 
203ba27f2bcSSteven Rostedt (Red Hat) static void per_cpu_ops_disable_all(struct ftrace_ops *ops)
204e248491aSJiri Olsa {
205e248491aSJiri Olsa 	int cpu;
206e248491aSJiri Olsa 
207e248491aSJiri Olsa 	for_each_possible_cpu(cpu)
208e248491aSJiri Olsa 		*per_cpu_ptr(ops->disabled, cpu) = 1;
209e248491aSJiri Olsa }
210e248491aSJiri Olsa 
211ba27f2bcSSteven Rostedt (Red Hat) static int per_cpu_ops_alloc(struct ftrace_ops *ops)
212e248491aSJiri Olsa {
213e248491aSJiri Olsa 	int __percpu *disabled;
214e248491aSJiri Olsa 
215ba27f2bcSSteven Rostedt (Red Hat) 	if (WARN_ON_ONCE(!(ops->flags & FTRACE_OPS_FL_PER_CPU)))
216ba27f2bcSSteven Rostedt (Red Hat) 		return -EINVAL;
217ba27f2bcSSteven Rostedt (Red Hat) 
218e248491aSJiri Olsa 	disabled = alloc_percpu(int);
219e248491aSJiri Olsa 	if (!disabled)
220e248491aSJiri Olsa 		return -ENOMEM;
221e248491aSJiri Olsa 
222e248491aSJiri Olsa 	ops->disabled = disabled;
223ba27f2bcSSteven Rostedt (Red Hat) 	per_cpu_ops_disable_all(ops);
224e248491aSJiri Olsa 	return 0;
225e248491aSJiri Olsa }
226e248491aSJiri Olsa 
227405e1d83SSteven Rostedt (Red Hat) static void ftrace_sync(struct work_struct *work)
228405e1d83SSteven Rostedt (Red Hat) {
229405e1d83SSteven Rostedt (Red Hat) 	/*
230405e1d83SSteven Rostedt (Red Hat) 	 * This function is just a stub to implement a hard force
231405e1d83SSteven Rostedt (Red Hat) 	 * of synchronize_sched(). This requires synchronizing
232405e1d83SSteven Rostedt (Red Hat) 	 * tasks even in userspace and idle.
233405e1d83SSteven Rostedt (Red Hat) 	 *
234405e1d83SSteven Rostedt (Red Hat) 	 * Yes, function tracing is rude.
235405e1d83SSteven Rostedt (Red Hat) 	 */
236405e1d83SSteven Rostedt (Red Hat) }
237405e1d83SSteven Rostedt (Red Hat) 
238405e1d83SSteven Rostedt (Red Hat) static void ftrace_sync_ipi(void *data)
239405e1d83SSteven Rostedt (Red Hat) {
240405e1d83SSteven Rostedt (Red Hat) 	/* Probably not needed, but do it anyway */
241405e1d83SSteven Rostedt (Red Hat) 	smp_rmb();
242405e1d83SSteven Rostedt (Red Hat) }
243405e1d83SSteven Rostedt (Red Hat) 
24423a8e844SSteven Rostedt (Red Hat) #ifdef CONFIG_FUNCTION_GRAPH_TRACER
24523a8e844SSteven Rostedt (Red Hat) static void update_function_graph_func(void);
24655577204SSteven Rostedt (Red Hat) 
24755577204SSteven Rostedt (Red Hat) /* Both enabled by default (can be cleared by function_graph tracer flags */
24855577204SSteven Rostedt (Red Hat) static bool fgraph_sleep_time = true;
24955577204SSteven Rostedt (Red Hat) static bool fgraph_graph_time = true;
25055577204SSteven Rostedt (Red Hat) 
25123a8e844SSteven Rostedt (Red Hat) #else
25223a8e844SSteven Rostedt (Red Hat) static inline void update_function_graph_func(void) { }
25323a8e844SSteven Rostedt (Red Hat) #endif
25423a8e844SSteven Rostedt (Red Hat) 
25500ccbf2fSSteven Rostedt (Red Hat) 
25600ccbf2fSSteven Rostedt (Red Hat) static ftrace_func_t ftrace_ops_get_list_func(struct ftrace_ops *ops)
25700ccbf2fSSteven Rostedt (Red Hat) {
25800ccbf2fSSteven Rostedt (Red Hat) 	/*
259ba27f2bcSSteven Rostedt (Red Hat) 	 * If this is a dynamic, RCU, or per CPU ops, or we force list func,
26000ccbf2fSSteven Rostedt (Red Hat) 	 * then it needs to call the list anyway.
26100ccbf2fSSteven Rostedt (Red Hat) 	 */
262ba27f2bcSSteven Rostedt (Red Hat) 	if (ops->flags & (FTRACE_OPS_FL_DYNAMIC | FTRACE_OPS_FL_PER_CPU |
263ba27f2bcSSteven Rostedt (Red Hat) 			  FTRACE_OPS_FL_RCU) || FTRACE_FORCE_LIST_FUNC)
26400ccbf2fSSteven Rostedt (Red Hat) 		return ftrace_ops_list_func;
26500ccbf2fSSteven Rostedt (Red Hat) 
26600ccbf2fSSteven Rostedt (Red Hat) 	return ftrace_ops_get_func(ops);
26700ccbf2fSSteven Rostedt (Red Hat) }
26800ccbf2fSSteven Rostedt (Red Hat) 
2692b499381SSteven Rostedt static void update_ftrace_function(void)
2702b499381SSteven Rostedt {
2712b499381SSteven Rostedt 	ftrace_func_t func;
2722b499381SSteven Rostedt 
273cdbe61bfSSteven Rostedt 	/*
274f7aad4e1SSteven Rostedt (Red Hat) 	 * Prepare the ftrace_ops that the arch callback will use.
275f7aad4e1SSteven Rostedt (Red Hat) 	 * If there's only one ftrace_ops registered, the ftrace_ops_list
276f7aad4e1SSteven Rostedt (Red Hat) 	 * will point to the ops we want.
277f7aad4e1SSteven Rostedt (Red Hat) 	 */
278f7aad4e1SSteven Rostedt (Red Hat) 	set_function_trace_op = ftrace_ops_list;
279f7aad4e1SSteven Rostedt (Red Hat) 
280f7aad4e1SSteven Rostedt (Red Hat) 	/* If there's no ftrace_ops registered, just call the stub function */
281f7aad4e1SSteven Rostedt (Red Hat) 	if (ftrace_ops_list == &ftrace_list_end) {
282f7aad4e1SSteven Rostedt (Red Hat) 		func = ftrace_stub;
283f7aad4e1SSteven Rostedt (Red Hat) 
284f7aad4e1SSteven Rostedt (Red Hat) 	/*
285cdbe61bfSSteven Rostedt 	 * If we are at the end of the list and this ops is
2864740974aSSteven Rostedt 	 * recursion safe and not dynamic and the arch supports passing ops,
2874740974aSSteven Rostedt 	 * then have the mcount trampoline call the function directly.
288cdbe61bfSSteven Rostedt 	 */
289f7aad4e1SSteven Rostedt (Red Hat) 	} else if (ftrace_ops_list->next == &ftrace_list_end) {
29000ccbf2fSSteven Rostedt (Red Hat) 		func = ftrace_ops_get_list_func(ftrace_ops_list);
291f7aad4e1SSteven Rostedt (Red Hat) 
2922f5f6ad9SSteven Rostedt 	} else {
2932f5f6ad9SSteven Rostedt 		/* Just use the default ftrace_ops */
294405e1d83SSteven Rostedt (Red Hat) 		set_function_trace_op = &ftrace_list_end;
295b848914cSSteven Rostedt 		func = ftrace_ops_list_func;
2962f5f6ad9SSteven Rostedt 	}
2972b499381SSteven Rostedt 
2985f8bf2d2SSteven Rostedt (Red Hat) 	update_function_graph_func();
2995f8bf2d2SSteven Rostedt (Red Hat) 
300405e1d83SSteven Rostedt (Red Hat) 	/* If there's no change, then do nothing more here */
301405e1d83SSteven Rostedt (Red Hat) 	if (ftrace_trace_function == func)
302405e1d83SSteven Rostedt (Red Hat) 		return;
303405e1d83SSteven Rostedt (Red Hat) 
304405e1d83SSteven Rostedt (Red Hat) 	/*
305405e1d83SSteven Rostedt (Red Hat) 	 * If we are using the list function, it doesn't care
306405e1d83SSteven Rostedt (Red Hat) 	 * about the function_trace_ops.
307405e1d83SSteven Rostedt (Red Hat) 	 */
308405e1d83SSteven Rostedt (Red Hat) 	if (func == ftrace_ops_list_func) {
309405e1d83SSteven Rostedt (Red Hat) 		ftrace_trace_function = func;
310405e1d83SSteven Rostedt (Red Hat) 		/*
311405e1d83SSteven Rostedt (Red Hat) 		 * Don't even bother setting function_trace_ops,
312405e1d83SSteven Rostedt (Red Hat) 		 * it would be racy to do so anyway.
313405e1d83SSteven Rostedt (Red Hat) 		 */
314405e1d83SSteven Rostedt (Red Hat) 		return;
315405e1d83SSteven Rostedt (Red Hat) 	}
316405e1d83SSteven Rostedt (Red Hat) 
317405e1d83SSteven Rostedt (Red Hat) #ifndef CONFIG_DYNAMIC_FTRACE
318405e1d83SSteven Rostedt (Red Hat) 	/*
319405e1d83SSteven Rostedt (Red Hat) 	 * For static tracing, we need to be a bit more careful.
320405e1d83SSteven Rostedt (Red Hat) 	 * The function change takes affect immediately. Thus,
321405e1d83SSteven Rostedt (Red Hat) 	 * we need to coorditate the setting of the function_trace_ops
322405e1d83SSteven Rostedt (Red Hat) 	 * with the setting of the ftrace_trace_function.
323405e1d83SSteven Rostedt (Red Hat) 	 *
324405e1d83SSteven Rostedt (Red Hat) 	 * Set the function to the list ops, which will call the
325405e1d83SSteven Rostedt (Red Hat) 	 * function we want, albeit indirectly, but it handles the
326405e1d83SSteven Rostedt (Red Hat) 	 * ftrace_ops and doesn't depend on function_trace_op.
327405e1d83SSteven Rostedt (Red Hat) 	 */
328405e1d83SSteven Rostedt (Red Hat) 	ftrace_trace_function = ftrace_ops_list_func;
329405e1d83SSteven Rostedt (Red Hat) 	/*
330405e1d83SSteven Rostedt (Red Hat) 	 * Make sure all CPUs see this. Yes this is slow, but static
331405e1d83SSteven Rostedt (Red Hat) 	 * tracing is slow and nasty to have enabled.
332405e1d83SSteven Rostedt (Red Hat) 	 */
333405e1d83SSteven Rostedt (Red Hat) 	schedule_on_each_cpu(ftrace_sync);
334405e1d83SSteven Rostedt (Red Hat) 	/* Now all cpus are using the list ops. */
335405e1d83SSteven Rostedt (Red Hat) 	function_trace_op = set_function_trace_op;
336405e1d83SSteven Rostedt (Red Hat) 	/* Make sure the function_trace_op is visible on all CPUs */
337405e1d83SSteven Rostedt (Red Hat) 	smp_wmb();
338405e1d83SSteven Rostedt (Red Hat) 	/* Nasty way to force a rmb on all cpus */
339405e1d83SSteven Rostedt (Red Hat) 	smp_call_function(ftrace_sync_ipi, NULL, 1);
340405e1d83SSteven Rostedt (Red Hat) 	/* OK, we are all set to update the ftrace_trace_function now! */
341405e1d83SSteven Rostedt (Red Hat) #endif /* !CONFIG_DYNAMIC_FTRACE */
342405e1d83SSteven Rostedt (Red Hat) 
343491d0dcfSSteven Rostedt 	ftrace_trace_function = func;
344491d0dcfSSteven Rostedt }
345491d0dcfSSteven Rostedt 
3467eea4fceSJiaxing Wang int using_ftrace_ops_list_func(void)
3477eea4fceSJiaxing Wang {
3487eea4fceSJiaxing Wang 	return ftrace_trace_function == ftrace_ops_list_func;
3497eea4fceSJiaxing Wang }
3507eea4fceSJiaxing Wang 
3512b499381SSteven Rostedt static void add_ftrace_ops(struct ftrace_ops **list, struct ftrace_ops *ops)
3523d083395SSteven Rostedt {
3532b499381SSteven Rostedt 	ops->next = *list;
35416444a8aSArnaldo Carvalho de Melo 	/*
355b848914cSSteven Rostedt 	 * We are entering ops into the list but another
35616444a8aSArnaldo Carvalho de Melo 	 * CPU might be walking that list. We need to make sure
35716444a8aSArnaldo Carvalho de Melo 	 * the ops->next pointer is valid before another CPU sees
358b848914cSSteven Rostedt 	 * the ops pointer included into the list.
35916444a8aSArnaldo Carvalho de Melo 	 */
3602b499381SSteven Rostedt 	rcu_assign_pointer(*list, ops);
3612b499381SSteven Rostedt }
3623d083395SSteven Rostedt 
3632b499381SSteven Rostedt static int remove_ftrace_ops(struct ftrace_ops **list, struct ftrace_ops *ops)
3642b499381SSteven Rostedt {
3652b499381SSteven Rostedt 	struct ftrace_ops **p;
3662b499381SSteven Rostedt 
3672b499381SSteven Rostedt 	/*
3682b499381SSteven Rostedt 	 * If we are removing the last function, then simply point
3692b499381SSteven Rostedt 	 * to the ftrace_stub.
3702b499381SSteven Rostedt 	 */
3712b499381SSteven Rostedt 	if (*list == ops && ops->next == &ftrace_list_end) {
3722b499381SSteven Rostedt 		*list = &ftrace_list_end;
3732b499381SSteven Rostedt 		return 0;
3742b499381SSteven Rostedt 	}
3752b499381SSteven Rostedt 
3762b499381SSteven Rostedt 	for (p = list; *p != &ftrace_list_end; p = &(*p)->next)
3772b499381SSteven Rostedt 		if (*p == ops)
3782b499381SSteven Rostedt 			break;
3792b499381SSteven Rostedt 
3802b499381SSteven Rostedt 	if (*p != ops)
3812b499381SSteven Rostedt 		return -1;
3822b499381SSteven Rostedt 
3832b499381SSteven Rostedt 	*p = (*p)->next;
3842b499381SSteven Rostedt 	return 0;
3852b499381SSteven Rostedt }
3862b499381SSteven Rostedt 
387f3bea491SSteven Rostedt (Red Hat) static void ftrace_update_trampoline(struct ftrace_ops *ops);
388f3bea491SSteven Rostedt (Red Hat) 
3892b499381SSteven Rostedt static int __register_ftrace_function(struct ftrace_ops *ops)
3902b499381SSteven Rostedt {
391591dffdaSSteven Rostedt (Red Hat) 	if (ops->flags & FTRACE_OPS_FL_DELETED)
392591dffdaSSteven Rostedt (Red Hat) 		return -EINVAL;
393591dffdaSSteven Rostedt (Red Hat) 
394b848914cSSteven Rostedt 	if (WARN_ON(ops->flags & FTRACE_OPS_FL_ENABLED))
395b848914cSSteven Rostedt 		return -EBUSY;
396b848914cSSteven Rostedt 
39706aeaaeaSMasami Hiramatsu #ifndef CONFIG_DYNAMIC_FTRACE_WITH_REGS
39808f6fba5SSteven Rostedt 	/*
39908f6fba5SSteven Rostedt 	 * If the ftrace_ops specifies SAVE_REGS, then it only can be used
40008f6fba5SSteven Rostedt 	 * if the arch supports it, or SAVE_REGS_IF_SUPPORTED is also set.
40108f6fba5SSteven Rostedt 	 * Setting SAVE_REGS_IF_SUPPORTED makes SAVE_REGS irrelevant.
40208f6fba5SSteven Rostedt 	 */
40308f6fba5SSteven Rostedt 	if (ops->flags & FTRACE_OPS_FL_SAVE_REGS &&
40408f6fba5SSteven Rostedt 	    !(ops->flags & FTRACE_OPS_FL_SAVE_REGS_IF_SUPPORTED))
40508f6fba5SSteven Rostedt 		return -EINVAL;
40608f6fba5SSteven Rostedt 
40708f6fba5SSteven Rostedt 	if (ops->flags & FTRACE_OPS_FL_SAVE_REGS_IF_SUPPORTED)
40808f6fba5SSteven Rostedt 		ops->flags |= FTRACE_OPS_FL_SAVE_REGS;
40908f6fba5SSteven Rostedt #endif
41008f6fba5SSteven Rostedt 
411cdbe61bfSSteven Rostedt 	if (!core_kernel_data((unsigned long)ops))
412cdbe61bfSSteven Rostedt 		ops->flags |= FTRACE_OPS_FL_DYNAMIC;
413cdbe61bfSSteven Rostedt 
414ba27f2bcSSteven Rostedt (Red Hat) 	if (ops->flags & FTRACE_OPS_FL_PER_CPU) {
415ba27f2bcSSteven Rostedt (Red Hat) 		if (per_cpu_ops_alloc(ops))
416e248491aSJiri Olsa 			return -ENOMEM;
417ba27f2bcSSteven Rostedt (Red Hat) 	}
418ba27f2bcSSteven Rostedt (Red Hat) 
419b848914cSSteven Rostedt 	add_ftrace_ops(&ftrace_ops_list, ops);
420b848914cSSteven Rostedt 
421e3eea140SSteven Rostedt (Red Hat) 	/* Always save the function, and reset at unregistering */
422e3eea140SSteven Rostedt (Red Hat) 	ops->saved_func = ops->func;
423e3eea140SSteven Rostedt (Red Hat) 
424345ddcc8SSteven Rostedt (Red Hat) 	if (ftrace_pids_enabled(ops))
425e3eea140SSteven Rostedt (Red Hat) 		ops->func = ftrace_pid_func;
426e3eea140SSteven Rostedt (Red Hat) 
427f3bea491SSteven Rostedt (Red Hat) 	ftrace_update_trampoline(ops);
428f3bea491SSteven Rostedt (Red Hat) 
429491d0dcfSSteven Rostedt 	if (ftrace_enabled)
430491d0dcfSSteven Rostedt 		update_ftrace_function();
4313d083395SSteven Rostedt 
43216444a8aSArnaldo Carvalho de Melo 	return 0;
43316444a8aSArnaldo Carvalho de Melo }
43416444a8aSArnaldo Carvalho de Melo 
435e309b41dSIngo Molnar static int __unregister_ftrace_function(struct ftrace_ops *ops)
43616444a8aSArnaldo Carvalho de Melo {
4372b499381SSteven Rostedt 	int ret;
43816444a8aSArnaldo Carvalho de Melo 
439b848914cSSteven Rostedt 	if (WARN_ON(!(ops->flags & FTRACE_OPS_FL_ENABLED)))
440b848914cSSteven Rostedt 		return -EBUSY;
441b848914cSSteven Rostedt 
442b848914cSSteven Rostedt 	ret = remove_ftrace_ops(&ftrace_ops_list, ops);
443b848914cSSteven Rostedt 
4442b499381SSteven Rostedt 	if (ret < 0)
4452b499381SSteven Rostedt 		return ret;
446b848914cSSteven Rostedt 
447491d0dcfSSteven Rostedt 	if (ftrace_enabled)
448491d0dcfSSteven Rostedt 		update_ftrace_function();
44916444a8aSArnaldo Carvalho de Melo 
450e3eea140SSteven Rostedt (Red Hat) 	ops->func = ops->saved_func;
451e3eea140SSteven Rostedt (Red Hat) 
452e6ea44e9SSteven Rostedt 	return 0;
4533d083395SSteven Rostedt }
4543d083395SSteven Rostedt 
455df4fc315SSteven Rostedt static void ftrace_update_pid_func(void)
456df4fc315SSteven Rostedt {
457e3eea140SSteven Rostedt (Red Hat) 	struct ftrace_ops *op;
458e3eea140SSteven Rostedt (Red Hat) 
459491d0dcfSSteven Rostedt 	/* Only do something if we are tracing something */
460df4fc315SSteven Rostedt 	if (ftrace_trace_function == ftrace_stub)
46110dd3ebeSKOSAKI Motohiro 		return;
462df4fc315SSteven Rostedt 
463e3eea140SSteven Rostedt (Red Hat) 	do_for_each_ftrace_op(op, ftrace_ops_list) {
464e3eea140SSteven Rostedt (Red Hat) 		if (op->flags & FTRACE_OPS_FL_PID) {
465345ddcc8SSteven Rostedt (Red Hat) 			op->func = ftrace_pids_enabled(op) ?
466345ddcc8SSteven Rostedt (Red Hat) 				ftrace_pid_func : op->saved_func;
467e3eea140SSteven Rostedt (Red Hat) 			ftrace_update_trampoline(op);
468e3eea140SSteven Rostedt (Red Hat) 		}
469e3eea140SSteven Rostedt (Red Hat) 	} while_for_each_ftrace_op(op);
470e3eea140SSteven Rostedt (Red Hat) 
471491d0dcfSSteven Rostedt 	update_ftrace_function();
472df4fc315SSteven Rostedt }
473df4fc315SSteven Rostedt 
474493762fcSSteven Rostedt #ifdef CONFIG_FUNCTION_PROFILER
475493762fcSSteven Rostedt struct ftrace_profile {
476493762fcSSteven Rostedt 	struct hlist_node		node;
477493762fcSSteven Rostedt 	unsigned long			ip;
478493762fcSSteven Rostedt 	unsigned long			counter;
4790706f1c4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
4800706f1c4SSteven Rostedt 	unsigned long long		time;
481e330b3bcSChase Douglas 	unsigned long long		time_squared;
4820706f1c4SSteven Rostedt #endif
483493762fcSSteven Rostedt };
484493762fcSSteven Rostedt 
485493762fcSSteven Rostedt struct ftrace_profile_page {
486493762fcSSteven Rostedt 	struct ftrace_profile_page	*next;
487493762fcSSteven Rostedt 	unsigned long			index;
488493762fcSSteven Rostedt 	struct ftrace_profile		records[];
489493762fcSSteven Rostedt };
490493762fcSSteven Rostedt 
491cafb168aSSteven Rostedt struct ftrace_profile_stat {
492cafb168aSSteven Rostedt 	atomic_t			disabled;
493cafb168aSSteven Rostedt 	struct hlist_head		*hash;
494cafb168aSSteven Rostedt 	struct ftrace_profile_page	*pages;
495cafb168aSSteven Rostedt 	struct ftrace_profile_page	*start;
496cafb168aSSteven Rostedt 	struct tracer_stat		stat;
497cafb168aSSteven Rostedt };
498cafb168aSSteven Rostedt 
499493762fcSSteven Rostedt #define PROFILE_RECORDS_SIZE						\
500493762fcSSteven Rostedt 	(PAGE_SIZE - offsetof(struct ftrace_profile_page, records))
501493762fcSSteven Rostedt 
502493762fcSSteven Rostedt #define PROFILES_PER_PAGE					\
503493762fcSSteven Rostedt 	(PROFILE_RECORDS_SIZE / sizeof(struct ftrace_profile))
504493762fcSSteven Rostedt 
505fb9fb015SSteven Rostedt static int ftrace_profile_enabled __read_mostly;
506fb9fb015SSteven Rostedt 
507fb9fb015SSteven Rostedt /* ftrace_profile_lock - synchronize the enable and disable of the profiler */
508493762fcSSteven Rostedt static DEFINE_MUTEX(ftrace_profile_lock);
509493762fcSSteven Rostedt 
510cafb168aSSteven Rostedt static DEFINE_PER_CPU(struct ftrace_profile_stat, ftrace_profile_stats);
511493762fcSSteven Rostedt 
51220079ebeSNamhyung Kim #define FTRACE_PROFILE_HASH_BITS 10
51320079ebeSNamhyung Kim #define FTRACE_PROFILE_HASH_SIZE (1 << FTRACE_PROFILE_HASH_BITS)
514493762fcSSteven Rostedt 
515493762fcSSteven Rostedt static void *
516493762fcSSteven Rostedt function_stat_next(void *v, int idx)
517493762fcSSteven Rostedt {
518493762fcSSteven Rostedt 	struct ftrace_profile *rec = v;
519493762fcSSteven Rostedt 	struct ftrace_profile_page *pg;
520493762fcSSteven Rostedt 
521493762fcSSteven Rostedt 	pg = (struct ftrace_profile_page *)((unsigned long)rec & PAGE_MASK);
522493762fcSSteven Rostedt 
523493762fcSSteven Rostedt  again:
5240296e425SLi Zefan 	if (idx != 0)
525493762fcSSteven Rostedt 		rec++;
5260296e425SLi Zefan 
527493762fcSSteven Rostedt 	if ((void *)rec >= (void *)&pg->records[pg->index]) {
528493762fcSSteven Rostedt 		pg = pg->next;
529493762fcSSteven Rostedt 		if (!pg)
530493762fcSSteven Rostedt 			return NULL;
531493762fcSSteven Rostedt 		rec = &pg->records[0];
532493762fcSSteven Rostedt 		if (!rec->counter)
533493762fcSSteven Rostedt 			goto again;
534493762fcSSteven Rostedt 	}
535493762fcSSteven Rostedt 
536493762fcSSteven Rostedt 	return rec;
537493762fcSSteven Rostedt }
538493762fcSSteven Rostedt 
539493762fcSSteven Rostedt static void *function_stat_start(struct tracer_stat *trace)
540493762fcSSteven Rostedt {
541cafb168aSSteven Rostedt 	struct ftrace_profile_stat *stat =
542cafb168aSSteven Rostedt 		container_of(trace, struct ftrace_profile_stat, stat);
543cafb168aSSteven Rostedt 
544cafb168aSSteven Rostedt 	if (!stat || !stat->start)
545cafb168aSSteven Rostedt 		return NULL;
546cafb168aSSteven Rostedt 
547cafb168aSSteven Rostedt 	return function_stat_next(&stat->start->records[0], 0);
548493762fcSSteven Rostedt }
549493762fcSSteven Rostedt 
5500706f1c4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
5510706f1c4SSteven Rostedt /* function graph compares on total time */
5520706f1c4SSteven Rostedt static int function_stat_cmp(void *p1, void *p2)
5530706f1c4SSteven Rostedt {
5540706f1c4SSteven Rostedt 	struct ftrace_profile *a = p1;
5550706f1c4SSteven Rostedt 	struct ftrace_profile *b = p2;
5560706f1c4SSteven Rostedt 
5570706f1c4SSteven Rostedt 	if (a->time < b->time)
5580706f1c4SSteven Rostedt 		return -1;
5590706f1c4SSteven Rostedt 	if (a->time > b->time)
5600706f1c4SSteven Rostedt 		return 1;
5610706f1c4SSteven Rostedt 	else
5620706f1c4SSteven Rostedt 		return 0;
5630706f1c4SSteven Rostedt }
5640706f1c4SSteven Rostedt #else
5650706f1c4SSteven Rostedt /* not function graph compares against hits */
566493762fcSSteven Rostedt static int function_stat_cmp(void *p1, void *p2)
567493762fcSSteven Rostedt {
568493762fcSSteven Rostedt 	struct ftrace_profile *a = p1;
569493762fcSSteven Rostedt 	struct ftrace_profile *b = p2;
570493762fcSSteven Rostedt 
571493762fcSSteven Rostedt 	if (a->counter < b->counter)
572493762fcSSteven Rostedt 		return -1;
573493762fcSSteven Rostedt 	if (a->counter > b->counter)
574493762fcSSteven Rostedt 		return 1;
575493762fcSSteven Rostedt 	else
576493762fcSSteven Rostedt 		return 0;
577493762fcSSteven Rostedt }
5780706f1c4SSteven Rostedt #endif
579493762fcSSteven Rostedt 
580493762fcSSteven Rostedt static int function_stat_headers(struct seq_file *m)
581493762fcSSteven Rostedt {
5820706f1c4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
583fa6f0cc7SRasmus Villemoes 	seq_puts(m, "  Function                               "
584e330b3bcSChase Douglas 		 "Hit    Time            Avg             s^2\n"
58534886c8bSSteven Rostedt 		    "  --------                               "
586e330b3bcSChase Douglas 		 "---    ----            ---             ---\n");
5870706f1c4SSteven Rostedt #else
588fa6f0cc7SRasmus Villemoes 	seq_puts(m, "  Function                               Hit\n"
589493762fcSSteven Rostedt 		    "  --------                               ---\n");
5900706f1c4SSteven Rostedt #endif
591493762fcSSteven Rostedt 	return 0;
592493762fcSSteven Rostedt }
593493762fcSSteven Rostedt 
594493762fcSSteven Rostedt static int function_stat_show(struct seq_file *m, void *v)
595493762fcSSteven Rostedt {
596493762fcSSteven Rostedt 	struct ftrace_profile *rec = v;
597493762fcSSteven Rostedt 	char str[KSYM_SYMBOL_LEN];
5983aaba20fSLi Zefan 	int ret = 0;
5990706f1c4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
60034886c8bSSteven Rostedt 	static struct trace_seq s;
60134886c8bSSteven Rostedt 	unsigned long long avg;
602e330b3bcSChase Douglas 	unsigned long long stddev;
6030706f1c4SSteven Rostedt #endif
6043aaba20fSLi Zefan 	mutex_lock(&ftrace_profile_lock);
6053aaba20fSLi Zefan 
6063aaba20fSLi Zefan 	/* we raced with function_profile_reset() */
6073aaba20fSLi Zefan 	if (unlikely(rec->counter == 0)) {
6083aaba20fSLi Zefan 		ret = -EBUSY;
6093aaba20fSLi Zefan 		goto out;
6103aaba20fSLi Zefan 	}
611493762fcSSteven Rostedt 
6128e436ca0SUmesh Tiwari #ifdef CONFIG_FUNCTION_GRAPH_TRACER
6138e436ca0SUmesh Tiwari 	avg = rec->time;
6148e436ca0SUmesh Tiwari 	do_div(avg, rec->counter);
6158e436ca0SUmesh Tiwari 	if (tracing_thresh && (avg < tracing_thresh))
6168e436ca0SUmesh Tiwari 		goto out;
6178e436ca0SUmesh Tiwari #endif
6188e436ca0SUmesh Tiwari 
619493762fcSSteven Rostedt 	kallsyms_lookup(rec->ip, NULL, NULL, NULL, str);
6200706f1c4SSteven Rostedt 	seq_printf(m, "  %-30.30s  %10lu", str, rec->counter);
621493762fcSSteven Rostedt 
6220706f1c4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
623fa6f0cc7SRasmus Villemoes 	seq_puts(m, "    ");
62434886c8bSSteven Rostedt 
625e330b3bcSChase Douglas 	/* Sample standard deviation (s^2) */
626e330b3bcSChase Douglas 	if (rec->counter <= 1)
627e330b3bcSChase Douglas 		stddev = 0;
628e330b3bcSChase Douglas 	else {
62952d85d76SJuri Lelli 		/*
63052d85d76SJuri Lelli 		 * Apply Welford's method:
63152d85d76SJuri Lelli 		 * s^2 = 1 / (n * (n-1)) * (n * \Sum (x_i)^2 - (\Sum x_i)^2)
63252d85d76SJuri Lelli 		 */
63352d85d76SJuri Lelli 		stddev = rec->counter * rec->time_squared -
63452d85d76SJuri Lelli 			 rec->time * rec->time;
63552d85d76SJuri Lelli 
636e330b3bcSChase Douglas 		/*
637e330b3bcSChase Douglas 		 * Divide only 1000 for ns^2 -> us^2 conversion.
638e330b3bcSChase Douglas 		 * trace_print_graph_duration will divide 1000 again.
639e330b3bcSChase Douglas 		 */
64052d85d76SJuri Lelli 		do_div(stddev, rec->counter * (rec->counter - 1) * 1000);
641e330b3bcSChase Douglas 	}
642e330b3bcSChase Douglas 
64334886c8bSSteven Rostedt 	trace_seq_init(&s);
64434886c8bSSteven Rostedt 	trace_print_graph_duration(rec->time, &s);
64534886c8bSSteven Rostedt 	trace_seq_puts(&s, "    ");
64634886c8bSSteven Rostedt 	trace_print_graph_duration(avg, &s);
647e330b3bcSChase Douglas 	trace_seq_puts(&s, "    ");
648e330b3bcSChase Douglas 	trace_print_graph_duration(stddev, &s);
6490706f1c4SSteven Rostedt 	trace_print_seq(m, &s);
6500706f1c4SSteven Rostedt #endif
6510706f1c4SSteven Rostedt 	seq_putc(m, '\n');
6523aaba20fSLi Zefan out:
6533aaba20fSLi Zefan 	mutex_unlock(&ftrace_profile_lock);
6540706f1c4SSteven Rostedt 
6553aaba20fSLi Zefan 	return ret;
656493762fcSSteven Rostedt }
657493762fcSSteven Rostedt 
658cafb168aSSteven Rostedt static void ftrace_profile_reset(struct ftrace_profile_stat *stat)
659493762fcSSteven Rostedt {
660493762fcSSteven Rostedt 	struct ftrace_profile_page *pg;
661493762fcSSteven Rostedt 
662cafb168aSSteven Rostedt 	pg = stat->pages = stat->start;
663493762fcSSteven Rostedt 
664493762fcSSteven Rostedt 	while (pg) {
665493762fcSSteven Rostedt 		memset(pg->records, 0, PROFILE_RECORDS_SIZE);
666493762fcSSteven Rostedt 		pg->index = 0;
667493762fcSSteven Rostedt 		pg = pg->next;
668493762fcSSteven Rostedt 	}
669493762fcSSteven Rostedt 
670cafb168aSSteven Rostedt 	memset(stat->hash, 0,
671493762fcSSteven Rostedt 	       FTRACE_PROFILE_HASH_SIZE * sizeof(struct hlist_head));
672493762fcSSteven Rostedt }
673493762fcSSteven Rostedt 
674cafb168aSSteven Rostedt int ftrace_profile_pages_init(struct ftrace_profile_stat *stat)
675493762fcSSteven Rostedt {
676493762fcSSteven Rostedt 	struct ftrace_profile_page *pg;
677318e0a73SSteven Rostedt 	int functions;
678318e0a73SSteven Rostedt 	int pages;
679493762fcSSteven Rostedt 	int i;
680493762fcSSteven Rostedt 
681493762fcSSteven Rostedt 	/* If we already allocated, do nothing */
682cafb168aSSteven Rostedt 	if (stat->pages)
683493762fcSSteven Rostedt 		return 0;
684493762fcSSteven Rostedt 
685cafb168aSSteven Rostedt 	stat->pages = (void *)get_zeroed_page(GFP_KERNEL);
686cafb168aSSteven Rostedt 	if (!stat->pages)
687493762fcSSteven Rostedt 		return -ENOMEM;
688493762fcSSteven Rostedt 
689318e0a73SSteven Rostedt #ifdef CONFIG_DYNAMIC_FTRACE
690318e0a73SSteven Rostedt 	functions = ftrace_update_tot_cnt;
691318e0a73SSteven Rostedt #else
692318e0a73SSteven Rostedt 	/*
693318e0a73SSteven Rostedt 	 * We do not know the number of functions that exist because
694318e0a73SSteven Rostedt 	 * dynamic tracing is what counts them. With past experience
695318e0a73SSteven Rostedt 	 * we have around 20K functions. That should be more than enough.
696318e0a73SSteven Rostedt 	 * It is highly unlikely we will execute every function in
697318e0a73SSteven Rostedt 	 * the kernel.
698318e0a73SSteven Rostedt 	 */
699318e0a73SSteven Rostedt 	functions = 20000;
700318e0a73SSteven Rostedt #endif
701318e0a73SSteven Rostedt 
702cafb168aSSteven Rostedt 	pg = stat->start = stat->pages;
703493762fcSSteven Rostedt 
704318e0a73SSteven Rostedt 	pages = DIV_ROUND_UP(functions, PROFILES_PER_PAGE);
705318e0a73SSteven Rostedt 
70639e30cd1SNamhyung Kim 	for (i = 1; i < pages; i++) {
707493762fcSSteven Rostedt 		pg->next = (void *)get_zeroed_page(GFP_KERNEL);
708493762fcSSteven Rostedt 		if (!pg->next)
709318e0a73SSteven Rostedt 			goto out_free;
710493762fcSSteven Rostedt 		pg = pg->next;
711493762fcSSteven Rostedt 	}
712493762fcSSteven Rostedt 
713493762fcSSteven Rostedt 	return 0;
714318e0a73SSteven Rostedt 
715318e0a73SSteven Rostedt  out_free:
716318e0a73SSteven Rostedt 	pg = stat->start;
717318e0a73SSteven Rostedt 	while (pg) {
718318e0a73SSteven Rostedt 		unsigned long tmp = (unsigned long)pg;
719318e0a73SSteven Rostedt 
720318e0a73SSteven Rostedt 		pg = pg->next;
721318e0a73SSteven Rostedt 		free_page(tmp);
722318e0a73SSteven Rostedt 	}
723318e0a73SSteven Rostedt 
724318e0a73SSteven Rostedt 	stat->pages = NULL;
725318e0a73SSteven Rostedt 	stat->start = NULL;
726318e0a73SSteven Rostedt 
727318e0a73SSteven Rostedt 	return -ENOMEM;
728493762fcSSteven Rostedt }
729493762fcSSteven Rostedt 
730cafb168aSSteven Rostedt static int ftrace_profile_init_cpu(int cpu)
731493762fcSSteven Rostedt {
732cafb168aSSteven Rostedt 	struct ftrace_profile_stat *stat;
733493762fcSSteven Rostedt 	int size;
734493762fcSSteven Rostedt 
735cafb168aSSteven Rostedt 	stat = &per_cpu(ftrace_profile_stats, cpu);
736cafb168aSSteven Rostedt 
737cafb168aSSteven Rostedt 	if (stat->hash) {
738493762fcSSteven Rostedt 		/* If the profile is already created, simply reset it */
739cafb168aSSteven Rostedt 		ftrace_profile_reset(stat);
740493762fcSSteven Rostedt 		return 0;
741493762fcSSteven Rostedt 	}
742493762fcSSteven Rostedt 
743493762fcSSteven Rostedt 	/*
744493762fcSSteven Rostedt 	 * We are profiling all functions, but usually only a few thousand
745493762fcSSteven Rostedt 	 * functions are hit. We'll make a hash of 1024 items.
746493762fcSSteven Rostedt 	 */
747493762fcSSteven Rostedt 	size = FTRACE_PROFILE_HASH_SIZE;
748493762fcSSteven Rostedt 
749cafb168aSSteven Rostedt 	stat->hash = kzalloc(sizeof(struct hlist_head) * size, GFP_KERNEL);
750493762fcSSteven Rostedt 
751cafb168aSSteven Rostedt 	if (!stat->hash)
752493762fcSSteven Rostedt 		return -ENOMEM;
753493762fcSSteven Rostedt 
754318e0a73SSteven Rostedt 	/* Preallocate the function profiling pages */
755cafb168aSSteven Rostedt 	if (ftrace_profile_pages_init(stat) < 0) {
756cafb168aSSteven Rostedt 		kfree(stat->hash);
757cafb168aSSteven Rostedt 		stat->hash = NULL;
758493762fcSSteven Rostedt 		return -ENOMEM;
759493762fcSSteven Rostedt 	}
760493762fcSSteven Rostedt 
761493762fcSSteven Rostedt 	return 0;
762493762fcSSteven Rostedt }
763493762fcSSteven Rostedt 
764cafb168aSSteven Rostedt static int ftrace_profile_init(void)
765cafb168aSSteven Rostedt {
766cafb168aSSteven Rostedt 	int cpu;
767cafb168aSSteven Rostedt 	int ret = 0;
768cafb168aSSteven Rostedt 
769c4602c1cSMiao Xie 	for_each_possible_cpu(cpu) {
770cafb168aSSteven Rostedt 		ret = ftrace_profile_init_cpu(cpu);
771cafb168aSSteven Rostedt 		if (ret)
772cafb168aSSteven Rostedt 			break;
773cafb168aSSteven Rostedt 	}
774cafb168aSSteven Rostedt 
775cafb168aSSteven Rostedt 	return ret;
776cafb168aSSteven Rostedt }
777cafb168aSSteven Rostedt 
778493762fcSSteven Rostedt /* interrupts must be disabled */
779cafb168aSSteven Rostedt static struct ftrace_profile *
780cafb168aSSteven Rostedt ftrace_find_profiled_func(struct ftrace_profile_stat *stat, unsigned long ip)
781493762fcSSteven Rostedt {
782493762fcSSteven Rostedt 	struct ftrace_profile *rec;
783493762fcSSteven Rostedt 	struct hlist_head *hhd;
784493762fcSSteven Rostedt 	unsigned long key;
785493762fcSSteven Rostedt 
78620079ebeSNamhyung Kim 	key = hash_long(ip, FTRACE_PROFILE_HASH_BITS);
787cafb168aSSteven Rostedt 	hhd = &stat->hash[key];
788493762fcSSteven Rostedt 
789493762fcSSteven Rostedt 	if (hlist_empty(hhd))
790493762fcSSteven Rostedt 		return NULL;
791493762fcSSteven Rostedt 
7921bb539caSSteven Rostedt 	hlist_for_each_entry_rcu_notrace(rec, hhd, node) {
793493762fcSSteven Rostedt 		if (rec->ip == ip)
794493762fcSSteven Rostedt 			return rec;
795493762fcSSteven Rostedt 	}
796493762fcSSteven Rostedt 
797493762fcSSteven Rostedt 	return NULL;
798493762fcSSteven Rostedt }
799493762fcSSteven Rostedt 
800cafb168aSSteven Rostedt static void ftrace_add_profile(struct ftrace_profile_stat *stat,
801cafb168aSSteven Rostedt 			       struct ftrace_profile *rec)
802493762fcSSteven Rostedt {
803493762fcSSteven Rostedt 	unsigned long key;
804493762fcSSteven Rostedt 
80520079ebeSNamhyung Kim 	key = hash_long(rec->ip, FTRACE_PROFILE_HASH_BITS);
806cafb168aSSteven Rostedt 	hlist_add_head_rcu(&rec->node, &stat->hash[key]);
807493762fcSSteven Rostedt }
808493762fcSSteven Rostedt 
809318e0a73SSteven Rostedt /*
810318e0a73SSteven Rostedt  * The memory is already allocated, this simply finds a new record to use.
811318e0a73SSteven Rostedt  */
812493762fcSSteven Rostedt static struct ftrace_profile *
813318e0a73SSteven Rostedt ftrace_profile_alloc(struct ftrace_profile_stat *stat, unsigned long ip)
814493762fcSSteven Rostedt {
815493762fcSSteven Rostedt 	struct ftrace_profile *rec = NULL;
816493762fcSSteven Rostedt 
817318e0a73SSteven Rostedt 	/* prevent recursion (from NMIs) */
818cafb168aSSteven Rostedt 	if (atomic_inc_return(&stat->disabled) != 1)
819493762fcSSteven Rostedt 		goto out;
820493762fcSSteven Rostedt 
821493762fcSSteven Rostedt 	/*
822318e0a73SSteven Rostedt 	 * Try to find the function again since an NMI
823318e0a73SSteven Rostedt 	 * could have added it
824493762fcSSteven Rostedt 	 */
825cafb168aSSteven Rostedt 	rec = ftrace_find_profiled_func(stat, ip);
826493762fcSSteven Rostedt 	if (rec)
827cafb168aSSteven Rostedt 		goto out;
828493762fcSSteven Rostedt 
829cafb168aSSteven Rostedt 	if (stat->pages->index == PROFILES_PER_PAGE) {
830cafb168aSSteven Rostedt 		if (!stat->pages->next)
831cafb168aSSteven Rostedt 			goto out;
832cafb168aSSteven Rostedt 		stat->pages = stat->pages->next;
833493762fcSSteven Rostedt 	}
834493762fcSSteven Rostedt 
835cafb168aSSteven Rostedt 	rec = &stat->pages->records[stat->pages->index++];
836493762fcSSteven Rostedt 	rec->ip = ip;
837cafb168aSSteven Rostedt 	ftrace_add_profile(stat, rec);
838493762fcSSteven Rostedt 
839493762fcSSteven Rostedt  out:
840cafb168aSSteven Rostedt 	atomic_dec(&stat->disabled);
841493762fcSSteven Rostedt 
842493762fcSSteven Rostedt 	return rec;
843493762fcSSteven Rostedt }
844493762fcSSteven Rostedt 
845493762fcSSteven Rostedt static void
8462f5f6ad9SSteven Rostedt function_profile_call(unsigned long ip, unsigned long parent_ip,
847a1e2e31dSSteven Rostedt 		      struct ftrace_ops *ops, struct pt_regs *regs)
848493762fcSSteven Rostedt {
849cafb168aSSteven Rostedt 	struct ftrace_profile_stat *stat;
850493762fcSSteven Rostedt 	struct ftrace_profile *rec;
851493762fcSSteven Rostedt 	unsigned long flags;
852493762fcSSteven Rostedt 
853493762fcSSteven Rostedt 	if (!ftrace_profile_enabled)
854493762fcSSteven Rostedt 		return;
855493762fcSSteven Rostedt 
856493762fcSSteven Rostedt 	local_irq_save(flags);
857cafb168aSSteven Rostedt 
858bdffd893SChristoph Lameter 	stat = this_cpu_ptr(&ftrace_profile_stats);
8590f6ce3deSSteven Rostedt 	if (!stat->hash || !ftrace_profile_enabled)
860cafb168aSSteven Rostedt 		goto out;
861cafb168aSSteven Rostedt 
862cafb168aSSteven Rostedt 	rec = ftrace_find_profiled_func(stat, ip);
863493762fcSSteven Rostedt 	if (!rec) {
864318e0a73SSteven Rostedt 		rec = ftrace_profile_alloc(stat, ip);
865493762fcSSteven Rostedt 		if (!rec)
866493762fcSSteven Rostedt 			goto out;
867493762fcSSteven Rostedt 	}
868493762fcSSteven Rostedt 
869493762fcSSteven Rostedt 	rec->counter++;
870493762fcSSteven Rostedt  out:
871493762fcSSteven Rostedt 	local_irq_restore(flags);
872493762fcSSteven Rostedt }
873493762fcSSteven Rostedt 
8740706f1c4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
8750706f1c4SSteven Rostedt static int profile_graph_entry(struct ftrace_graph_ent *trace)
8760706f1c4SSteven Rostedt {
8778861dd30SNamhyung Kim 	int index = trace->depth;
8788861dd30SNamhyung Kim 
879a1e2e31dSSteven Rostedt 	function_profile_call(trace->func, 0, NULL, NULL);
8808861dd30SNamhyung Kim 
8818861dd30SNamhyung Kim 	if (index >= 0 && index < FTRACE_RETFUNC_DEPTH)
8828861dd30SNamhyung Kim 		current->ret_stack[index].subtime = 0;
8838861dd30SNamhyung Kim 
8840706f1c4SSteven Rostedt 	return 1;
8850706f1c4SSteven Rostedt }
8860706f1c4SSteven Rostedt 
8870706f1c4SSteven Rostedt static void profile_graph_return(struct ftrace_graph_ret *trace)
8880706f1c4SSteven Rostedt {
889cafb168aSSteven Rostedt 	struct ftrace_profile_stat *stat;
890a2a16d6aSSteven Rostedt 	unsigned long long calltime;
8910706f1c4SSteven Rostedt 	struct ftrace_profile *rec;
892cafb168aSSteven Rostedt 	unsigned long flags;
8930706f1c4SSteven Rostedt 
8940706f1c4SSteven Rostedt 	local_irq_save(flags);
895bdffd893SChristoph Lameter 	stat = this_cpu_ptr(&ftrace_profile_stats);
8960f6ce3deSSteven Rostedt 	if (!stat->hash || !ftrace_profile_enabled)
897cafb168aSSteven Rostedt 		goto out;
898cafb168aSSteven Rostedt 
89937e44bc5SSteven Rostedt 	/* If the calltime was zero'd ignore it */
90037e44bc5SSteven Rostedt 	if (!trace->calltime)
90137e44bc5SSteven Rostedt 		goto out;
90237e44bc5SSteven Rostedt 
903a2a16d6aSSteven Rostedt 	calltime = trace->rettime - trace->calltime;
904a2a16d6aSSteven Rostedt 
90555577204SSteven Rostedt (Red Hat) 	if (!fgraph_graph_time) {
906a2a16d6aSSteven Rostedt 		int index;
907a2a16d6aSSteven Rostedt 
908a2a16d6aSSteven Rostedt 		index = trace->depth;
909a2a16d6aSSteven Rostedt 
910a2a16d6aSSteven Rostedt 		/* Append this call time to the parent time to subtract */
911a2a16d6aSSteven Rostedt 		if (index)
912a2a16d6aSSteven Rostedt 			current->ret_stack[index - 1].subtime += calltime;
913a2a16d6aSSteven Rostedt 
914a2a16d6aSSteven Rostedt 		if (current->ret_stack[index].subtime < calltime)
915a2a16d6aSSteven Rostedt 			calltime -= current->ret_stack[index].subtime;
916a2a16d6aSSteven Rostedt 		else
917a2a16d6aSSteven Rostedt 			calltime = 0;
918a2a16d6aSSteven Rostedt 	}
919a2a16d6aSSteven Rostedt 
920cafb168aSSteven Rostedt 	rec = ftrace_find_profiled_func(stat, trace->func);
921e330b3bcSChase Douglas 	if (rec) {
922a2a16d6aSSteven Rostedt 		rec->time += calltime;
923e330b3bcSChase Douglas 		rec->time_squared += calltime * calltime;
924e330b3bcSChase Douglas 	}
925a2a16d6aSSteven Rostedt 
926cafb168aSSteven Rostedt  out:
9270706f1c4SSteven Rostedt 	local_irq_restore(flags);
9280706f1c4SSteven Rostedt }
9290706f1c4SSteven Rostedt 
9300706f1c4SSteven Rostedt static int register_ftrace_profiler(void)
9310706f1c4SSteven Rostedt {
9320706f1c4SSteven Rostedt 	return register_ftrace_graph(&profile_graph_return,
9330706f1c4SSteven Rostedt 				     &profile_graph_entry);
9340706f1c4SSteven Rostedt }
9350706f1c4SSteven Rostedt 
9360706f1c4SSteven Rostedt static void unregister_ftrace_profiler(void)
9370706f1c4SSteven Rostedt {
9380706f1c4SSteven Rostedt 	unregister_ftrace_graph();
9390706f1c4SSteven Rostedt }
9400706f1c4SSteven Rostedt #else
941bd38c0e6SPaul McQuade static struct ftrace_ops ftrace_profile_ops __read_mostly = {
942493762fcSSteven Rostedt 	.func		= function_profile_call,
943f04f24fbSMasami Hiramatsu 	.flags		= FTRACE_OPS_FL_RECURSION_SAFE | FTRACE_OPS_FL_INITIALIZED,
94433b7f99cSSteven Rostedt (Red Hat) 	INIT_OPS_HASH(ftrace_profile_ops)
945493762fcSSteven Rostedt };
946493762fcSSteven Rostedt 
9470706f1c4SSteven Rostedt static int register_ftrace_profiler(void)
9480706f1c4SSteven Rostedt {
9490706f1c4SSteven Rostedt 	return register_ftrace_function(&ftrace_profile_ops);
9500706f1c4SSteven Rostedt }
9510706f1c4SSteven Rostedt 
9520706f1c4SSteven Rostedt static void unregister_ftrace_profiler(void)
9530706f1c4SSteven Rostedt {
9540706f1c4SSteven Rostedt 	unregister_ftrace_function(&ftrace_profile_ops);
9550706f1c4SSteven Rostedt }
9560706f1c4SSteven Rostedt #endif /* CONFIG_FUNCTION_GRAPH_TRACER */
9570706f1c4SSteven Rostedt 
958493762fcSSteven Rostedt static ssize_t
959493762fcSSteven Rostedt ftrace_profile_write(struct file *filp, const char __user *ubuf,
960493762fcSSteven Rostedt 		     size_t cnt, loff_t *ppos)
961493762fcSSteven Rostedt {
962493762fcSSteven Rostedt 	unsigned long val;
963493762fcSSteven Rostedt 	int ret;
964493762fcSSteven Rostedt 
96522fe9b54SPeter Huewe 	ret = kstrtoul_from_user(ubuf, cnt, 10, &val);
96622fe9b54SPeter Huewe 	if (ret)
967493762fcSSteven Rostedt 		return ret;
968493762fcSSteven Rostedt 
969493762fcSSteven Rostedt 	val = !!val;
970493762fcSSteven Rostedt 
971493762fcSSteven Rostedt 	mutex_lock(&ftrace_profile_lock);
972493762fcSSteven Rostedt 	if (ftrace_profile_enabled ^ val) {
973493762fcSSteven Rostedt 		if (val) {
974493762fcSSteven Rostedt 			ret = ftrace_profile_init();
975493762fcSSteven Rostedt 			if (ret < 0) {
976493762fcSSteven Rostedt 				cnt = ret;
977493762fcSSteven Rostedt 				goto out;
978493762fcSSteven Rostedt 			}
979493762fcSSteven Rostedt 
9800706f1c4SSteven Rostedt 			ret = register_ftrace_profiler();
9810706f1c4SSteven Rostedt 			if (ret < 0) {
9820706f1c4SSteven Rostedt 				cnt = ret;
9830706f1c4SSteven Rostedt 				goto out;
9840706f1c4SSteven Rostedt 			}
985493762fcSSteven Rostedt 			ftrace_profile_enabled = 1;
986493762fcSSteven Rostedt 		} else {
987493762fcSSteven Rostedt 			ftrace_profile_enabled = 0;
9880f6ce3deSSteven Rostedt 			/*
9890f6ce3deSSteven Rostedt 			 * unregister_ftrace_profiler calls stop_machine
9900f6ce3deSSteven Rostedt 			 * so this acts like an synchronize_sched.
9910f6ce3deSSteven Rostedt 			 */
9920706f1c4SSteven Rostedt 			unregister_ftrace_profiler();
993493762fcSSteven Rostedt 		}
994493762fcSSteven Rostedt 	}
995493762fcSSteven Rostedt  out:
996493762fcSSteven Rostedt 	mutex_unlock(&ftrace_profile_lock);
997493762fcSSteven Rostedt 
998cf8517cfSJiri Olsa 	*ppos += cnt;
999493762fcSSteven Rostedt 
1000493762fcSSteven Rostedt 	return cnt;
1001493762fcSSteven Rostedt }
1002493762fcSSteven Rostedt 
1003493762fcSSteven Rostedt static ssize_t
1004493762fcSSteven Rostedt ftrace_profile_read(struct file *filp, char __user *ubuf,
1005493762fcSSteven Rostedt 		     size_t cnt, loff_t *ppos)
1006493762fcSSteven Rostedt {
1007fb9fb015SSteven Rostedt 	char buf[64];		/* big enough to hold a number */
1008493762fcSSteven Rostedt 	int r;
1009493762fcSSteven Rostedt 
1010493762fcSSteven Rostedt 	r = sprintf(buf, "%u\n", ftrace_profile_enabled);
1011493762fcSSteven Rostedt 	return simple_read_from_buffer(ubuf, cnt, ppos, buf, r);
1012493762fcSSteven Rostedt }
1013493762fcSSteven Rostedt 
1014493762fcSSteven Rostedt static const struct file_operations ftrace_profile_fops = {
1015493762fcSSteven Rostedt 	.open		= tracing_open_generic,
1016493762fcSSteven Rostedt 	.read		= ftrace_profile_read,
1017493762fcSSteven Rostedt 	.write		= ftrace_profile_write,
10186038f373SArnd Bergmann 	.llseek		= default_llseek,
1019493762fcSSteven Rostedt };
1020493762fcSSteven Rostedt 
1021cafb168aSSteven Rostedt /* used to initialize the real stat files */
1022cafb168aSSteven Rostedt static struct tracer_stat function_stats __initdata = {
1023cafb168aSSteven Rostedt 	.name		= "functions",
1024cafb168aSSteven Rostedt 	.stat_start	= function_stat_start,
1025cafb168aSSteven Rostedt 	.stat_next	= function_stat_next,
1026cafb168aSSteven Rostedt 	.stat_cmp	= function_stat_cmp,
1027cafb168aSSteven Rostedt 	.stat_headers	= function_stat_headers,
1028cafb168aSSteven Rostedt 	.stat_show	= function_stat_show
1029cafb168aSSteven Rostedt };
1030cafb168aSSteven Rostedt 
10318434dc93SSteven Rostedt (Red Hat) static __init void ftrace_profile_tracefs(struct dentry *d_tracer)
1032493762fcSSteven Rostedt {
1033cafb168aSSteven Rostedt 	struct ftrace_profile_stat *stat;
1034493762fcSSteven Rostedt 	struct dentry *entry;
1035cafb168aSSteven Rostedt 	char *name;
1036493762fcSSteven Rostedt 	int ret;
1037cafb168aSSteven Rostedt 	int cpu;
1038493762fcSSteven Rostedt 
1039cafb168aSSteven Rostedt 	for_each_possible_cpu(cpu) {
1040cafb168aSSteven Rostedt 		stat = &per_cpu(ftrace_profile_stats, cpu);
1041cafb168aSSteven Rostedt 
10426363c6b5SGeliang Tang 		name = kasprintf(GFP_KERNEL, "function%d", cpu);
1043cafb168aSSteven Rostedt 		if (!name) {
1044cafb168aSSteven Rostedt 			/*
1045cafb168aSSteven Rostedt 			 * The files created are permanent, if something happens
1046cafb168aSSteven Rostedt 			 * we still do not free memory.
1047cafb168aSSteven Rostedt 			 */
1048cafb168aSSteven Rostedt 			WARN(1,
1049cafb168aSSteven Rostedt 			     "Could not allocate stat file for cpu %d\n",
1050cafb168aSSteven Rostedt 			     cpu);
1051493762fcSSteven Rostedt 			return;
1052493762fcSSteven Rostedt 		}
1053cafb168aSSteven Rostedt 		stat->stat = function_stats;
1054cafb168aSSteven Rostedt 		stat->stat.name = name;
1055cafb168aSSteven Rostedt 		ret = register_stat_tracer(&stat->stat);
1056cafb168aSSteven Rostedt 		if (ret) {
1057cafb168aSSteven Rostedt 			WARN(1,
1058cafb168aSSteven Rostedt 			     "Could not register function stat for cpu %d\n",
1059cafb168aSSteven Rostedt 			     cpu);
1060cafb168aSSteven Rostedt 			kfree(name);
1061cafb168aSSteven Rostedt 			return;
1062cafb168aSSteven Rostedt 		}
1063cafb168aSSteven Rostedt 	}
1064493762fcSSteven Rostedt 
10658434dc93SSteven Rostedt (Red Hat) 	entry = tracefs_create_file("function_profile_enabled", 0644,
1066493762fcSSteven Rostedt 				    d_tracer, NULL, &ftrace_profile_fops);
1067493762fcSSteven Rostedt 	if (!entry)
1068a395d6a7SJoe Perches 		pr_warn("Could not create tracefs 'function_profile_enabled' entry\n");
1069493762fcSSteven Rostedt }
1070493762fcSSteven Rostedt 
1071493762fcSSteven Rostedt #else /* CONFIG_FUNCTION_PROFILER */
10728434dc93SSteven Rostedt (Red Hat) static __init void ftrace_profile_tracefs(struct dentry *d_tracer)
1073493762fcSSteven Rostedt {
1074493762fcSSteven Rostedt }
1075493762fcSSteven Rostedt #endif /* CONFIG_FUNCTION_PROFILER */
1076493762fcSSteven Rostedt 
107773d3fd96SIngo Molnar static struct pid * const ftrace_swapper_pid = &init_struct_pid;
107873d3fd96SIngo Molnar 
10791619dc3fSPratyush Anand #ifdef CONFIG_FUNCTION_GRAPH_TRACER
10801619dc3fSPratyush Anand static int ftrace_graph_active;
10811619dc3fSPratyush Anand #else
10821619dc3fSPratyush Anand # define ftrace_graph_active 0
10831619dc3fSPratyush Anand #endif
10841619dc3fSPratyush Anand 
10853d083395SSteven Rostedt #ifdef CONFIG_DYNAMIC_FTRACE
108673d3fd96SIngo Molnar 
108779922b80SSteven Rostedt (Red Hat) static struct ftrace_ops *removed_ops;
108879922b80SSteven Rostedt (Red Hat) 
1089e1effa01SSteven Rostedt (Red Hat) /*
1090e1effa01SSteven Rostedt (Red Hat)  * Set when doing a global update, like enabling all recs or disabling them.
1091e1effa01SSteven Rostedt (Red Hat)  * It is not set when just updating a single ftrace_ops.
1092e1effa01SSteven Rostedt (Red Hat)  */
1093e1effa01SSteven Rostedt (Red Hat) static bool update_all_ops;
1094e1effa01SSteven Rostedt (Red Hat) 
109599ecdc43SSteven Rostedt #ifndef CONFIG_FTRACE_MCOUNT_RECORD
1096cb7be3b2SSteven Rostedt # error Dynamic ftrace depends on MCOUNT_RECORD
109799ecdc43SSteven Rostedt #endif
109899ecdc43SSteven Rostedt 
1099b448c4e3SSteven Rostedt struct ftrace_func_entry {
1100b448c4e3SSteven Rostedt 	struct hlist_node hlist;
1101b448c4e3SSteven Rostedt 	unsigned long ip;
1102b448c4e3SSteven Rostedt };
1103b448c4e3SSteven Rostedt 
11047b60f3d8SSteven Rostedt (VMware) struct ftrace_func_probe {
11057b60f3d8SSteven Rostedt (VMware) 	struct ftrace_probe_ops	*probe_ops;
11067b60f3d8SSteven Rostedt (VMware) 	struct ftrace_ops	ops;
11077b60f3d8SSteven Rostedt (VMware) 	struct trace_array	*tr;
11087b60f3d8SSteven Rostedt (VMware) 	struct list_head	list;
11096e444319SSteven Rostedt (VMware) 	void			*data;
11107b60f3d8SSteven Rostedt (VMware) 	int			ref;
11117b60f3d8SSteven Rostedt (VMware) };
11127b60f3d8SSteven Rostedt (VMware) 
111333dc9b12SSteven Rostedt /*
111433dc9b12SSteven Rostedt  * We make these constant because no one should touch them,
111533dc9b12SSteven Rostedt  * but they are used as the default "empty hash", to avoid allocating
111633dc9b12SSteven Rostedt  * it all the time. These are in a read only section such that if
111733dc9b12SSteven Rostedt  * anyone does try to modify it, it will cause an exception.
111833dc9b12SSteven Rostedt  */
111933dc9b12SSteven Rostedt static const struct hlist_head empty_buckets[1];
112033dc9b12SSteven Rostedt static const struct ftrace_hash empty_hash = {
112133dc9b12SSteven Rostedt 	.buckets = (struct hlist_head *)empty_buckets,
1122b448c4e3SSteven Rostedt };
112333dc9b12SSteven Rostedt #define EMPTY_HASH	((struct ftrace_hash *)&empty_hash)
11245072c59fSSteven Rostedt 
11252b499381SSteven Rostedt static struct ftrace_ops global_ops = {
1126f45948e8SSteven Rostedt 	.func				= ftrace_stub,
112733b7f99cSSteven Rostedt (Red Hat) 	.local_hash.notrace_hash	= EMPTY_HASH,
112833b7f99cSSteven Rostedt (Red Hat) 	.local_hash.filter_hash		= EMPTY_HASH,
112933b7f99cSSteven Rostedt (Red Hat) 	INIT_OPS_HASH(global_ops)
113033b7f99cSSteven Rostedt (Red Hat) 	.flags				= FTRACE_OPS_FL_RECURSION_SAFE |
1131e3eea140SSteven Rostedt (Red Hat) 					  FTRACE_OPS_FL_INITIALIZED |
1132e3eea140SSteven Rostedt (Red Hat) 					  FTRACE_OPS_FL_PID,
1133f45948e8SSteven Rostedt };
1134f45948e8SSteven Rostedt 
1135aec0be2dSSteven Rostedt (Red Hat) /*
1136aec0be2dSSteven Rostedt (Red Hat)  * This is used by __kernel_text_address() to return true if the
11370af26492SSteven Rostedt (Red Hat)  * address is on a dynamically allocated trampoline that would
1138aec0be2dSSteven Rostedt (Red Hat)  * not return true for either core_kernel_text() or
1139aec0be2dSSteven Rostedt (Red Hat)  * is_module_text_address().
1140aec0be2dSSteven Rostedt (Red Hat)  */
1141aec0be2dSSteven Rostedt (Red Hat) bool is_ftrace_trampoline(unsigned long addr)
1142aec0be2dSSteven Rostedt (Red Hat) {
1143aec0be2dSSteven Rostedt (Red Hat) 	struct ftrace_ops *op;
1144aec0be2dSSteven Rostedt (Red Hat) 	bool ret = false;
1145aec0be2dSSteven Rostedt (Red Hat) 
1146aec0be2dSSteven Rostedt (Red Hat) 	/*
1147aec0be2dSSteven Rostedt (Red Hat) 	 * Some of the ops may be dynamically allocated,
1148aec0be2dSSteven Rostedt (Red Hat) 	 * they are freed after a synchronize_sched().
1149aec0be2dSSteven Rostedt (Red Hat) 	 */
1150aec0be2dSSteven Rostedt (Red Hat) 	preempt_disable_notrace();
1151aec0be2dSSteven Rostedt (Red Hat) 
1152aec0be2dSSteven Rostedt (Red Hat) 	do_for_each_ftrace_op(op, ftrace_ops_list) {
1153aec0be2dSSteven Rostedt (Red Hat) 		/*
1154aec0be2dSSteven Rostedt (Red Hat) 		 * This is to check for dynamically allocated trampolines.
1155aec0be2dSSteven Rostedt (Red Hat) 		 * Trampolines that are in kernel text will have
1156aec0be2dSSteven Rostedt (Red Hat) 		 * core_kernel_text() return true.
1157aec0be2dSSteven Rostedt (Red Hat) 		 */
1158aec0be2dSSteven Rostedt (Red Hat) 		if (op->trampoline && op->trampoline_size)
1159aec0be2dSSteven Rostedt (Red Hat) 			if (addr >= op->trampoline &&
1160aec0be2dSSteven Rostedt (Red Hat) 			    addr < op->trampoline + op->trampoline_size) {
1161aec0be2dSSteven Rostedt (Red Hat) 				ret = true;
1162aec0be2dSSteven Rostedt (Red Hat) 				goto out;
1163aec0be2dSSteven Rostedt (Red Hat) 			}
1164aec0be2dSSteven Rostedt (Red Hat) 	} while_for_each_ftrace_op(op);
1165aec0be2dSSteven Rostedt (Red Hat) 
1166aec0be2dSSteven Rostedt (Red Hat)  out:
1167aec0be2dSSteven Rostedt (Red Hat) 	preempt_enable_notrace();
1168aec0be2dSSteven Rostedt (Red Hat) 
1169aec0be2dSSteven Rostedt (Red Hat) 	return ret;
1170aec0be2dSSteven Rostedt (Red Hat) }
1171aec0be2dSSteven Rostedt (Red Hat) 
11723c1720f0SSteven Rostedt struct ftrace_page {
11733c1720f0SSteven Rostedt 	struct ftrace_page	*next;
1174a7900875SSteven Rostedt 	struct dyn_ftrace	*records;
1175431aa3fbSSteven Rostedt 	int			index;
1176a7900875SSteven Rostedt 	int			size;
1177aa5e5ceaSDavid Miller };
11783c1720f0SSteven Rostedt 
1179a7900875SSteven Rostedt #define ENTRY_SIZE sizeof(struct dyn_ftrace)
1180a7900875SSteven Rostedt #define ENTRIES_PER_PAGE (PAGE_SIZE / ENTRY_SIZE)
11813c1720f0SSteven Rostedt 
11823c1720f0SSteven Rostedt /* estimate from running different kernels */
11833c1720f0SSteven Rostedt #define NR_TO_INIT		10000
11843c1720f0SSteven Rostedt 
11853c1720f0SSteven Rostedt static struct ftrace_page	*ftrace_pages_start;
11863c1720f0SSteven Rostedt static struct ftrace_page	*ftrace_pages;
11873c1720f0SSteven Rostedt 
11882b0cce0eSSteven Rostedt (VMware) static __always_inline unsigned long
11892b0cce0eSSteven Rostedt (VMware) ftrace_hash_key(struct ftrace_hash *hash, unsigned long ip)
11902b0cce0eSSteven Rostedt (VMware) {
11912b0cce0eSSteven Rostedt (VMware) 	if (hash->size_bits > 0)
11922b0cce0eSSteven Rostedt (VMware) 		return hash_long(ip, hash->size_bits);
11932b0cce0eSSteven Rostedt (VMware) 
11942b0cce0eSSteven Rostedt (VMware) 	return 0;
11952b0cce0eSSteven Rostedt (VMware) }
11962b0cce0eSSteven Rostedt (VMware) 
11972b2c279cSSteven Rostedt (VMware) /* Only use this function if ftrace_hash_empty() has already been tested */
11982b2c279cSSteven Rostedt (VMware) static __always_inline struct ftrace_func_entry *
11992b2c279cSSteven Rostedt (VMware) __ftrace_lookup_ip(struct ftrace_hash *hash, unsigned long ip)
1200b448c4e3SSteven Rostedt {
1201b448c4e3SSteven Rostedt 	unsigned long key;
1202b448c4e3SSteven Rostedt 	struct ftrace_func_entry *entry;
1203b448c4e3SSteven Rostedt 	struct hlist_head *hhd;
1204b448c4e3SSteven Rostedt 
12052b0cce0eSSteven Rostedt (VMware) 	key = ftrace_hash_key(hash, ip);
1206b448c4e3SSteven Rostedt 	hhd = &hash->buckets[key];
1207b448c4e3SSteven Rostedt 
12081bb539caSSteven Rostedt 	hlist_for_each_entry_rcu_notrace(entry, hhd, hlist) {
1209b448c4e3SSteven Rostedt 		if (entry->ip == ip)
1210b448c4e3SSteven Rostedt 			return entry;
1211b448c4e3SSteven Rostedt 	}
1212b448c4e3SSteven Rostedt 	return NULL;
1213b448c4e3SSteven Rostedt }
1214b448c4e3SSteven Rostedt 
12152b2c279cSSteven Rostedt (VMware) /**
12162b2c279cSSteven Rostedt (VMware)  * ftrace_lookup_ip - Test to see if an ip exists in an ftrace_hash
12172b2c279cSSteven Rostedt (VMware)  * @hash: The hash to look at
12182b2c279cSSteven Rostedt (VMware)  * @ip: The instruction pointer to test
12192b2c279cSSteven Rostedt (VMware)  *
12202b2c279cSSteven Rostedt (VMware)  * Search a given @hash to see if a given instruction pointer (@ip)
12212b2c279cSSteven Rostedt (VMware)  * exists in it.
12222b2c279cSSteven Rostedt (VMware)  *
12232b2c279cSSteven Rostedt (VMware)  * Returns the entry that holds the @ip if found. NULL otherwise.
12242b2c279cSSteven Rostedt (VMware)  */
12252b2c279cSSteven Rostedt (VMware) struct ftrace_func_entry *
12262b2c279cSSteven Rostedt (VMware) ftrace_lookup_ip(struct ftrace_hash *hash, unsigned long ip)
12272b2c279cSSteven Rostedt (VMware) {
12282b2c279cSSteven Rostedt (VMware) 	if (ftrace_hash_empty(hash))
12292b2c279cSSteven Rostedt (VMware) 		return NULL;
12302b2c279cSSteven Rostedt (VMware) 
12312b2c279cSSteven Rostedt (VMware) 	return __ftrace_lookup_ip(hash, ip);
12322b2c279cSSteven Rostedt (VMware) }
12332b2c279cSSteven Rostedt (VMware) 
123433dc9b12SSteven Rostedt static void __add_hash_entry(struct ftrace_hash *hash,
123533dc9b12SSteven Rostedt 			     struct ftrace_func_entry *entry)
123633dc9b12SSteven Rostedt {
123733dc9b12SSteven Rostedt 	struct hlist_head *hhd;
123833dc9b12SSteven Rostedt 	unsigned long key;
123933dc9b12SSteven Rostedt 
12402b0cce0eSSteven Rostedt (VMware) 	key = ftrace_hash_key(hash, entry->ip);
124133dc9b12SSteven Rostedt 	hhd = &hash->buckets[key];
124233dc9b12SSteven Rostedt 	hlist_add_head(&entry->hlist, hhd);
124333dc9b12SSteven Rostedt 	hash->count++;
124433dc9b12SSteven Rostedt }
124533dc9b12SSteven Rostedt 
1246b448c4e3SSteven Rostedt static int add_hash_entry(struct ftrace_hash *hash, unsigned long ip)
1247b448c4e3SSteven Rostedt {
1248b448c4e3SSteven Rostedt 	struct ftrace_func_entry *entry;
1249b448c4e3SSteven Rostedt 
1250b448c4e3SSteven Rostedt 	entry = kmalloc(sizeof(*entry), GFP_KERNEL);
1251b448c4e3SSteven Rostedt 	if (!entry)
1252b448c4e3SSteven Rostedt 		return -ENOMEM;
1253b448c4e3SSteven Rostedt 
1254b448c4e3SSteven Rostedt 	entry->ip = ip;
125533dc9b12SSteven Rostedt 	__add_hash_entry(hash, entry);
1256b448c4e3SSteven Rostedt 
1257b448c4e3SSteven Rostedt 	return 0;
1258b448c4e3SSteven Rostedt }
1259b448c4e3SSteven Rostedt 
1260b448c4e3SSteven Rostedt static void
126133dc9b12SSteven Rostedt free_hash_entry(struct ftrace_hash *hash,
126233dc9b12SSteven Rostedt 		  struct ftrace_func_entry *entry)
126333dc9b12SSteven Rostedt {
126433dc9b12SSteven Rostedt 	hlist_del(&entry->hlist);
126533dc9b12SSteven Rostedt 	kfree(entry);
126633dc9b12SSteven Rostedt 	hash->count--;
126733dc9b12SSteven Rostedt }
126833dc9b12SSteven Rostedt 
126933dc9b12SSteven Rostedt static void
1270b448c4e3SSteven Rostedt remove_hash_entry(struct ftrace_hash *hash,
1271b448c4e3SSteven Rostedt 		  struct ftrace_func_entry *entry)
1272b448c4e3SSteven Rostedt {
1273eee8ded1SSteven Rostedt (VMware) 	hlist_del_rcu(&entry->hlist);
1274b448c4e3SSteven Rostedt 	hash->count--;
1275b448c4e3SSteven Rostedt }
1276b448c4e3SSteven Rostedt 
1277b448c4e3SSteven Rostedt static void ftrace_hash_clear(struct ftrace_hash *hash)
1278b448c4e3SSteven Rostedt {
1279b448c4e3SSteven Rostedt 	struct hlist_head *hhd;
1280b67bfe0dSSasha Levin 	struct hlist_node *tn;
1281b448c4e3SSteven Rostedt 	struct ftrace_func_entry *entry;
1282b448c4e3SSteven Rostedt 	int size = 1 << hash->size_bits;
1283b448c4e3SSteven Rostedt 	int i;
1284b448c4e3SSteven Rostedt 
128533dc9b12SSteven Rostedt 	if (!hash->count)
128633dc9b12SSteven Rostedt 		return;
128733dc9b12SSteven Rostedt 
1288b448c4e3SSteven Rostedt 	for (i = 0; i < size; i++) {
1289b448c4e3SSteven Rostedt 		hhd = &hash->buckets[i];
1290b67bfe0dSSasha Levin 		hlist_for_each_entry_safe(entry, tn, hhd, hlist)
129133dc9b12SSteven Rostedt 			free_hash_entry(hash, entry);
1292b448c4e3SSteven Rostedt 	}
1293b448c4e3SSteven Rostedt 	FTRACE_WARN_ON(hash->count);
1294b448c4e3SSteven Rostedt }
1295b448c4e3SSteven Rostedt 
1296673feb9dSSteven Rostedt (VMware) static void free_ftrace_mod(struct ftrace_mod_load *ftrace_mod)
1297673feb9dSSteven Rostedt (VMware) {
1298673feb9dSSteven Rostedt (VMware) 	list_del(&ftrace_mod->list);
1299673feb9dSSteven Rostedt (VMware) 	kfree(ftrace_mod->module);
1300673feb9dSSteven Rostedt (VMware) 	kfree(ftrace_mod->func);
1301673feb9dSSteven Rostedt (VMware) 	kfree(ftrace_mod);
1302673feb9dSSteven Rostedt (VMware) }
1303673feb9dSSteven Rostedt (VMware) 
1304673feb9dSSteven Rostedt (VMware) static void clear_ftrace_mod_list(struct list_head *head)
1305673feb9dSSteven Rostedt (VMware) {
1306673feb9dSSteven Rostedt (VMware) 	struct ftrace_mod_load *p, *n;
1307673feb9dSSteven Rostedt (VMware) 
1308673feb9dSSteven Rostedt (VMware) 	/* stack tracer isn't supported yet */
1309673feb9dSSteven Rostedt (VMware) 	if (!head)
1310673feb9dSSteven Rostedt (VMware) 		return;
1311673feb9dSSteven Rostedt (VMware) 
1312673feb9dSSteven Rostedt (VMware) 	mutex_lock(&ftrace_lock);
1313673feb9dSSteven Rostedt (VMware) 	list_for_each_entry_safe(p, n, head, list)
1314673feb9dSSteven Rostedt (VMware) 		free_ftrace_mod(p);
1315673feb9dSSteven Rostedt (VMware) 	mutex_unlock(&ftrace_lock);
1316673feb9dSSteven Rostedt (VMware) }
1317673feb9dSSteven Rostedt (VMware) 
131833dc9b12SSteven Rostedt static void free_ftrace_hash(struct ftrace_hash *hash)
131933dc9b12SSteven Rostedt {
132033dc9b12SSteven Rostedt 	if (!hash || hash == EMPTY_HASH)
132133dc9b12SSteven Rostedt 		return;
132233dc9b12SSteven Rostedt 	ftrace_hash_clear(hash);
132333dc9b12SSteven Rostedt 	kfree(hash->buckets);
132433dc9b12SSteven Rostedt 	kfree(hash);
132533dc9b12SSteven Rostedt }
132633dc9b12SSteven Rostedt 
132707fd5515SSteven Rostedt static void __free_ftrace_hash_rcu(struct rcu_head *rcu)
132807fd5515SSteven Rostedt {
132907fd5515SSteven Rostedt 	struct ftrace_hash *hash;
133007fd5515SSteven Rostedt 
133107fd5515SSteven Rostedt 	hash = container_of(rcu, struct ftrace_hash, rcu);
133207fd5515SSteven Rostedt 	free_ftrace_hash(hash);
133307fd5515SSteven Rostedt }
133407fd5515SSteven Rostedt 
133507fd5515SSteven Rostedt static void free_ftrace_hash_rcu(struct ftrace_hash *hash)
133607fd5515SSteven Rostedt {
133707fd5515SSteven Rostedt 	if (!hash || hash == EMPTY_HASH)
133807fd5515SSteven Rostedt 		return;
133907fd5515SSteven Rostedt 	call_rcu_sched(&hash->rcu, __free_ftrace_hash_rcu);
134007fd5515SSteven Rostedt }
134107fd5515SSteven Rostedt 
13425500fa51SJiri Olsa void ftrace_free_filter(struct ftrace_ops *ops)
13435500fa51SJiri Olsa {
1344f04f24fbSMasami Hiramatsu 	ftrace_ops_init(ops);
134533b7f99cSSteven Rostedt (Red Hat) 	free_ftrace_hash(ops->func_hash->filter_hash);
134633b7f99cSSteven Rostedt (Red Hat) 	free_ftrace_hash(ops->func_hash->notrace_hash);
13475500fa51SJiri Olsa }
13485500fa51SJiri Olsa 
134933dc9b12SSteven Rostedt static struct ftrace_hash *alloc_ftrace_hash(int size_bits)
135033dc9b12SSteven Rostedt {
135133dc9b12SSteven Rostedt 	struct ftrace_hash *hash;
135233dc9b12SSteven Rostedt 	int size;
135333dc9b12SSteven Rostedt 
135433dc9b12SSteven Rostedt 	hash = kzalloc(sizeof(*hash), GFP_KERNEL);
135533dc9b12SSteven Rostedt 	if (!hash)
135633dc9b12SSteven Rostedt 		return NULL;
135733dc9b12SSteven Rostedt 
135833dc9b12SSteven Rostedt 	size = 1 << size_bits;
135947b0edcbSThomas Meyer 	hash->buckets = kcalloc(size, sizeof(*hash->buckets), GFP_KERNEL);
136033dc9b12SSteven Rostedt 
136133dc9b12SSteven Rostedt 	if (!hash->buckets) {
136233dc9b12SSteven Rostedt 		kfree(hash);
136333dc9b12SSteven Rostedt 		return NULL;
136433dc9b12SSteven Rostedt 	}
136533dc9b12SSteven Rostedt 
136633dc9b12SSteven Rostedt 	hash->size_bits = size_bits;
136733dc9b12SSteven Rostedt 
136833dc9b12SSteven Rostedt 	return hash;
136933dc9b12SSteven Rostedt }
137033dc9b12SSteven Rostedt 
1371673feb9dSSteven Rostedt (VMware) 
1372673feb9dSSteven Rostedt (VMware) static int ftrace_add_mod(struct trace_array *tr,
1373673feb9dSSteven Rostedt (VMware) 			  const char *func, const char *module,
1374673feb9dSSteven Rostedt (VMware) 			  int enable)
1375673feb9dSSteven Rostedt (VMware) {
1376673feb9dSSteven Rostedt (VMware) 	struct ftrace_mod_load *ftrace_mod;
1377673feb9dSSteven Rostedt (VMware) 	struct list_head *mod_head = enable ? &tr->mod_trace : &tr->mod_notrace;
1378673feb9dSSteven Rostedt (VMware) 
1379673feb9dSSteven Rostedt (VMware) 	ftrace_mod = kzalloc(sizeof(*ftrace_mod), GFP_KERNEL);
1380673feb9dSSteven Rostedt (VMware) 	if (!ftrace_mod)
1381673feb9dSSteven Rostedt (VMware) 		return -ENOMEM;
1382673feb9dSSteven Rostedt (VMware) 
1383673feb9dSSteven Rostedt (VMware) 	ftrace_mod->func = kstrdup(func, GFP_KERNEL);
1384673feb9dSSteven Rostedt (VMware) 	ftrace_mod->module = kstrdup(module, GFP_KERNEL);
1385673feb9dSSteven Rostedt (VMware) 	ftrace_mod->enable = enable;
1386673feb9dSSteven Rostedt (VMware) 
1387673feb9dSSteven Rostedt (VMware) 	if (!ftrace_mod->func || !ftrace_mod->module)
1388673feb9dSSteven Rostedt (VMware) 		goto out_free;
1389673feb9dSSteven Rostedt (VMware) 
1390673feb9dSSteven Rostedt (VMware) 	list_add(&ftrace_mod->list, mod_head);
1391673feb9dSSteven Rostedt (VMware) 
1392673feb9dSSteven Rostedt (VMware) 	return 0;
1393673feb9dSSteven Rostedt (VMware) 
1394673feb9dSSteven Rostedt (VMware)  out_free:
1395673feb9dSSteven Rostedt (VMware) 	free_ftrace_mod(ftrace_mod);
1396673feb9dSSteven Rostedt (VMware) 
1397673feb9dSSteven Rostedt (VMware) 	return -ENOMEM;
1398673feb9dSSteven Rostedt (VMware) }
1399673feb9dSSteven Rostedt (VMware) 
140033dc9b12SSteven Rostedt static struct ftrace_hash *
140133dc9b12SSteven Rostedt alloc_and_copy_ftrace_hash(int size_bits, struct ftrace_hash *hash)
140233dc9b12SSteven Rostedt {
140333dc9b12SSteven Rostedt 	struct ftrace_func_entry *entry;
140433dc9b12SSteven Rostedt 	struct ftrace_hash *new_hash;
140533dc9b12SSteven Rostedt 	int size;
140633dc9b12SSteven Rostedt 	int ret;
140733dc9b12SSteven Rostedt 	int i;
140833dc9b12SSteven Rostedt 
140933dc9b12SSteven Rostedt 	new_hash = alloc_ftrace_hash(size_bits);
141033dc9b12SSteven Rostedt 	if (!new_hash)
141133dc9b12SSteven Rostedt 		return NULL;
141233dc9b12SSteven Rostedt 
14138c08f0d5SSteven Rostedt (VMware) 	if (hash)
14148c08f0d5SSteven Rostedt (VMware) 		new_hash->flags = hash->flags;
14158c08f0d5SSteven Rostedt (VMware) 
141633dc9b12SSteven Rostedt 	/* Empty hash? */
141706a51d93SSteven Rostedt 	if (ftrace_hash_empty(hash))
141833dc9b12SSteven Rostedt 		return new_hash;
141933dc9b12SSteven Rostedt 
142033dc9b12SSteven Rostedt 	size = 1 << hash->size_bits;
142133dc9b12SSteven Rostedt 	for (i = 0; i < size; i++) {
1422b67bfe0dSSasha Levin 		hlist_for_each_entry(entry, &hash->buckets[i], hlist) {
142333dc9b12SSteven Rostedt 			ret = add_hash_entry(new_hash, entry->ip);
142433dc9b12SSteven Rostedt 			if (ret < 0)
142533dc9b12SSteven Rostedt 				goto free_hash;
142633dc9b12SSteven Rostedt 		}
142733dc9b12SSteven Rostedt 	}
142833dc9b12SSteven Rostedt 
142933dc9b12SSteven Rostedt 	FTRACE_WARN_ON(new_hash->count != hash->count);
143033dc9b12SSteven Rostedt 
143133dc9b12SSteven Rostedt 	return new_hash;
143233dc9b12SSteven Rostedt 
143333dc9b12SSteven Rostedt  free_hash:
143433dc9b12SSteven Rostedt 	free_ftrace_hash(new_hash);
143533dc9b12SSteven Rostedt 	return NULL;
143633dc9b12SSteven Rostedt }
143733dc9b12SSteven Rostedt 
143841fb61c2SSteven Rostedt static void
143984261912SSteven Rostedt (Red Hat) ftrace_hash_rec_disable_modify(struct ftrace_ops *ops, int filter_hash);
144041fb61c2SSteven Rostedt static void
144184261912SSteven Rostedt (Red Hat) ftrace_hash_rec_enable_modify(struct ftrace_ops *ops, int filter_hash);
144241fb61c2SSteven Rostedt 
1443f8b8be8aSMasami Hiramatsu static int ftrace_hash_ipmodify_update(struct ftrace_ops *ops,
1444f8b8be8aSMasami Hiramatsu 				       struct ftrace_hash *new_hash);
1445f8b8be8aSMasami Hiramatsu 
14463e278c0dSNamhyung Kim static struct ftrace_hash *
14473e278c0dSNamhyung Kim __ftrace_hash_move(struct ftrace_hash *src)
144833dc9b12SSteven Rostedt {
144933dc9b12SSteven Rostedt 	struct ftrace_func_entry *entry;
1450b67bfe0dSSasha Levin 	struct hlist_node *tn;
145133dc9b12SSteven Rostedt 	struct hlist_head *hhd;
145207fd5515SSteven Rostedt 	struct ftrace_hash *new_hash;
145333dc9b12SSteven Rostedt 	int size = src->count;
145433dc9b12SSteven Rostedt 	int bits = 0;
145533dc9b12SSteven Rostedt 	int i;
145633dc9b12SSteven Rostedt 
145733dc9b12SSteven Rostedt 	/*
14583e278c0dSNamhyung Kim 	 * If the new source is empty, just return the empty_hash.
145933dc9b12SSteven Rostedt 	 */
14608c08f0d5SSteven Rostedt (VMware) 	if (ftrace_hash_empty(src))
14613e278c0dSNamhyung Kim 		return EMPTY_HASH;
146233dc9b12SSteven Rostedt 
146333dc9b12SSteven Rostedt 	/*
146433dc9b12SSteven Rostedt 	 * Make the hash size about 1/2 the # found
146533dc9b12SSteven Rostedt 	 */
146633dc9b12SSteven Rostedt 	for (size /= 2; size; size >>= 1)
146733dc9b12SSteven Rostedt 		bits++;
146833dc9b12SSteven Rostedt 
146933dc9b12SSteven Rostedt 	/* Don't allocate too much */
147033dc9b12SSteven Rostedt 	if (bits > FTRACE_HASH_MAX_BITS)
147133dc9b12SSteven Rostedt 		bits = FTRACE_HASH_MAX_BITS;
147233dc9b12SSteven Rostedt 
147307fd5515SSteven Rostedt 	new_hash = alloc_ftrace_hash(bits);
147407fd5515SSteven Rostedt 	if (!new_hash)
14753e278c0dSNamhyung Kim 		return NULL;
147633dc9b12SSteven Rostedt 
14778c08f0d5SSteven Rostedt (VMware) 	new_hash->flags = src->flags;
14788c08f0d5SSteven Rostedt (VMware) 
147933dc9b12SSteven Rostedt 	size = 1 << src->size_bits;
148033dc9b12SSteven Rostedt 	for (i = 0; i < size; i++) {
148133dc9b12SSteven Rostedt 		hhd = &src->buckets[i];
1482b67bfe0dSSasha Levin 		hlist_for_each_entry_safe(entry, tn, hhd, hlist) {
148333dc9b12SSteven Rostedt 			remove_hash_entry(src, entry);
148407fd5515SSteven Rostedt 			__add_hash_entry(new_hash, entry);
148533dc9b12SSteven Rostedt 		}
148633dc9b12SSteven Rostedt 	}
148733dc9b12SSteven Rostedt 
14883e278c0dSNamhyung Kim 	return new_hash;
14893e278c0dSNamhyung Kim }
14903e278c0dSNamhyung Kim 
14913e278c0dSNamhyung Kim static int
14923e278c0dSNamhyung Kim ftrace_hash_move(struct ftrace_ops *ops, int enable,
14933e278c0dSNamhyung Kim 		 struct ftrace_hash **dst, struct ftrace_hash *src)
14943e278c0dSNamhyung Kim {
14953e278c0dSNamhyung Kim 	struct ftrace_hash *new_hash;
14963e278c0dSNamhyung Kim 	int ret;
14973e278c0dSNamhyung Kim 
14983e278c0dSNamhyung Kim 	/* Reject setting notrace hash on IPMODIFY ftrace_ops */
14993e278c0dSNamhyung Kim 	if (ops->flags & FTRACE_OPS_FL_IPMODIFY && !enable)
15003e278c0dSNamhyung Kim 		return -EINVAL;
15013e278c0dSNamhyung Kim 
15023e278c0dSNamhyung Kim 	new_hash = __ftrace_hash_move(src);
15033e278c0dSNamhyung Kim 	if (!new_hash)
15043e278c0dSNamhyung Kim 		return -ENOMEM;
15053e278c0dSNamhyung Kim 
1506f8b8be8aSMasami Hiramatsu 	/* Make sure this can be applied if it is IPMODIFY ftrace_ops */
1507f8b8be8aSMasami Hiramatsu 	if (enable) {
1508f8b8be8aSMasami Hiramatsu 		/* IPMODIFY should be updated only when filter_hash updating */
1509f8b8be8aSMasami Hiramatsu 		ret = ftrace_hash_ipmodify_update(ops, new_hash);
1510f8b8be8aSMasami Hiramatsu 		if (ret < 0) {
1511f8b8be8aSMasami Hiramatsu 			free_ftrace_hash(new_hash);
1512f8b8be8aSMasami Hiramatsu 			return ret;
1513f8b8be8aSMasami Hiramatsu 		}
1514f8b8be8aSMasami Hiramatsu 	}
1515f8b8be8aSMasami Hiramatsu 
15165c27c775SMasami Hiramatsu 	/*
15175c27c775SMasami Hiramatsu 	 * Remove the current set, update the hash and add
15185c27c775SMasami Hiramatsu 	 * them back.
15195c27c775SMasami Hiramatsu 	 */
152084261912SSteven Rostedt (Red Hat) 	ftrace_hash_rec_disable_modify(ops, enable);
15215c27c775SMasami Hiramatsu 
152207fd5515SSteven Rostedt 	rcu_assign_pointer(*dst, new_hash);
152307fd5515SSteven Rostedt 
152484261912SSteven Rostedt (Red Hat) 	ftrace_hash_rec_enable_modify(ops, enable);
152541fb61c2SSteven Rostedt 
15265c27c775SMasami Hiramatsu 	return 0;
152733dc9b12SSteven Rostedt }
152833dc9b12SSteven Rostedt 
1529fef5aeeeSSteven Rostedt (Red Hat) static bool hash_contains_ip(unsigned long ip,
1530fef5aeeeSSteven Rostedt (Red Hat) 			     struct ftrace_ops_hash *hash)
1531fef5aeeeSSteven Rostedt (Red Hat) {
1532fef5aeeeSSteven Rostedt (Red Hat) 	/*
1533fef5aeeeSSteven Rostedt (Red Hat) 	 * The function record is a match if it exists in the filter
1534fef5aeeeSSteven Rostedt (Red Hat) 	 * hash and not in the notrace hash. Note, an emty hash is
1535fef5aeeeSSteven Rostedt (Red Hat) 	 * considered a match for the filter hash, but an empty
1536fef5aeeeSSteven Rostedt (Red Hat) 	 * notrace hash is considered not in the notrace hash.
1537fef5aeeeSSteven Rostedt (Red Hat) 	 */
1538fef5aeeeSSteven Rostedt (Red Hat) 	return (ftrace_hash_empty(hash->filter_hash) ||
15392b2c279cSSteven Rostedt (VMware) 		__ftrace_lookup_ip(hash->filter_hash, ip)) &&
1540fef5aeeeSSteven Rostedt (Red Hat) 		(ftrace_hash_empty(hash->notrace_hash) ||
15412b2c279cSSteven Rostedt (VMware) 		 !__ftrace_lookup_ip(hash->notrace_hash, ip));
1542fef5aeeeSSteven Rostedt (Red Hat) }
1543fef5aeeeSSteven Rostedt (Red Hat) 
1544265c831cSSteven Rostedt /*
1545b848914cSSteven Rostedt  * Test the hashes for this ops to see if we want to call
1546b848914cSSteven Rostedt  * the ops->func or not.
1547b848914cSSteven Rostedt  *
1548b848914cSSteven Rostedt  * It's a match if the ip is in the ops->filter_hash or
1549b848914cSSteven Rostedt  * the filter_hash does not exist or is empty,
1550b848914cSSteven Rostedt  *  AND
1551b848914cSSteven Rostedt  * the ip is not in the ops->notrace_hash.
1552cdbe61bfSSteven Rostedt  *
1553cdbe61bfSSteven Rostedt  * This needs to be called with preemption disabled as
1554cdbe61bfSSteven Rostedt  * the hashes are freed with call_rcu_sched().
1555b848914cSSteven Rostedt  */
1556b848914cSSteven Rostedt static int
1557195a8afcSSteven Rostedt (Red Hat) ftrace_ops_test(struct ftrace_ops *ops, unsigned long ip, void *regs)
1558b848914cSSteven Rostedt {
1559fef5aeeeSSteven Rostedt (Red Hat) 	struct ftrace_ops_hash hash;
1560b848914cSSteven Rostedt 	int ret;
1561b848914cSSteven Rostedt 
1562195a8afcSSteven Rostedt (Red Hat) #ifdef CONFIG_DYNAMIC_FTRACE_WITH_REGS
1563195a8afcSSteven Rostedt (Red Hat) 	/*
1564195a8afcSSteven Rostedt (Red Hat) 	 * There's a small race when adding ops that the ftrace handler
1565195a8afcSSteven Rostedt (Red Hat) 	 * that wants regs, may be called without them. We can not
1566195a8afcSSteven Rostedt (Red Hat) 	 * allow that handler to be called if regs is NULL.
1567195a8afcSSteven Rostedt (Red Hat) 	 */
1568195a8afcSSteven Rostedt (Red Hat) 	if (regs == NULL && (ops->flags & FTRACE_OPS_FL_SAVE_REGS))
1569195a8afcSSteven Rostedt (Red Hat) 		return 0;
1570195a8afcSSteven Rostedt (Red Hat) #endif
1571195a8afcSSteven Rostedt (Red Hat) 
1572fef5aeeeSSteven Rostedt (Red Hat) 	hash.filter_hash = rcu_dereference_raw_notrace(ops->func_hash->filter_hash);
1573fef5aeeeSSteven Rostedt (Red Hat) 	hash.notrace_hash = rcu_dereference_raw_notrace(ops->func_hash->notrace_hash);
1574b848914cSSteven Rostedt 
1575fef5aeeeSSteven Rostedt (Red Hat) 	if (hash_contains_ip(ip, &hash))
1576b848914cSSteven Rostedt 		ret = 1;
1577b848914cSSteven Rostedt 	else
1578b848914cSSteven Rostedt 		ret = 0;
1579b848914cSSteven Rostedt 
1580b848914cSSteven Rostedt 	return ret;
1581b848914cSSteven Rostedt }
1582b848914cSSteven Rostedt 
1583b848914cSSteven Rostedt /*
1584265c831cSSteven Rostedt  * This is a double for. Do not use 'break' to break out of the loop,
1585265c831cSSteven Rostedt  * you must use a goto.
1586265c831cSSteven Rostedt  */
1587265c831cSSteven Rostedt #define do_for_each_ftrace_rec(pg, rec)					\
1588265c831cSSteven Rostedt 	for (pg = ftrace_pages_start; pg; pg = pg->next) {		\
1589265c831cSSteven Rostedt 		int _____i;						\
1590265c831cSSteven Rostedt 		for (_____i = 0; _____i < pg->index; _____i++) {	\
1591265c831cSSteven Rostedt 			rec = &pg->records[_____i];
1592265c831cSSteven Rostedt 
1593265c831cSSteven Rostedt #define while_for_each_ftrace_rec()		\
1594265c831cSSteven Rostedt 		}				\
1595265c831cSSteven Rostedt 	}
1596ecea656dSAbhishek Sagar 
15975855feadSSteven Rostedt 
15985855feadSSteven Rostedt static int ftrace_cmp_recs(const void *a, const void *b)
15995855feadSSteven Rostedt {
1600a650e02aSSteven Rostedt 	const struct dyn_ftrace *key = a;
1601a650e02aSSteven Rostedt 	const struct dyn_ftrace *rec = b;
16025855feadSSteven Rostedt 
1603a650e02aSSteven Rostedt 	if (key->flags < rec->ip)
16045855feadSSteven Rostedt 		return -1;
1605a650e02aSSteven Rostedt 	if (key->ip >= rec->ip + MCOUNT_INSN_SIZE)
1606a650e02aSSteven Rostedt 		return 1;
1607a650e02aSSteven Rostedt 	return 0;
1608a650e02aSSteven Rostedt }
1609a650e02aSSteven Rostedt 
161004cf31a7SMichael Ellerman /**
161104cf31a7SMichael Ellerman  * ftrace_location_range - return the first address of a traced location
161204cf31a7SMichael Ellerman  *	if it touches the given ip range
161304cf31a7SMichael Ellerman  * @start: start of range to search.
161404cf31a7SMichael Ellerman  * @end: end of range to search (inclusive). @end points to the last byte
161504cf31a7SMichael Ellerman  *	to check.
161604cf31a7SMichael Ellerman  *
161704cf31a7SMichael Ellerman  * Returns rec->ip if the related ftrace location is a least partly within
161804cf31a7SMichael Ellerman  * the given address range. That is, the first address of the instruction
161904cf31a7SMichael Ellerman  * that is either a NOP or call to the function tracer. It checks the ftrace
162004cf31a7SMichael Ellerman  * internal tables to determine if the address belongs or not.
162104cf31a7SMichael Ellerman  */
162204cf31a7SMichael Ellerman unsigned long ftrace_location_range(unsigned long start, unsigned long end)
1623a650e02aSSteven Rostedt {
1624a650e02aSSteven Rostedt 	struct ftrace_page *pg;
1625a650e02aSSteven Rostedt 	struct dyn_ftrace *rec;
1626a650e02aSSteven Rostedt 	struct dyn_ftrace key;
1627a650e02aSSteven Rostedt 
1628a650e02aSSteven Rostedt 	key.ip = start;
1629a650e02aSSteven Rostedt 	key.flags = end;	/* overload flags, as it is unsigned long */
1630a650e02aSSteven Rostedt 
1631a650e02aSSteven Rostedt 	for (pg = ftrace_pages_start; pg; pg = pg->next) {
1632a650e02aSSteven Rostedt 		if (end < pg->records[0].ip ||
1633a650e02aSSteven Rostedt 		    start >= (pg->records[pg->index - 1].ip + MCOUNT_INSN_SIZE))
1634a650e02aSSteven Rostedt 			continue;
1635a650e02aSSteven Rostedt 		rec = bsearch(&key, pg->records, pg->index,
1636a650e02aSSteven Rostedt 			      sizeof(struct dyn_ftrace),
1637a650e02aSSteven Rostedt 			      ftrace_cmp_recs);
1638a650e02aSSteven Rostedt 		if (rec)
1639f0cf973aSSteven Rostedt 			return rec->ip;
1640a650e02aSSteven Rostedt 	}
1641a650e02aSSteven Rostedt 
16425855feadSSteven Rostedt 	return 0;
16435855feadSSteven Rostedt }
16445855feadSSteven Rostedt 
1645c88fd863SSteven Rostedt /**
1646c88fd863SSteven Rostedt  * ftrace_location - return true if the ip giving is a traced location
1647c88fd863SSteven Rostedt  * @ip: the instruction pointer to check
1648c88fd863SSteven Rostedt  *
1649f0cf973aSSteven Rostedt  * Returns rec->ip if @ip given is a pointer to a ftrace location.
1650c88fd863SSteven Rostedt  * That is, the instruction that is either a NOP or call to
1651c88fd863SSteven Rostedt  * the function tracer. It checks the ftrace internal tables to
1652c88fd863SSteven Rostedt  * determine if the address belongs or not.
1653c88fd863SSteven Rostedt  */
1654f0cf973aSSteven Rostedt unsigned long ftrace_location(unsigned long ip)
1655c88fd863SSteven Rostedt {
1656a650e02aSSteven Rostedt 	return ftrace_location_range(ip, ip);
16575855feadSSteven Rostedt }
1658c88fd863SSteven Rostedt 
1659a650e02aSSteven Rostedt /**
1660a650e02aSSteven Rostedt  * ftrace_text_reserved - return true if range contains an ftrace location
1661a650e02aSSteven Rostedt  * @start: start of range to search
1662a650e02aSSteven Rostedt  * @end: end of range to search (inclusive). @end points to the last byte to check.
1663a650e02aSSteven Rostedt  *
1664a650e02aSSteven Rostedt  * Returns 1 if @start and @end contains a ftrace location.
1665a650e02aSSteven Rostedt  * That is, the instruction that is either a NOP or call to
1666a650e02aSSteven Rostedt  * the function tracer. It checks the ftrace internal tables to
1667a650e02aSSteven Rostedt  * determine if the address belongs or not.
1668a650e02aSSteven Rostedt  */
1669d88471cbSSasha Levin int ftrace_text_reserved(const void *start, const void *end)
1670a650e02aSSteven Rostedt {
1671f0cf973aSSteven Rostedt 	unsigned long ret;
1672f0cf973aSSteven Rostedt 
1673f0cf973aSSteven Rostedt 	ret = ftrace_location_range((unsigned long)start,
1674a650e02aSSteven Rostedt 				    (unsigned long)end);
1675f0cf973aSSteven Rostedt 
1676f0cf973aSSteven Rostedt 	return (int)!!ret;
1677c88fd863SSteven Rostedt }
1678c88fd863SSteven Rostedt 
16794fbb48cbSSteven Rostedt (Red Hat) /* Test if ops registered to this rec needs regs */
16804fbb48cbSSteven Rostedt (Red Hat) static bool test_rec_ops_needs_regs(struct dyn_ftrace *rec)
16814fbb48cbSSteven Rostedt (Red Hat) {
16824fbb48cbSSteven Rostedt (Red Hat) 	struct ftrace_ops *ops;
16834fbb48cbSSteven Rostedt (Red Hat) 	bool keep_regs = false;
16844fbb48cbSSteven Rostedt (Red Hat) 
16854fbb48cbSSteven Rostedt (Red Hat) 	for (ops = ftrace_ops_list;
16864fbb48cbSSteven Rostedt (Red Hat) 	     ops != &ftrace_list_end; ops = ops->next) {
16874fbb48cbSSteven Rostedt (Red Hat) 		/* pass rec in as regs to have non-NULL val */
16884fbb48cbSSteven Rostedt (Red Hat) 		if (ftrace_ops_test(ops, rec->ip, rec)) {
16894fbb48cbSSteven Rostedt (Red Hat) 			if (ops->flags & FTRACE_OPS_FL_SAVE_REGS) {
16904fbb48cbSSteven Rostedt (Red Hat) 				keep_regs = true;
16914fbb48cbSSteven Rostedt (Red Hat) 				break;
16924fbb48cbSSteven Rostedt (Red Hat) 			}
16934fbb48cbSSteven Rostedt (Red Hat) 		}
16944fbb48cbSSteven Rostedt (Red Hat) 	}
16954fbb48cbSSteven Rostedt (Red Hat) 
16964fbb48cbSSteven Rostedt (Red Hat) 	return  keep_regs;
16974fbb48cbSSteven Rostedt (Red Hat) }
16984fbb48cbSSteven Rostedt (Red Hat) 
169984b6d3e6SJiri Olsa static bool __ftrace_hash_rec_update(struct ftrace_ops *ops,
1700ed926f9bSSteven Rostedt 				     int filter_hash,
1701ed926f9bSSteven Rostedt 				     bool inc)
1702ed926f9bSSteven Rostedt {
1703ed926f9bSSteven Rostedt 	struct ftrace_hash *hash;
1704ed926f9bSSteven Rostedt 	struct ftrace_hash *other_hash;
1705ed926f9bSSteven Rostedt 	struct ftrace_page *pg;
1706ed926f9bSSteven Rostedt 	struct dyn_ftrace *rec;
170784b6d3e6SJiri Olsa 	bool update = false;
1708ed926f9bSSteven Rostedt 	int count = 0;
17098c08f0d5SSteven Rostedt (VMware) 	int all = false;
1710ed926f9bSSteven Rostedt 
1711ed926f9bSSteven Rostedt 	/* Only update if the ops has been registered */
1712ed926f9bSSteven Rostedt 	if (!(ops->flags & FTRACE_OPS_FL_ENABLED))
171384b6d3e6SJiri Olsa 		return false;
1714ed926f9bSSteven Rostedt 
1715ed926f9bSSteven Rostedt 	/*
1716ed926f9bSSteven Rostedt 	 * In the filter_hash case:
1717ed926f9bSSteven Rostedt 	 *   If the count is zero, we update all records.
1718ed926f9bSSteven Rostedt 	 *   Otherwise we just update the items in the hash.
1719ed926f9bSSteven Rostedt 	 *
1720ed926f9bSSteven Rostedt 	 * In the notrace_hash case:
1721ed926f9bSSteven Rostedt 	 *   We enable the update in the hash.
1722ed926f9bSSteven Rostedt 	 *   As disabling notrace means enabling the tracing,
1723ed926f9bSSteven Rostedt 	 *   and enabling notrace means disabling, the inc variable
1724ed926f9bSSteven Rostedt 	 *   gets inversed.
1725ed926f9bSSteven Rostedt 	 */
1726ed926f9bSSteven Rostedt 	if (filter_hash) {
172733b7f99cSSteven Rostedt (Red Hat) 		hash = ops->func_hash->filter_hash;
172833b7f99cSSteven Rostedt (Red Hat) 		other_hash = ops->func_hash->notrace_hash;
172906a51d93SSteven Rostedt 		if (ftrace_hash_empty(hash))
17308c08f0d5SSteven Rostedt (VMware) 			all = true;
1731ed926f9bSSteven Rostedt 	} else {
1732ed926f9bSSteven Rostedt 		inc = !inc;
173333b7f99cSSteven Rostedt (Red Hat) 		hash = ops->func_hash->notrace_hash;
173433b7f99cSSteven Rostedt (Red Hat) 		other_hash = ops->func_hash->filter_hash;
1735ed926f9bSSteven Rostedt 		/*
1736ed926f9bSSteven Rostedt 		 * If the notrace hash has no items,
1737ed926f9bSSteven Rostedt 		 * then there's nothing to do.
1738ed926f9bSSteven Rostedt 		 */
173906a51d93SSteven Rostedt 		if (ftrace_hash_empty(hash))
174084b6d3e6SJiri Olsa 			return false;
1741ed926f9bSSteven Rostedt 	}
1742ed926f9bSSteven Rostedt 
1743ed926f9bSSteven Rostedt 	do_for_each_ftrace_rec(pg, rec) {
1744ed926f9bSSteven Rostedt 		int in_other_hash = 0;
1745ed926f9bSSteven Rostedt 		int in_hash = 0;
1746ed926f9bSSteven Rostedt 		int match = 0;
1747ed926f9bSSteven Rostedt 
1748b7ffffbbSSteven Rostedt (Red Hat) 		if (rec->flags & FTRACE_FL_DISABLED)
1749b7ffffbbSSteven Rostedt (Red Hat) 			continue;
1750b7ffffbbSSteven Rostedt (Red Hat) 
1751ed926f9bSSteven Rostedt 		if (all) {
1752ed926f9bSSteven Rostedt 			/*
1753ed926f9bSSteven Rostedt 			 * Only the filter_hash affects all records.
1754ed926f9bSSteven Rostedt 			 * Update if the record is not in the notrace hash.
1755ed926f9bSSteven Rostedt 			 */
1756b848914cSSteven Rostedt 			if (!other_hash || !ftrace_lookup_ip(other_hash, rec->ip))
1757ed926f9bSSteven Rostedt 				match = 1;
1758ed926f9bSSteven Rostedt 		} else {
175906a51d93SSteven Rostedt 			in_hash = !!ftrace_lookup_ip(hash, rec->ip);
176006a51d93SSteven Rostedt 			in_other_hash = !!ftrace_lookup_ip(other_hash, rec->ip);
1761ed926f9bSSteven Rostedt 
1762ed926f9bSSteven Rostedt 			/*
176319eab4a4SSteven Rostedt (Red Hat) 			 * If filter_hash is set, we want to match all functions
176419eab4a4SSteven Rostedt (Red Hat) 			 * that are in the hash but not in the other hash.
1765ed926f9bSSteven Rostedt 			 *
176619eab4a4SSteven Rostedt (Red Hat) 			 * If filter_hash is not set, then we are decrementing.
176719eab4a4SSteven Rostedt (Red Hat) 			 * That means we match anything that is in the hash
176819eab4a4SSteven Rostedt (Red Hat) 			 * and also in the other_hash. That is, we need to turn
176919eab4a4SSteven Rostedt (Red Hat) 			 * off functions in the other hash because they are disabled
177019eab4a4SSteven Rostedt (Red Hat) 			 * by this hash.
1771ed926f9bSSteven Rostedt 			 */
1772ed926f9bSSteven Rostedt 			if (filter_hash && in_hash && !in_other_hash)
1773ed926f9bSSteven Rostedt 				match = 1;
1774ed926f9bSSteven Rostedt 			else if (!filter_hash && in_hash &&
177506a51d93SSteven Rostedt 				 (in_other_hash || ftrace_hash_empty(other_hash)))
1776ed926f9bSSteven Rostedt 				match = 1;
1777ed926f9bSSteven Rostedt 		}
1778ed926f9bSSteven Rostedt 		if (!match)
1779ed926f9bSSteven Rostedt 			continue;
1780ed926f9bSSteven Rostedt 
1781ed926f9bSSteven Rostedt 		if (inc) {
1782ed926f9bSSteven Rostedt 			rec->flags++;
17830376bde1SSteven Rostedt (Red Hat) 			if (FTRACE_WARN_ON(ftrace_rec_count(rec) == FTRACE_REF_MAX))
178484b6d3e6SJiri Olsa 				return false;
178579922b80SSteven Rostedt (Red Hat) 
178679922b80SSteven Rostedt (Red Hat) 			/*
178779922b80SSteven Rostedt (Red Hat) 			 * If there's only a single callback registered to a
178879922b80SSteven Rostedt (Red Hat) 			 * function, and the ops has a trampoline registered
178979922b80SSteven Rostedt (Red Hat) 			 * for it, then we can call it directly.
179079922b80SSteven Rostedt (Red Hat) 			 */
1791fef5aeeeSSteven Rostedt (Red Hat) 			if (ftrace_rec_count(rec) == 1 && ops->trampoline)
179279922b80SSteven Rostedt (Red Hat) 				rec->flags |= FTRACE_FL_TRAMP;
1793fef5aeeeSSteven Rostedt (Red Hat) 			else
179479922b80SSteven Rostedt (Red Hat) 				/*
179579922b80SSteven Rostedt (Red Hat) 				 * If we are adding another function callback
179679922b80SSteven Rostedt (Red Hat) 				 * to this function, and the previous had a
1797bce0b6c5SSteven Rostedt (Red Hat) 				 * custom trampoline in use, then we need to go
1798bce0b6c5SSteven Rostedt (Red Hat) 				 * back to the default trampoline.
179979922b80SSteven Rostedt (Red Hat) 				 */
1800fef5aeeeSSteven Rostedt (Red Hat) 				rec->flags &= ~FTRACE_FL_TRAMP;
180179922b80SSteven Rostedt (Red Hat) 
180208f6fba5SSteven Rostedt 			/*
180308f6fba5SSteven Rostedt 			 * If any ops wants regs saved for this function
180408f6fba5SSteven Rostedt 			 * then all ops will get saved regs.
180508f6fba5SSteven Rostedt 			 */
180608f6fba5SSteven Rostedt 			if (ops->flags & FTRACE_OPS_FL_SAVE_REGS)
180708f6fba5SSteven Rostedt 				rec->flags |= FTRACE_FL_REGS;
1808ed926f9bSSteven Rostedt 		} else {
18090376bde1SSteven Rostedt (Red Hat) 			if (FTRACE_WARN_ON(ftrace_rec_count(rec) == 0))
181084b6d3e6SJiri Olsa 				return false;
1811ed926f9bSSteven Rostedt 			rec->flags--;
181279922b80SSteven Rostedt (Red Hat) 
18134fbb48cbSSteven Rostedt (Red Hat) 			/*
18144fbb48cbSSteven Rostedt (Red Hat) 			 * If the rec had REGS enabled and the ops that is
18154fbb48cbSSteven Rostedt (Red Hat) 			 * being removed had REGS set, then see if there is
18164fbb48cbSSteven Rostedt (Red Hat) 			 * still any ops for this record that wants regs.
18174fbb48cbSSteven Rostedt (Red Hat) 			 * If not, we can stop recording them.
18184fbb48cbSSteven Rostedt (Red Hat) 			 */
18190376bde1SSteven Rostedt (Red Hat) 			if (ftrace_rec_count(rec) > 0 &&
18204fbb48cbSSteven Rostedt (Red Hat) 			    rec->flags & FTRACE_FL_REGS &&
18214fbb48cbSSteven Rostedt (Red Hat) 			    ops->flags & FTRACE_OPS_FL_SAVE_REGS) {
18224fbb48cbSSteven Rostedt (Red Hat) 				if (!test_rec_ops_needs_regs(rec))
18234fbb48cbSSteven Rostedt (Red Hat) 					rec->flags &= ~FTRACE_FL_REGS;
18244fbb48cbSSteven Rostedt (Red Hat) 			}
182579922b80SSteven Rostedt (Red Hat) 
182679922b80SSteven Rostedt (Red Hat) 			/*
1827fef5aeeeSSteven Rostedt (Red Hat) 			 * If the rec had TRAMP enabled, then it needs to
1828fef5aeeeSSteven Rostedt (Red Hat) 			 * be cleared. As TRAMP can only be enabled iff
1829fef5aeeeSSteven Rostedt (Red Hat) 			 * there is only a single ops attached to it.
1830fef5aeeeSSteven Rostedt (Red Hat) 			 * In otherwords, always disable it on decrementing.
1831fef5aeeeSSteven Rostedt (Red Hat) 			 * In the future, we may set it if rec count is
1832fef5aeeeSSteven Rostedt (Red Hat) 			 * decremented to one, and the ops that is left
1833fef5aeeeSSteven Rostedt (Red Hat) 			 * has a trampoline.
1834fef5aeeeSSteven Rostedt (Red Hat) 			 */
1835fef5aeeeSSteven Rostedt (Red Hat) 			rec->flags &= ~FTRACE_FL_TRAMP;
1836fef5aeeeSSteven Rostedt (Red Hat) 
1837fef5aeeeSSteven Rostedt (Red Hat) 			/*
183879922b80SSteven Rostedt (Red Hat) 			 * flags will be cleared in ftrace_check_record()
183979922b80SSteven Rostedt (Red Hat) 			 * if rec count is zero.
184079922b80SSteven Rostedt (Red Hat) 			 */
1841ed926f9bSSteven Rostedt 		}
1842ed926f9bSSteven Rostedt 		count++;
184384b6d3e6SJiri Olsa 
184484b6d3e6SJiri Olsa 		/* Must match FTRACE_UPDATE_CALLS in ftrace_modify_all_code() */
184584b6d3e6SJiri Olsa 		update |= ftrace_test_record(rec, 1) != FTRACE_UPDATE_IGNORE;
184684b6d3e6SJiri Olsa 
1847ed926f9bSSteven Rostedt 		/* Shortcut, if we handled all records, we are done. */
1848ed926f9bSSteven Rostedt 		if (!all && count == hash->count)
184984b6d3e6SJiri Olsa 			return update;
1850ed926f9bSSteven Rostedt 	} while_for_each_ftrace_rec();
185184b6d3e6SJiri Olsa 
185284b6d3e6SJiri Olsa 	return update;
1853ed926f9bSSteven Rostedt }
1854ed926f9bSSteven Rostedt 
185584b6d3e6SJiri Olsa static bool ftrace_hash_rec_disable(struct ftrace_ops *ops,
1856ed926f9bSSteven Rostedt 				    int filter_hash)
1857ed926f9bSSteven Rostedt {
185884b6d3e6SJiri Olsa 	return __ftrace_hash_rec_update(ops, filter_hash, 0);
1859ed926f9bSSteven Rostedt }
1860ed926f9bSSteven Rostedt 
186184b6d3e6SJiri Olsa static bool ftrace_hash_rec_enable(struct ftrace_ops *ops,
1862ed926f9bSSteven Rostedt 				   int filter_hash)
1863ed926f9bSSteven Rostedt {
186484b6d3e6SJiri Olsa 	return __ftrace_hash_rec_update(ops, filter_hash, 1);
1865ed926f9bSSteven Rostedt }
1866ed926f9bSSteven Rostedt 
186784261912SSteven Rostedt (Red Hat) static void ftrace_hash_rec_update_modify(struct ftrace_ops *ops,
186884261912SSteven Rostedt (Red Hat) 					  int filter_hash, int inc)
186984261912SSteven Rostedt (Red Hat) {
187084261912SSteven Rostedt (Red Hat) 	struct ftrace_ops *op;
187184261912SSteven Rostedt (Red Hat) 
187284261912SSteven Rostedt (Red Hat) 	__ftrace_hash_rec_update(ops, filter_hash, inc);
187384261912SSteven Rostedt (Red Hat) 
187484261912SSteven Rostedt (Red Hat) 	if (ops->func_hash != &global_ops.local_hash)
187584261912SSteven Rostedt (Red Hat) 		return;
187684261912SSteven Rostedt (Red Hat) 
187784261912SSteven Rostedt (Red Hat) 	/*
187884261912SSteven Rostedt (Red Hat) 	 * If the ops shares the global_ops hash, then we need to update
187984261912SSteven Rostedt (Red Hat) 	 * all ops that are enabled and use this hash.
188084261912SSteven Rostedt (Red Hat) 	 */
188184261912SSteven Rostedt (Red Hat) 	do_for_each_ftrace_op(op, ftrace_ops_list) {
188284261912SSteven Rostedt (Red Hat) 		/* Already done */
188384261912SSteven Rostedt (Red Hat) 		if (op == ops)
188484261912SSteven Rostedt (Red Hat) 			continue;
188584261912SSteven Rostedt (Red Hat) 		if (op->func_hash == &global_ops.local_hash)
188684261912SSteven Rostedt (Red Hat) 			__ftrace_hash_rec_update(op, filter_hash, inc);
188784261912SSteven Rostedt (Red Hat) 	} while_for_each_ftrace_op(op);
188884261912SSteven Rostedt (Red Hat) }
188984261912SSteven Rostedt (Red Hat) 
189084261912SSteven Rostedt (Red Hat) static void ftrace_hash_rec_disable_modify(struct ftrace_ops *ops,
189184261912SSteven Rostedt (Red Hat) 					   int filter_hash)
189284261912SSteven Rostedt (Red Hat) {
189384261912SSteven Rostedt (Red Hat) 	ftrace_hash_rec_update_modify(ops, filter_hash, 0);
189484261912SSteven Rostedt (Red Hat) }
189584261912SSteven Rostedt (Red Hat) 
189684261912SSteven Rostedt (Red Hat) static void ftrace_hash_rec_enable_modify(struct ftrace_ops *ops,
189784261912SSteven Rostedt (Red Hat) 					  int filter_hash)
189884261912SSteven Rostedt (Red Hat) {
189984261912SSteven Rostedt (Red Hat) 	ftrace_hash_rec_update_modify(ops, filter_hash, 1);
190084261912SSteven Rostedt (Red Hat) }
190184261912SSteven Rostedt (Red Hat) 
1902f8b8be8aSMasami Hiramatsu /*
1903f8b8be8aSMasami Hiramatsu  * Try to update IPMODIFY flag on each ftrace_rec. Return 0 if it is OK
1904f8b8be8aSMasami Hiramatsu  * or no-needed to update, -EBUSY if it detects a conflict of the flag
1905f8b8be8aSMasami Hiramatsu  * on a ftrace_rec, and -EINVAL if the new_hash tries to trace all recs.
1906f8b8be8aSMasami Hiramatsu  * Note that old_hash and new_hash has below meanings
1907f8b8be8aSMasami Hiramatsu  *  - If the hash is NULL, it hits all recs (if IPMODIFY is set, this is rejected)
1908f8b8be8aSMasami Hiramatsu  *  - If the hash is EMPTY_HASH, it hits nothing
1909f8b8be8aSMasami Hiramatsu  *  - Anything else hits the recs which match the hash entries.
1910f8b8be8aSMasami Hiramatsu  */
1911f8b8be8aSMasami Hiramatsu static int __ftrace_hash_update_ipmodify(struct ftrace_ops *ops,
1912f8b8be8aSMasami Hiramatsu 					 struct ftrace_hash *old_hash,
1913f8b8be8aSMasami Hiramatsu 					 struct ftrace_hash *new_hash)
1914f8b8be8aSMasami Hiramatsu {
1915f8b8be8aSMasami Hiramatsu 	struct ftrace_page *pg;
1916f8b8be8aSMasami Hiramatsu 	struct dyn_ftrace *rec, *end = NULL;
1917f8b8be8aSMasami Hiramatsu 	int in_old, in_new;
1918f8b8be8aSMasami Hiramatsu 
1919f8b8be8aSMasami Hiramatsu 	/* Only update if the ops has been registered */
1920f8b8be8aSMasami Hiramatsu 	if (!(ops->flags & FTRACE_OPS_FL_ENABLED))
1921f8b8be8aSMasami Hiramatsu 		return 0;
1922f8b8be8aSMasami Hiramatsu 
1923f8b8be8aSMasami Hiramatsu 	if (!(ops->flags & FTRACE_OPS_FL_IPMODIFY))
1924f8b8be8aSMasami Hiramatsu 		return 0;
1925f8b8be8aSMasami Hiramatsu 
1926f8b8be8aSMasami Hiramatsu 	/*
1927f8b8be8aSMasami Hiramatsu 	 * Since the IPMODIFY is a very address sensitive action, we do not
1928f8b8be8aSMasami Hiramatsu 	 * allow ftrace_ops to set all functions to new hash.
1929f8b8be8aSMasami Hiramatsu 	 */
1930f8b8be8aSMasami Hiramatsu 	if (!new_hash || !old_hash)
1931f8b8be8aSMasami Hiramatsu 		return -EINVAL;
1932f8b8be8aSMasami Hiramatsu 
1933f8b8be8aSMasami Hiramatsu 	/* Update rec->flags */
1934f8b8be8aSMasami Hiramatsu 	do_for_each_ftrace_rec(pg, rec) {
1935546fece4SSteven Rostedt (Red Hat) 
1936546fece4SSteven Rostedt (Red Hat) 		if (rec->flags & FTRACE_FL_DISABLED)
1937546fece4SSteven Rostedt (Red Hat) 			continue;
1938546fece4SSteven Rostedt (Red Hat) 
1939f8b8be8aSMasami Hiramatsu 		/* We need to update only differences of filter_hash */
1940f8b8be8aSMasami Hiramatsu 		in_old = !!ftrace_lookup_ip(old_hash, rec->ip);
1941f8b8be8aSMasami Hiramatsu 		in_new = !!ftrace_lookup_ip(new_hash, rec->ip);
1942f8b8be8aSMasami Hiramatsu 		if (in_old == in_new)
1943f8b8be8aSMasami Hiramatsu 			continue;
1944f8b8be8aSMasami Hiramatsu 
1945f8b8be8aSMasami Hiramatsu 		if (in_new) {
1946f8b8be8aSMasami Hiramatsu 			/* New entries must ensure no others are using it */
1947f8b8be8aSMasami Hiramatsu 			if (rec->flags & FTRACE_FL_IPMODIFY)
1948f8b8be8aSMasami Hiramatsu 				goto rollback;
1949f8b8be8aSMasami Hiramatsu 			rec->flags |= FTRACE_FL_IPMODIFY;
1950f8b8be8aSMasami Hiramatsu 		} else /* Removed entry */
1951f8b8be8aSMasami Hiramatsu 			rec->flags &= ~FTRACE_FL_IPMODIFY;
1952f8b8be8aSMasami Hiramatsu 	} while_for_each_ftrace_rec();
1953f8b8be8aSMasami Hiramatsu 
1954f8b8be8aSMasami Hiramatsu 	return 0;
1955f8b8be8aSMasami Hiramatsu 
1956f8b8be8aSMasami Hiramatsu rollback:
1957f8b8be8aSMasami Hiramatsu 	end = rec;
1958f8b8be8aSMasami Hiramatsu 
1959f8b8be8aSMasami Hiramatsu 	/* Roll back what we did above */
1960f8b8be8aSMasami Hiramatsu 	do_for_each_ftrace_rec(pg, rec) {
1961546fece4SSteven Rostedt (Red Hat) 
1962546fece4SSteven Rostedt (Red Hat) 		if (rec->flags & FTRACE_FL_DISABLED)
1963546fece4SSteven Rostedt (Red Hat) 			continue;
1964546fece4SSteven Rostedt (Red Hat) 
1965f8b8be8aSMasami Hiramatsu 		if (rec == end)
1966f8b8be8aSMasami Hiramatsu 			goto err_out;
1967f8b8be8aSMasami Hiramatsu 
1968f8b8be8aSMasami Hiramatsu 		in_old = !!ftrace_lookup_ip(old_hash, rec->ip);
1969f8b8be8aSMasami Hiramatsu 		in_new = !!ftrace_lookup_ip(new_hash, rec->ip);
1970f8b8be8aSMasami Hiramatsu 		if (in_old == in_new)
1971f8b8be8aSMasami Hiramatsu 			continue;
1972f8b8be8aSMasami Hiramatsu 
1973f8b8be8aSMasami Hiramatsu 		if (in_new)
1974f8b8be8aSMasami Hiramatsu 			rec->flags &= ~FTRACE_FL_IPMODIFY;
1975f8b8be8aSMasami Hiramatsu 		else
1976f8b8be8aSMasami Hiramatsu 			rec->flags |= FTRACE_FL_IPMODIFY;
1977f8b8be8aSMasami Hiramatsu 	} while_for_each_ftrace_rec();
1978f8b8be8aSMasami Hiramatsu 
1979f8b8be8aSMasami Hiramatsu err_out:
1980f8b8be8aSMasami Hiramatsu 	return -EBUSY;
1981f8b8be8aSMasami Hiramatsu }
1982f8b8be8aSMasami Hiramatsu 
1983f8b8be8aSMasami Hiramatsu static int ftrace_hash_ipmodify_enable(struct ftrace_ops *ops)
1984f8b8be8aSMasami Hiramatsu {
1985f8b8be8aSMasami Hiramatsu 	struct ftrace_hash *hash = ops->func_hash->filter_hash;
1986f8b8be8aSMasami Hiramatsu 
1987f8b8be8aSMasami Hiramatsu 	if (ftrace_hash_empty(hash))
1988f8b8be8aSMasami Hiramatsu 		hash = NULL;
1989f8b8be8aSMasami Hiramatsu 
1990f8b8be8aSMasami Hiramatsu 	return __ftrace_hash_update_ipmodify(ops, EMPTY_HASH, hash);
1991f8b8be8aSMasami Hiramatsu }
1992f8b8be8aSMasami Hiramatsu 
1993f8b8be8aSMasami Hiramatsu /* Disabling always succeeds */
1994f8b8be8aSMasami Hiramatsu static void ftrace_hash_ipmodify_disable(struct ftrace_ops *ops)
1995f8b8be8aSMasami Hiramatsu {
1996f8b8be8aSMasami Hiramatsu 	struct ftrace_hash *hash = ops->func_hash->filter_hash;
1997f8b8be8aSMasami Hiramatsu 
1998f8b8be8aSMasami Hiramatsu 	if (ftrace_hash_empty(hash))
1999f8b8be8aSMasami Hiramatsu 		hash = NULL;
2000f8b8be8aSMasami Hiramatsu 
2001f8b8be8aSMasami Hiramatsu 	__ftrace_hash_update_ipmodify(ops, hash, EMPTY_HASH);
2002f8b8be8aSMasami Hiramatsu }
2003f8b8be8aSMasami Hiramatsu 
2004f8b8be8aSMasami Hiramatsu static int ftrace_hash_ipmodify_update(struct ftrace_ops *ops,
2005f8b8be8aSMasami Hiramatsu 				       struct ftrace_hash *new_hash)
2006f8b8be8aSMasami Hiramatsu {
2007f8b8be8aSMasami Hiramatsu 	struct ftrace_hash *old_hash = ops->func_hash->filter_hash;
2008f8b8be8aSMasami Hiramatsu 
2009f8b8be8aSMasami Hiramatsu 	if (ftrace_hash_empty(old_hash))
2010f8b8be8aSMasami Hiramatsu 		old_hash = NULL;
2011f8b8be8aSMasami Hiramatsu 
2012f8b8be8aSMasami Hiramatsu 	if (ftrace_hash_empty(new_hash))
2013f8b8be8aSMasami Hiramatsu 		new_hash = NULL;
2014f8b8be8aSMasami Hiramatsu 
2015f8b8be8aSMasami Hiramatsu 	return __ftrace_hash_update_ipmodify(ops, old_hash, new_hash);
2016f8b8be8aSMasami Hiramatsu }
2017f8b8be8aSMasami Hiramatsu 
2018b05086c7SSteven Rostedt (Red Hat) static void print_ip_ins(const char *fmt, const unsigned char *p)
201905736a42SSteven Rostedt {
202005736a42SSteven Rostedt 	int i;
202105736a42SSteven Rostedt 
202205736a42SSteven Rostedt 	printk(KERN_CONT "%s", fmt);
202305736a42SSteven Rostedt 
202405736a42SSteven Rostedt 	for (i = 0; i < MCOUNT_INSN_SIZE; i++)
202505736a42SSteven Rostedt 		printk(KERN_CONT "%s%02x", i ? ":" : "", p[i]);
202605736a42SSteven Rostedt }
202705736a42SSteven Rostedt 
20284fd3279bSSteven Rostedt (Red Hat) static struct ftrace_ops *
20294fd3279bSSteven Rostedt (Red Hat) ftrace_find_tramp_ops_any(struct dyn_ftrace *rec);
203039daa7b9SSteven Rostedt (Red Hat) static struct ftrace_ops *
203139daa7b9SSteven Rostedt (Red Hat) ftrace_find_tramp_ops_next(struct dyn_ftrace *rec, struct ftrace_ops *ops);
20324fd3279bSSteven Rostedt (Red Hat) 
203302a392a0SSteven Rostedt (Red Hat) enum ftrace_bug_type ftrace_bug_type;
2034b05086c7SSteven Rostedt (Red Hat) const void *ftrace_expected;
203502a392a0SSteven Rostedt (Red Hat) 
203602a392a0SSteven Rostedt (Red Hat) static void print_bug_type(void)
203702a392a0SSteven Rostedt (Red Hat) {
203802a392a0SSteven Rostedt (Red Hat) 	switch (ftrace_bug_type) {
203902a392a0SSteven Rostedt (Red Hat) 	case FTRACE_BUG_UNKNOWN:
204002a392a0SSteven Rostedt (Red Hat) 		break;
204102a392a0SSteven Rostedt (Red Hat) 	case FTRACE_BUG_INIT:
204202a392a0SSteven Rostedt (Red Hat) 		pr_info("Initializing ftrace call sites\n");
204302a392a0SSteven Rostedt (Red Hat) 		break;
204402a392a0SSteven Rostedt (Red Hat) 	case FTRACE_BUG_NOP:
204502a392a0SSteven Rostedt (Red Hat) 		pr_info("Setting ftrace call site to NOP\n");
204602a392a0SSteven Rostedt (Red Hat) 		break;
204702a392a0SSteven Rostedt (Red Hat) 	case FTRACE_BUG_CALL:
204802a392a0SSteven Rostedt (Red Hat) 		pr_info("Setting ftrace call site to call ftrace function\n");
204902a392a0SSteven Rostedt (Red Hat) 		break;
205002a392a0SSteven Rostedt (Red Hat) 	case FTRACE_BUG_UPDATE:
205102a392a0SSteven Rostedt (Red Hat) 		pr_info("Updating ftrace call site to call a different ftrace function\n");
205202a392a0SSteven Rostedt (Red Hat) 		break;
205302a392a0SSteven Rostedt (Red Hat) 	}
205402a392a0SSteven Rostedt (Red Hat) }
205502a392a0SSteven Rostedt (Red Hat) 
2056c88fd863SSteven Rostedt /**
2057c88fd863SSteven Rostedt  * ftrace_bug - report and shutdown function tracer
2058c88fd863SSteven Rostedt  * @failed: The failed type (EFAULT, EINVAL, EPERM)
20594fd3279bSSteven Rostedt (Red Hat)  * @rec: The record that failed
2060c88fd863SSteven Rostedt  *
2061c88fd863SSteven Rostedt  * The arch code that enables or disables the function tracing
2062c88fd863SSteven Rostedt  * can call ftrace_bug() when it has detected a problem in
2063c88fd863SSteven Rostedt  * modifying the code. @failed should be one of either:
2064c88fd863SSteven Rostedt  * EFAULT - if the problem happens on reading the @ip address
2065c88fd863SSteven Rostedt  * EINVAL - if what is read at @ip is not what was expected
2066c88fd863SSteven Rostedt  * EPERM - if the problem happens on writting to the @ip address
2067c88fd863SSteven Rostedt  */
20684fd3279bSSteven Rostedt (Red Hat) void ftrace_bug(int failed, struct dyn_ftrace *rec)
20693c1720f0SSteven Rostedt {
20704fd3279bSSteven Rostedt (Red Hat) 	unsigned long ip = rec ? rec->ip : 0;
20714fd3279bSSteven Rostedt (Red Hat) 
2072b17e8a37SSteven Rostedt 	switch (failed) {
2073593eb8a2SSteven Rostedt 	case -EFAULT:
20746912896eSSteven Rostedt 		FTRACE_WARN_ON_ONCE(1);
207505736a42SSteven Rostedt 		pr_info("ftrace faulted on modifying ");
207605736a42SSteven Rostedt 		print_ip_sym(ip);
207705736a42SSteven Rostedt 		break;
2078593eb8a2SSteven Rostedt 	case -EINVAL:
20796912896eSSteven Rostedt 		FTRACE_WARN_ON_ONCE(1);
208005736a42SSteven Rostedt 		pr_info("ftrace failed to modify ");
208105736a42SSteven Rostedt 		print_ip_sym(ip);
208205736a42SSteven Rostedt 		print_ip_ins(" actual:   ", (unsigned char *)ip);
20834fd3279bSSteven Rostedt (Red Hat) 		pr_cont("\n");
2084b05086c7SSteven Rostedt (Red Hat) 		if (ftrace_expected) {
2085b05086c7SSteven Rostedt (Red Hat) 			print_ip_ins(" expected: ", ftrace_expected);
2086b05086c7SSteven Rostedt (Red Hat) 			pr_cont("\n");
2087b05086c7SSteven Rostedt (Red Hat) 		}
208805736a42SSteven Rostedt 		break;
2089593eb8a2SSteven Rostedt 	case -EPERM:
20906912896eSSteven Rostedt 		FTRACE_WARN_ON_ONCE(1);
2091593eb8a2SSteven Rostedt 		pr_info("ftrace faulted on writing ");
2092593eb8a2SSteven Rostedt 		print_ip_sym(ip);
2093593eb8a2SSteven Rostedt 		break;
2094593eb8a2SSteven Rostedt 	default:
20956912896eSSteven Rostedt 		FTRACE_WARN_ON_ONCE(1);
2096593eb8a2SSteven Rostedt 		pr_info("ftrace faulted on unknown error ");
2097593eb8a2SSteven Rostedt 		print_ip_sym(ip);
209805736a42SSteven Rostedt 	}
209902a392a0SSteven Rostedt (Red Hat) 	print_bug_type();
21004fd3279bSSteven Rostedt (Red Hat) 	if (rec) {
21014fd3279bSSteven Rostedt (Red Hat) 		struct ftrace_ops *ops = NULL;
21024fd3279bSSteven Rostedt (Red Hat) 
21034fd3279bSSteven Rostedt (Red Hat) 		pr_info("ftrace record flags: %lx\n", rec->flags);
21044fd3279bSSteven Rostedt (Red Hat) 		pr_cont(" (%ld)%s", ftrace_rec_count(rec),
21054fd3279bSSteven Rostedt (Red Hat) 			rec->flags & FTRACE_FL_REGS ? " R" : "  ");
21064fd3279bSSteven Rostedt (Red Hat) 		if (rec->flags & FTRACE_FL_TRAMP_EN) {
21074fd3279bSSteven Rostedt (Red Hat) 			ops = ftrace_find_tramp_ops_any(rec);
210839daa7b9SSteven Rostedt (Red Hat) 			if (ops) {
210939daa7b9SSteven Rostedt (Red Hat) 				do {
211039daa7b9SSteven Rostedt (Red Hat) 					pr_cont("\ttramp: %pS (%pS)",
211139daa7b9SSteven Rostedt (Red Hat) 						(void *)ops->trampoline,
211239daa7b9SSteven Rostedt (Red Hat) 						(void *)ops->func);
211339daa7b9SSteven Rostedt (Red Hat) 					ops = ftrace_find_tramp_ops_next(rec, ops);
211439daa7b9SSteven Rostedt (Red Hat) 				} while (ops);
211539daa7b9SSteven Rostedt (Red Hat) 			} else
21164fd3279bSSteven Rostedt (Red Hat) 				pr_cont("\ttramp: ERROR!");
21174fd3279bSSteven Rostedt (Red Hat) 
21184fd3279bSSteven Rostedt (Red Hat) 		}
21194fd3279bSSteven Rostedt (Red Hat) 		ip = ftrace_get_addr_curr(rec);
212039daa7b9SSteven Rostedt (Red Hat) 		pr_cont("\n expected tramp: %lx\n", ip);
21214fd3279bSSteven Rostedt (Red Hat) 	}
2122b17e8a37SSteven Rostedt }
212305736a42SSteven Rostedt 
2124c88fd863SSteven Rostedt static int ftrace_check_record(struct dyn_ftrace *rec, int enable, int update)
21253d083395SSteven Rostedt {
212664fbcd16SXiao Guangrong 	unsigned long flag = 0UL;
2127e7d3737eSFrederic Weisbecker 
212802a392a0SSteven Rostedt (Red Hat) 	ftrace_bug_type = FTRACE_BUG_UNKNOWN;
212902a392a0SSteven Rostedt (Red Hat) 
2130b7ffffbbSSteven Rostedt (Red Hat) 	if (rec->flags & FTRACE_FL_DISABLED)
2131b7ffffbbSSteven Rostedt (Red Hat) 		return FTRACE_UPDATE_IGNORE;
2132b7ffffbbSSteven Rostedt (Red Hat) 
21333d083395SSteven Rostedt 	/*
213430fb6aa7SJiri Olsa 	 * If we are updating calls:
21353d083395SSteven Rostedt 	 *
2136ed926f9bSSteven Rostedt 	 *   If the record has a ref count, then we need to enable it
2137ed926f9bSSteven Rostedt 	 *   because someone is using it.
21383d083395SSteven Rostedt 	 *
2139ed926f9bSSteven Rostedt 	 *   Otherwise we make sure its disabled.
2140ed926f9bSSteven Rostedt 	 *
214130fb6aa7SJiri Olsa 	 * If we are disabling calls, then disable all records that
2142ed926f9bSSteven Rostedt 	 * are enabled.
21433d083395SSteven Rostedt 	 */
21440376bde1SSteven Rostedt (Red Hat) 	if (enable && ftrace_rec_count(rec))
214564fbcd16SXiao Guangrong 		flag = FTRACE_FL_ENABLED;
21463d083395SSteven Rostedt 
214708f6fba5SSteven Rostedt 	/*
214879922b80SSteven Rostedt (Red Hat) 	 * If enabling and the REGS flag does not match the REGS_EN, or
214979922b80SSteven Rostedt (Red Hat) 	 * the TRAMP flag doesn't match the TRAMP_EN, then do not ignore
215079922b80SSteven Rostedt (Red Hat) 	 * this record. Set flags to fail the compare against ENABLED.
215108f6fba5SSteven Rostedt 	 */
215279922b80SSteven Rostedt (Red Hat) 	if (flag) {
215379922b80SSteven Rostedt (Red Hat) 		if (!(rec->flags & FTRACE_FL_REGS) !=
215479922b80SSteven Rostedt (Red Hat) 		    !(rec->flags & FTRACE_FL_REGS_EN))
215508f6fba5SSteven Rostedt 			flag |= FTRACE_FL_REGS;
215608f6fba5SSteven Rostedt 
215779922b80SSteven Rostedt (Red Hat) 		if (!(rec->flags & FTRACE_FL_TRAMP) !=
215879922b80SSteven Rostedt (Red Hat) 		    !(rec->flags & FTRACE_FL_TRAMP_EN))
215979922b80SSteven Rostedt (Red Hat) 			flag |= FTRACE_FL_TRAMP;
216079922b80SSteven Rostedt (Red Hat) 	}
216179922b80SSteven Rostedt (Red Hat) 
216264fbcd16SXiao Guangrong 	/* If the state of this record hasn't changed, then do nothing */
216364fbcd16SXiao Guangrong 	if ((rec->flags & FTRACE_FL_ENABLED) == flag)
2164c88fd863SSteven Rostedt 		return FTRACE_UPDATE_IGNORE;
216564fbcd16SXiao Guangrong 
216664fbcd16SXiao Guangrong 	if (flag) {
216708f6fba5SSteven Rostedt 		/* Save off if rec is being enabled (for return value) */
216808f6fba5SSteven Rostedt 		flag ^= rec->flags & FTRACE_FL_ENABLED;
216908f6fba5SSteven Rostedt 
217008f6fba5SSteven Rostedt 		if (update) {
217164fbcd16SXiao Guangrong 			rec->flags |= FTRACE_FL_ENABLED;
217208f6fba5SSteven Rostedt 			if (flag & FTRACE_FL_REGS) {
217308f6fba5SSteven Rostedt 				if (rec->flags & FTRACE_FL_REGS)
217408f6fba5SSteven Rostedt 					rec->flags |= FTRACE_FL_REGS_EN;
217508f6fba5SSteven Rostedt 				else
217608f6fba5SSteven Rostedt 					rec->flags &= ~FTRACE_FL_REGS_EN;
217708f6fba5SSteven Rostedt 			}
217879922b80SSteven Rostedt (Red Hat) 			if (flag & FTRACE_FL_TRAMP) {
217979922b80SSteven Rostedt (Red Hat) 				if (rec->flags & FTRACE_FL_TRAMP)
218079922b80SSteven Rostedt (Red Hat) 					rec->flags |= FTRACE_FL_TRAMP_EN;
218179922b80SSteven Rostedt (Red Hat) 				else
218279922b80SSteven Rostedt (Red Hat) 					rec->flags &= ~FTRACE_FL_TRAMP_EN;
218379922b80SSteven Rostedt (Red Hat) 			}
218464fbcd16SXiao Guangrong 		}
218564fbcd16SXiao Guangrong 
218608f6fba5SSteven Rostedt 		/*
218708f6fba5SSteven Rostedt 		 * If this record is being updated from a nop, then
218808f6fba5SSteven Rostedt 		 *   return UPDATE_MAKE_CALL.
218908f6fba5SSteven Rostedt 		 * Otherwise,
219008f6fba5SSteven Rostedt 		 *   return UPDATE_MODIFY_CALL to tell the caller to convert
2191f1b2f2bdSSteven Rostedt (Red Hat) 		 *   from the save regs, to a non-save regs function or
219279922b80SSteven Rostedt (Red Hat) 		 *   vice versa, or from a trampoline call.
219308f6fba5SSteven Rostedt 		 */
219402a392a0SSteven Rostedt (Red Hat) 		if (flag & FTRACE_FL_ENABLED) {
219502a392a0SSteven Rostedt (Red Hat) 			ftrace_bug_type = FTRACE_BUG_CALL;
219608f6fba5SSteven Rostedt 			return FTRACE_UPDATE_MAKE_CALL;
219702a392a0SSteven Rostedt (Red Hat) 		}
2198f1b2f2bdSSteven Rostedt (Red Hat) 
219902a392a0SSteven Rostedt (Red Hat) 		ftrace_bug_type = FTRACE_BUG_UPDATE;
220008f6fba5SSteven Rostedt 		return FTRACE_UPDATE_MODIFY_CALL;
220108f6fba5SSteven Rostedt 	}
220208f6fba5SSteven Rostedt 
220308f6fba5SSteven Rostedt 	if (update) {
220408f6fba5SSteven Rostedt 		/* If there's no more users, clear all flags */
22050376bde1SSteven Rostedt (Red Hat) 		if (!ftrace_rec_count(rec))
220608f6fba5SSteven Rostedt 			rec->flags = 0;
220708f6fba5SSteven Rostedt 		else
2208b24d443bSSteven Rostedt (Red Hat) 			/*
2209b24d443bSSteven Rostedt (Red Hat) 			 * Just disable the record, but keep the ops TRAMP
2210b24d443bSSteven Rostedt (Red Hat) 			 * and REGS states. The _EN flags must be disabled though.
2211b24d443bSSteven Rostedt (Red Hat) 			 */
2212b24d443bSSteven Rostedt (Red Hat) 			rec->flags &= ~(FTRACE_FL_ENABLED | FTRACE_FL_TRAMP_EN |
2213b24d443bSSteven Rostedt (Red Hat) 					FTRACE_FL_REGS_EN);
221408f6fba5SSteven Rostedt 	}
2215c88fd863SSteven Rostedt 
221602a392a0SSteven Rostedt (Red Hat) 	ftrace_bug_type = FTRACE_BUG_NOP;
2217c88fd863SSteven Rostedt 	return FTRACE_UPDATE_MAKE_NOP;
2218c88fd863SSteven Rostedt }
2219c88fd863SSteven Rostedt 
2220c88fd863SSteven Rostedt /**
2221c88fd863SSteven Rostedt  * ftrace_update_record, set a record that now is tracing or not
2222c88fd863SSteven Rostedt  * @rec: the record to update
2223c88fd863SSteven Rostedt  * @enable: set to 1 if the record is tracing, zero to force disable
2224c88fd863SSteven Rostedt  *
2225c88fd863SSteven Rostedt  * The records that represent all functions that can be traced need
2226c88fd863SSteven Rostedt  * to be updated when tracing has been enabled.
2227c88fd863SSteven Rostedt  */
2228c88fd863SSteven Rostedt int ftrace_update_record(struct dyn_ftrace *rec, int enable)
2229c88fd863SSteven Rostedt {
2230c88fd863SSteven Rostedt 	return ftrace_check_record(rec, enable, 1);
2231c88fd863SSteven Rostedt }
2232c88fd863SSteven Rostedt 
2233c88fd863SSteven Rostedt /**
2234c88fd863SSteven Rostedt  * ftrace_test_record, check if the record has been enabled or not
2235c88fd863SSteven Rostedt  * @rec: the record to test
2236c88fd863SSteven Rostedt  * @enable: set to 1 to check if enabled, 0 if it is disabled
2237c88fd863SSteven Rostedt  *
2238c88fd863SSteven Rostedt  * The arch code may need to test if a record is already set to
2239c88fd863SSteven Rostedt  * tracing to determine how to modify the function code that it
2240c88fd863SSteven Rostedt  * represents.
2241c88fd863SSteven Rostedt  */
2242c88fd863SSteven Rostedt int ftrace_test_record(struct dyn_ftrace *rec, int enable)
2243c88fd863SSteven Rostedt {
2244c88fd863SSteven Rostedt 	return ftrace_check_record(rec, enable, 0);
2245c88fd863SSteven Rostedt }
2246c88fd863SSteven Rostedt 
224779922b80SSteven Rostedt (Red Hat) static struct ftrace_ops *
22485fecaa04SSteven Rostedt (Red Hat) ftrace_find_tramp_ops_any(struct dyn_ftrace *rec)
22495fecaa04SSteven Rostedt (Red Hat) {
22505fecaa04SSteven Rostedt (Red Hat) 	struct ftrace_ops *op;
2251fef5aeeeSSteven Rostedt (Red Hat) 	unsigned long ip = rec->ip;
22525fecaa04SSteven Rostedt (Red Hat) 
22535fecaa04SSteven Rostedt (Red Hat) 	do_for_each_ftrace_op(op, ftrace_ops_list) {
22545fecaa04SSteven Rostedt (Red Hat) 
22555fecaa04SSteven Rostedt (Red Hat) 		if (!op->trampoline)
22565fecaa04SSteven Rostedt (Red Hat) 			continue;
22575fecaa04SSteven Rostedt (Red Hat) 
2258fef5aeeeSSteven Rostedt (Red Hat) 		if (hash_contains_ip(ip, op->func_hash))
22595fecaa04SSteven Rostedt (Red Hat) 			return op;
22605fecaa04SSteven Rostedt (Red Hat) 	} while_for_each_ftrace_op(op);
22615fecaa04SSteven Rostedt (Red Hat) 
22625fecaa04SSteven Rostedt (Red Hat) 	return NULL;
22635fecaa04SSteven Rostedt (Red Hat) }
22645fecaa04SSteven Rostedt (Red Hat) 
22655fecaa04SSteven Rostedt (Red Hat) static struct ftrace_ops *
226639daa7b9SSteven Rostedt (Red Hat) ftrace_find_tramp_ops_next(struct dyn_ftrace *rec,
226739daa7b9SSteven Rostedt (Red Hat) 			   struct ftrace_ops *op)
226839daa7b9SSteven Rostedt (Red Hat) {
226939daa7b9SSteven Rostedt (Red Hat) 	unsigned long ip = rec->ip;
227039daa7b9SSteven Rostedt (Red Hat) 
227139daa7b9SSteven Rostedt (Red Hat) 	while_for_each_ftrace_op(op) {
227239daa7b9SSteven Rostedt (Red Hat) 
227339daa7b9SSteven Rostedt (Red Hat) 		if (!op->trampoline)
227439daa7b9SSteven Rostedt (Red Hat) 			continue;
227539daa7b9SSteven Rostedt (Red Hat) 
227639daa7b9SSteven Rostedt (Red Hat) 		if (hash_contains_ip(ip, op->func_hash))
227739daa7b9SSteven Rostedt (Red Hat) 			return op;
227839daa7b9SSteven Rostedt (Red Hat) 	}
227939daa7b9SSteven Rostedt (Red Hat) 
228039daa7b9SSteven Rostedt (Red Hat) 	return NULL;
228139daa7b9SSteven Rostedt (Red Hat) }
228239daa7b9SSteven Rostedt (Red Hat) 
228339daa7b9SSteven Rostedt (Red Hat) static struct ftrace_ops *
228479922b80SSteven Rostedt (Red Hat) ftrace_find_tramp_ops_curr(struct dyn_ftrace *rec)
228579922b80SSteven Rostedt (Red Hat) {
228679922b80SSteven Rostedt (Red Hat) 	struct ftrace_ops *op;
2287fef5aeeeSSteven Rostedt (Red Hat) 	unsigned long ip = rec->ip;
228879922b80SSteven Rostedt (Red Hat) 
2289fef5aeeeSSteven Rostedt (Red Hat) 	/*
2290fef5aeeeSSteven Rostedt (Red Hat) 	 * Need to check removed ops first.
2291fef5aeeeSSteven Rostedt (Red Hat) 	 * If they are being removed, and this rec has a tramp,
2292fef5aeeeSSteven Rostedt (Red Hat) 	 * and this rec is in the ops list, then it would be the
2293fef5aeeeSSteven Rostedt (Red Hat) 	 * one with the tramp.
2294fef5aeeeSSteven Rostedt (Red Hat) 	 */
2295fef5aeeeSSteven Rostedt (Red Hat) 	if (removed_ops) {
2296fef5aeeeSSteven Rostedt (Red Hat) 		if (hash_contains_ip(ip, &removed_ops->old_hash))
229779922b80SSteven Rostedt (Red Hat) 			return removed_ops;
229879922b80SSteven Rostedt (Red Hat) 	}
229979922b80SSteven Rostedt (Red Hat) 
2300fef5aeeeSSteven Rostedt (Red Hat) 	/*
2301fef5aeeeSSteven Rostedt (Red Hat) 	 * Need to find the current trampoline for a rec.
2302fef5aeeeSSteven Rostedt (Red Hat) 	 * Now, a trampoline is only attached to a rec if there
2303fef5aeeeSSteven Rostedt (Red Hat) 	 * was a single 'ops' attached to it. But this can be called
2304fef5aeeeSSteven Rostedt (Red Hat) 	 * when we are adding another op to the rec or removing the
2305fef5aeeeSSteven Rostedt (Red Hat) 	 * current one. Thus, if the op is being added, we can
2306fef5aeeeSSteven Rostedt (Red Hat) 	 * ignore it because it hasn't attached itself to the rec
23074fc40904SSteven Rostedt (Red Hat) 	 * yet.
23084fc40904SSteven Rostedt (Red Hat) 	 *
23094fc40904SSteven Rostedt (Red Hat) 	 * If an ops is being modified (hooking to different functions)
23104fc40904SSteven Rostedt (Red Hat) 	 * then we don't care about the new functions that are being
23114fc40904SSteven Rostedt (Red Hat) 	 * added, just the old ones (that are probably being removed).
23124fc40904SSteven Rostedt (Red Hat) 	 *
23134fc40904SSteven Rostedt (Red Hat) 	 * If we are adding an ops to a function that already is using
23144fc40904SSteven Rostedt (Red Hat) 	 * a trampoline, it needs to be removed (trampolines are only
23154fc40904SSteven Rostedt (Red Hat) 	 * for single ops connected), then an ops that is not being
23164fc40904SSteven Rostedt (Red Hat) 	 * modified also needs to be checked.
2317fef5aeeeSSteven Rostedt (Red Hat) 	 */
231879922b80SSteven Rostedt (Red Hat) 	do_for_each_ftrace_op(op, ftrace_ops_list) {
2319fef5aeeeSSteven Rostedt (Red Hat) 
2320fef5aeeeSSteven Rostedt (Red Hat) 		if (!op->trampoline)
232179922b80SSteven Rostedt (Red Hat) 			continue;
232279922b80SSteven Rostedt (Red Hat) 
2323fef5aeeeSSteven Rostedt (Red Hat) 		/*
2324fef5aeeeSSteven Rostedt (Red Hat) 		 * If the ops is being added, it hasn't gotten to
2325fef5aeeeSSteven Rostedt (Red Hat) 		 * the point to be removed from this tree yet.
2326fef5aeeeSSteven Rostedt (Red Hat) 		 */
2327fef5aeeeSSteven Rostedt (Red Hat) 		if (op->flags & FTRACE_OPS_FL_ADDING)
2328fef5aeeeSSteven Rostedt (Red Hat) 			continue;
2329fef5aeeeSSteven Rostedt (Red Hat) 
2330fef5aeeeSSteven Rostedt (Red Hat) 
23314fc40904SSteven Rostedt (Red Hat) 		/*
23324fc40904SSteven Rostedt (Red Hat) 		 * If the ops is being modified and is in the old
23334fc40904SSteven Rostedt (Red Hat) 		 * hash, then it is probably being removed from this
23344fc40904SSteven Rostedt (Red Hat) 		 * function.
23354fc40904SSteven Rostedt (Red Hat) 		 */
2336fef5aeeeSSteven Rostedt (Red Hat) 		if ((op->flags & FTRACE_OPS_FL_MODIFYING) &&
2337fef5aeeeSSteven Rostedt (Red Hat) 		    hash_contains_ip(ip, &op->old_hash))
233879922b80SSteven Rostedt (Red Hat) 			return op;
23394fc40904SSteven Rostedt (Red Hat) 		/*
23404fc40904SSteven Rostedt (Red Hat) 		 * If the ops is not being added or modified, and it's
23414fc40904SSteven Rostedt (Red Hat) 		 * in its normal filter hash, then this must be the one
23424fc40904SSteven Rostedt (Red Hat) 		 * we want!
23434fc40904SSteven Rostedt (Red Hat) 		 */
23444fc40904SSteven Rostedt (Red Hat) 		if (!(op->flags & FTRACE_OPS_FL_MODIFYING) &&
23454fc40904SSteven Rostedt (Red Hat) 		    hash_contains_ip(ip, op->func_hash))
23464fc40904SSteven Rostedt (Red Hat) 			return op;
234779922b80SSteven Rostedt (Red Hat) 
234879922b80SSteven Rostedt (Red Hat) 	} while_for_each_ftrace_op(op);
234979922b80SSteven Rostedt (Red Hat) 
235079922b80SSteven Rostedt (Red Hat) 	return NULL;
235179922b80SSteven Rostedt (Red Hat) }
235279922b80SSteven Rostedt (Red Hat) 
235379922b80SSteven Rostedt (Red Hat) static struct ftrace_ops *
235479922b80SSteven Rostedt (Red Hat) ftrace_find_tramp_ops_new(struct dyn_ftrace *rec)
235579922b80SSteven Rostedt (Red Hat) {
235679922b80SSteven Rostedt (Red Hat) 	struct ftrace_ops *op;
2357fef5aeeeSSteven Rostedt (Red Hat) 	unsigned long ip = rec->ip;
235879922b80SSteven Rostedt (Red Hat) 
235979922b80SSteven Rostedt (Red Hat) 	do_for_each_ftrace_op(op, ftrace_ops_list) {
236079922b80SSteven Rostedt (Red Hat) 		/* pass rec in as regs to have non-NULL val */
2361fef5aeeeSSteven Rostedt (Red Hat) 		if (hash_contains_ip(ip, op->func_hash))
236279922b80SSteven Rostedt (Red Hat) 			return op;
236379922b80SSteven Rostedt (Red Hat) 	} while_for_each_ftrace_op(op);
236479922b80SSteven Rostedt (Red Hat) 
236579922b80SSteven Rostedt (Red Hat) 	return NULL;
236679922b80SSteven Rostedt (Red Hat) }
236779922b80SSteven Rostedt (Red Hat) 
23687413af1fSSteven Rostedt (Red Hat) /**
23697413af1fSSteven Rostedt (Red Hat)  * ftrace_get_addr_new - Get the call address to set to
23707413af1fSSteven Rostedt (Red Hat)  * @rec:  The ftrace record descriptor
23717413af1fSSteven Rostedt (Red Hat)  *
23727413af1fSSteven Rostedt (Red Hat)  * If the record has the FTRACE_FL_REGS set, that means that it
23737413af1fSSteven Rostedt (Red Hat)  * wants to convert to a callback that saves all regs. If FTRACE_FL_REGS
23747413af1fSSteven Rostedt (Red Hat)  * is not not set, then it wants to convert to the normal callback.
23757413af1fSSteven Rostedt (Red Hat)  *
23767413af1fSSteven Rostedt (Red Hat)  * Returns the address of the trampoline to set to
23777413af1fSSteven Rostedt (Red Hat)  */
23787413af1fSSteven Rostedt (Red Hat) unsigned long ftrace_get_addr_new(struct dyn_ftrace *rec)
23797413af1fSSteven Rostedt (Red Hat) {
238079922b80SSteven Rostedt (Red Hat) 	struct ftrace_ops *ops;
238179922b80SSteven Rostedt (Red Hat) 
238279922b80SSteven Rostedt (Red Hat) 	/* Trampolines take precedence over regs */
238379922b80SSteven Rostedt (Red Hat) 	if (rec->flags & FTRACE_FL_TRAMP) {
238479922b80SSteven Rostedt (Red Hat) 		ops = ftrace_find_tramp_ops_new(rec);
238579922b80SSteven Rostedt (Red Hat) 		if (FTRACE_WARN_ON(!ops || !ops->trampoline)) {
2386bce0b6c5SSteven Rostedt (Red Hat) 			pr_warn("Bad trampoline accounting at: %p (%pS) (%lx)\n",
2387bce0b6c5SSteven Rostedt (Red Hat) 				(void *)rec->ip, (void *)rec->ip, rec->flags);
238879922b80SSteven Rostedt (Red Hat) 			/* Ftrace is shutting down, return anything */
238979922b80SSteven Rostedt (Red Hat) 			return (unsigned long)FTRACE_ADDR;
239079922b80SSteven Rostedt (Red Hat) 		}
239179922b80SSteven Rostedt (Red Hat) 		return ops->trampoline;
239279922b80SSteven Rostedt (Red Hat) 	}
239379922b80SSteven Rostedt (Red Hat) 
23947413af1fSSteven Rostedt (Red Hat) 	if (rec->flags & FTRACE_FL_REGS)
23957413af1fSSteven Rostedt (Red Hat) 		return (unsigned long)FTRACE_REGS_ADDR;
23967413af1fSSteven Rostedt (Red Hat) 	else
23977413af1fSSteven Rostedt (Red Hat) 		return (unsigned long)FTRACE_ADDR;
23987413af1fSSteven Rostedt (Red Hat) }
23997413af1fSSteven Rostedt (Red Hat) 
24007413af1fSSteven Rostedt (Red Hat) /**
24017413af1fSSteven Rostedt (Red Hat)  * ftrace_get_addr_curr - Get the call address that is already there
24027413af1fSSteven Rostedt (Red Hat)  * @rec:  The ftrace record descriptor
24037413af1fSSteven Rostedt (Red Hat)  *
24047413af1fSSteven Rostedt (Red Hat)  * The FTRACE_FL_REGS_EN is set when the record already points to
24057413af1fSSteven Rostedt (Red Hat)  * a function that saves all the regs. Basically the '_EN' version
24067413af1fSSteven Rostedt (Red Hat)  * represents the current state of the function.
24077413af1fSSteven Rostedt (Red Hat)  *
24087413af1fSSteven Rostedt (Red Hat)  * Returns the address of the trampoline that is currently being called
24097413af1fSSteven Rostedt (Red Hat)  */
24107413af1fSSteven Rostedt (Red Hat) unsigned long ftrace_get_addr_curr(struct dyn_ftrace *rec)
24117413af1fSSteven Rostedt (Red Hat) {
241279922b80SSteven Rostedt (Red Hat) 	struct ftrace_ops *ops;
241379922b80SSteven Rostedt (Red Hat) 
241479922b80SSteven Rostedt (Red Hat) 	/* Trampolines take precedence over regs */
241579922b80SSteven Rostedt (Red Hat) 	if (rec->flags & FTRACE_FL_TRAMP_EN) {
241679922b80SSteven Rostedt (Red Hat) 		ops = ftrace_find_tramp_ops_curr(rec);
241779922b80SSteven Rostedt (Red Hat) 		if (FTRACE_WARN_ON(!ops)) {
2418a395d6a7SJoe Perches 			pr_warn("Bad trampoline accounting at: %p (%pS)\n",
241979922b80SSteven Rostedt (Red Hat) 				(void *)rec->ip, (void *)rec->ip);
242079922b80SSteven Rostedt (Red Hat) 			/* Ftrace is shutting down, return anything */
242179922b80SSteven Rostedt (Red Hat) 			return (unsigned long)FTRACE_ADDR;
242279922b80SSteven Rostedt (Red Hat) 		}
242379922b80SSteven Rostedt (Red Hat) 		return ops->trampoline;
242479922b80SSteven Rostedt (Red Hat) 	}
242579922b80SSteven Rostedt (Red Hat) 
24267413af1fSSteven Rostedt (Red Hat) 	if (rec->flags & FTRACE_FL_REGS_EN)
24277413af1fSSteven Rostedt (Red Hat) 		return (unsigned long)FTRACE_REGS_ADDR;
24287413af1fSSteven Rostedt (Red Hat) 	else
24297413af1fSSteven Rostedt (Red Hat) 		return (unsigned long)FTRACE_ADDR;
24307413af1fSSteven Rostedt (Red Hat) }
24317413af1fSSteven Rostedt (Red Hat) 
2432c88fd863SSteven Rostedt static int
2433c88fd863SSteven Rostedt __ftrace_replace_code(struct dyn_ftrace *rec, int enable)
2434c88fd863SSteven Rostedt {
243508f6fba5SSteven Rostedt 	unsigned long ftrace_old_addr;
2436c88fd863SSteven Rostedt 	unsigned long ftrace_addr;
2437c88fd863SSteven Rostedt 	int ret;
2438c88fd863SSteven Rostedt 
24397c0868e0SSteven Rostedt (Red Hat) 	ftrace_addr = ftrace_get_addr_new(rec);
2440c88fd863SSteven Rostedt 
24417c0868e0SSteven Rostedt (Red Hat) 	/* This needs to be done before we call ftrace_update_record */
24427c0868e0SSteven Rostedt (Red Hat) 	ftrace_old_addr = ftrace_get_addr_curr(rec);
24437c0868e0SSteven Rostedt (Red Hat) 
24447c0868e0SSteven Rostedt (Red Hat) 	ret = ftrace_update_record(rec, enable);
244508f6fba5SSteven Rostedt 
244602a392a0SSteven Rostedt (Red Hat) 	ftrace_bug_type = FTRACE_BUG_UNKNOWN;
244702a392a0SSteven Rostedt (Red Hat) 
2448c88fd863SSteven Rostedt 	switch (ret) {
2449c88fd863SSteven Rostedt 	case FTRACE_UPDATE_IGNORE:
2450c88fd863SSteven Rostedt 		return 0;
2451c88fd863SSteven Rostedt 
2452c88fd863SSteven Rostedt 	case FTRACE_UPDATE_MAKE_CALL:
245302a392a0SSteven Rostedt (Red Hat) 		ftrace_bug_type = FTRACE_BUG_CALL;
2454c88fd863SSteven Rostedt 		return ftrace_make_call(rec, ftrace_addr);
2455c88fd863SSteven Rostedt 
2456c88fd863SSteven Rostedt 	case FTRACE_UPDATE_MAKE_NOP:
245702a392a0SSteven Rostedt (Red Hat) 		ftrace_bug_type = FTRACE_BUG_NOP;
245839b5552cSSteven Rostedt (Red Hat) 		return ftrace_make_nop(NULL, rec, ftrace_old_addr);
245908f6fba5SSteven Rostedt 
246008f6fba5SSteven Rostedt 	case FTRACE_UPDATE_MODIFY_CALL:
246102a392a0SSteven Rostedt (Red Hat) 		ftrace_bug_type = FTRACE_BUG_UPDATE;
246208f6fba5SSteven Rostedt 		return ftrace_modify_call(rec, ftrace_old_addr, ftrace_addr);
24633d083395SSteven Rostedt 	}
24643d083395SSteven Rostedt 
2465c88fd863SSteven Rostedt 	return -1; /* unknow ftrace bug */
2466c88fd863SSteven Rostedt }
2467c88fd863SSteven Rostedt 
2468e4f5d544SSteven Rostedt void __weak ftrace_replace_code(int enable)
24693d083395SSteven Rostedt {
24703d083395SSteven Rostedt 	struct dyn_ftrace *rec;
24713d083395SSteven Rostedt 	struct ftrace_page *pg;
24726a24a244SSteven Rostedt 	int failed;
24733d083395SSteven Rostedt 
247445a4a237SSteven Rostedt 	if (unlikely(ftrace_disabled))
247545a4a237SSteven Rostedt 		return;
247645a4a237SSteven Rostedt 
2477265c831cSSteven Rostedt 	do_for_each_ftrace_rec(pg, rec) {
2478546fece4SSteven Rostedt (Red Hat) 
2479546fece4SSteven Rostedt (Red Hat) 		if (rec->flags & FTRACE_FL_DISABLED)
2480546fece4SSteven Rostedt (Red Hat) 			continue;
2481546fece4SSteven Rostedt (Red Hat) 
2482e4f5d544SSteven Rostedt 		failed = __ftrace_replace_code(rec, enable);
2483fa9d13cfSZhaolei 		if (failed) {
24844fd3279bSSteven Rostedt (Red Hat) 			ftrace_bug(failed, rec);
24854377245aSSteven Rostedt 			/* Stop processing */
24864377245aSSteven Rostedt 			return;
24874377245aSSteven Rostedt 		}
2488265c831cSSteven Rostedt 	} while_for_each_ftrace_rec();
24893d083395SSteven Rostedt }
24903c1720f0SSteven Rostedt 
2491c88fd863SSteven Rostedt struct ftrace_rec_iter {
2492c88fd863SSteven Rostedt 	struct ftrace_page	*pg;
2493c88fd863SSteven Rostedt 	int			index;
2494c88fd863SSteven Rostedt };
2495c88fd863SSteven Rostedt 
2496c88fd863SSteven Rostedt /**
2497c88fd863SSteven Rostedt  * ftrace_rec_iter_start, start up iterating over traced functions
2498c88fd863SSteven Rostedt  *
2499c88fd863SSteven Rostedt  * Returns an iterator handle that is used to iterate over all
2500c88fd863SSteven Rostedt  * the records that represent address locations where functions
2501c88fd863SSteven Rostedt  * are traced.
2502c88fd863SSteven Rostedt  *
2503c88fd863SSteven Rostedt  * May return NULL if no records are available.
2504c88fd863SSteven Rostedt  */
2505c88fd863SSteven Rostedt struct ftrace_rec_iter *ftrace_rec_iter_start(void)
2506c88fd863SSteven Rostedt {
2507c88fd863SSteven Rostedt 	/*
2508c88fd863SSteven Rostedt 	 * We only use a single iterator.
2509c88fd863SSteven Rostedt 	 * Protected by the ftrace_lock mutex.
2510c88fd863SSteven Rostedt 	 */
2511c88fd863SSteven Rostedt 	static struct ftrace_rec_iter ftrace_rec_iter;
2512c88fd863SSteven Rostedt 	struct ftrace_rec_iter *iter = &ftrace_rec_iter;
2513c88fd863SSteven Rostedt 
2514c88fd863SSteven Rostedt 	iter->pg = ftrace_pages_start;
2515c88fd863SSteven Rostedt 	iter->index = 0;
2516c88fd863SSteven Rostedt 
2517c88fd863SSteven Rostedt 	/* Could have empty pages */
2518c88fd863SSteven Rostedt 	while (iter->pg && !iter->pg->index)
2519c88fd863SSteven Rostedt 		iter->pg = iter->pg->next;
2520c88fd863SSteven Rostedt 
2521c88fd863SSteven Rostedt 	if (!iter->pg)
2522c88fd863SSteven Rostedt 		return NULL;
2523c88fd863SSteven Rostedt 
2524c88fd863SSteven Rostedt 	return iter;
2525c88fd863SSteven Rostedt }
2526c88fd863SSteven Rostedt 
2527c88fd863SSteven Rostedt /**
2528c88fd863SSteven Rostedt  * ftrace_rec_iter_next, get the next record to process.
2529c88fd863SSteven Rostedt  * @iter: The handle to the iterator.
2530c88fd863SSteven Rostedt  *
2531c88fd863SSteven Rostedt  * Returns the next iterator after the given iterator @iter.
2532c88fd863SSteven Rostedt  */
2533c88fd863SSteven Rostedt struct ftrace_rec_iter *ftrace_rec_iter_next(struct ftrace_rec_iter *iter)
2534c88fd863SSteven Rostedt {
2535c88fd863SSteven Rostedt 	iter->index++;
2536c88fd863SSteven Rostedt 
2537c88fd863SSteven Rostedt 	if (iter->index >= iter->pg->index) {
2538c88fd863SSteven Rostedt 		iter->pg = iter->pg->next;
2539c88fd863SSteven Rostedt 		iter->index = 0;
2540c88fd863SSteven Rostedt 
2541c88fd863SSteven Rostedt 		/* Could have empty pages */
2542c88fd863SSteven Rostedt 		while (iter->pg && !iter->pg->index)
2543c88fd863SSteven Rostedt 			iter->pg = iter->pg->next;
2544c88fd863SSteven Rostedt 	}
2545c88fd863SSteven Rostedt 
2546c88fd863SSteven Rostedt 	if (!iter->pg)
2547c88fd863SSteven Rostedt 		return NULL;
2548c88fd863SSteven Rostedt 
2549c88fd863SSteven Rostedt 	return iter;
2550c88fd863SSteven Rostedt }
2551c88fd863SSteven Rostedt 
2552c88fd863SSteven Rostedt /**
2553c88fd863SSteven Rostedt  * ftrace_rec_iter_record, get the record at the iterator location
2554c88fd863SSteven Rostedt  * @iter: The current iterator location
2555c88fd863SSteven Rostedt  *
2556c88fd863SSteven Rostedt  * Returns the record that the current @iter is at.
2557c88fd863SSteven Rostedt  */
2558c88fd863SSteven Rostedt struct dyn_ftrace *ftrace_rec_iter_record(struct ftrace_rec_iter *iter)
2559c88fd863SSteven Rostedt {
2560c88fd863SSteven Rostedt 	return &iter->pg->records[iter->index];
2561c88fd863SSteven Rostedt }
2562c88fd863SSteven Rostedt 
25633b47bfc1SSteven Rostedt static int
256431e88909SSteven Rostedt ftrace_code_disable(struct module *mod, struct dyn_ftrace *rec)
25653c1720f0SSteven Rostedt {
2566492a7ea5SAbhishek Sagar 	int ret;
256737ad5084SSteven Rostedt 
256845a4a237SSteven Rostedt 	if (unlikely(ftrace_disabled))
256945a4a237SSteven Rostedt 		return 0;
257045a4a237SSteven Rostedt 
257125aac9dcSShaohua Li 	ret = ftrace_make_nop(mod, rec, MCOUNT_ADDR);
25723d083395SSteven Rostedt 	if (ret) {
257302a392a0SSteven Rostedt (Red Hat) 		ftrace_bug_type = FTRACE_BUG_INIT;
25744fd3279bSSteven Rostedt (Red Hat) 		ftrace_bug(ret, rec);
25753d083395SSteven Rostedt 		return 0;
2576d61f82d0SSteven Rostedt 	}
2577d61f82d0SSteven Rostedt 	return 1;
25783d083395SSteven Rostedt }
25793d083395SSteven Rostedt 
2580000ab691SSteven Rostedt /*
2581000ab691SSteven Rostedt  * archs can override this function if they must do something
2582000ab691SSteven Rostedt  * before the modifying code is performed.
2583000ab691SSteven Rostedt  */
2584000ab691SSteven Rostedt int __weak ftrace_arch_code_modify_prepare(void)
2585000ab691SSteven Rostedt {
2586000ab691SSteven Rostedt 	return 0;
2587000ab691SSteven Rostedt }
2588000ab691SSteven Rostedt 
2589000ab691SSteven Rostedt /*
2590000ab691SSteven Rostedt  * archs can override this function if they must do something
2591000ab691SSteven Rostedt  * after the modifying code is performed.
2592000ab691SSteven Rostedt  */
2593000ab691SSteven Rostedt int __weak ftrace_arch_code_modify_post_process(void)
2594000ab691SSteven Rostedt {
2595000ab691SSteven Rostedt 	return 0;
2596000ab691SSteven Rostedt }
2597000ab691SSteven Rostedt 
25988ed3e2cfSSteven Rostedt void ftrace_modify_all_code(int command)
25998ed3e2cfSSteven Rostedt {
260059338f75SSteven Rostedt (Red Hat) 	int update = command & FTRACE_UPDATE_TRACE_FUNC;
2601cd21067fSPetr Mladek 	int err = 0;
260259338f75SSteven Rostedt (Red Hat) 
260359338f75SSteven Rostedt (Red Hat) 	/*
260459338f75SSteven Rostedt (Red Hat) 	 * If the ftrace_caller calls a ftrace_ops func directly,
260559338f75SSteven Rostedt (Red Hat) 	 * we need to make sure that it only traces functions it
260659338f75SSteven Rostedt (Red Hat) 	 * expects to trace. When doing the switch of functions,
260759338f75SSteven Rostedt (Red Hat) 	 * we need to update to the ftrace_ops_list_func first
260859338f75SSteven Rostedt (Red Hat) 	 * before the transition between old and new calls are set,
260959338f75SSteven Rostedt (Red Hat) 	 * as the ftrace_ops_list_func will check the ops hashes
261059338f75SSteven Rostedt (Red Hat) 	 * to make sure the ops are having the right functions
261159338f75SSteven Rostedt (Red Hat) 	 * traced.
261259338f75SSteven Rostedt (Red Hat) 	 */
2613cd21067fSPetr Mladek 	if (update) {
2614cd21067fSPetr Mladek 		err = ftrace_update_ftrace_func(ftrace_ops_list_func);
2615cd21067fSPetr Mladek 		if (FTRACE_WARN_ON(err))
2616cd21067fSPetr Mladek 			return;
2617cd21067fSPetr Mladek 	}
261859338f75SSteven Rostedt (Red Hat) 
26198ed3e2cfSSteven Rostedt 	if (command & FTRACE_UPDATE_CALLS)
26208ed3e2cfSSteven Rostedt 		ftrace_replace_code(1);
26218ed3e2cfSSteven Rostedt 	else if (command & FTRACE_DISABLE_CALLS)
26228ed3e2cfSSteven Rostedt 		ftrace_replace_code(0);
26238ed3e2cfSSteven Rostedt 
2624405e1d83SSteven Rostedt (Red Hat) 	if (update && ftrace_trace_function != ftrace_ops_list_func) {
2625405e1d83SSteven Rostedt (Red Hat) 		function_trace_op = set_function_trace_op;
2626405e1d83SSteven Rostedt (Red Hat) 		smp_wmb();
2627405e1d83SSteven Rostedt (Red Hat) 		/* If irqs are disabled, we are in stop machine */
2628405e1d83SSteven Rostedt (Red Hat) 		if (!irqs_disabled())
2629405e1d83SSteven Rostedt (Red Hat) 			smp_call_function(ftrace_sync_ipi, NULL, 1);
2630cd21067fSPetr Mladek 		err = ftrace_update_ftrace_func(ftrace_trace_function);
2631cd21067fSPetr Mladek 		if (FTRACE_WARN_ON(err))
2632cd21067fSPetr Mladek 			return;
2633405e1d83SSteven Rostedt (Red Hat) 	}
26348ed3e2cfSSteven Rostedt 
26358ed3e2cfSSteven Rostedt 	if (command & FTRACE_START_FUNC_RET)
2636cd21067fSPetr Mladek 		err = ftrace_enable_ftrace_graph_caller();
26378ed3e2cfSSteven Rostedt 	else if (command & FTRACE_STOP_FUNC_RET)
2638cd21067fSPetr Mladek 		err = ftrace_disable_ftrace_graph_caller();
2639cd21067fSPetr Mladek 	FTRACE_WARN_ON(err);
26408ed3e2cfSSteven Rostedt }
26418ed3e2cfSSteven Rostedt 
26423d083395SSteven Rostedt static int __ftrace_modify_code(void *data)
26433d083395SSteven Rostedt {
26443d083395SSteven Rostedt 	int *command = data;
26453d083395SSteven Rostedt 
26468ed3e2cfSSteven Rostedt 	ftrace_modify_all_code(*command);
26475a45cfe1SSteven Rostedt 
2648c88fd863SSteven Rostedt 	return 0;
2649c88fd863SSteven Rostedt }
2650c88fd863SSteven Rostedt 
2651c88fd863SSteven Rostedt /**
2652c88fd863SSteven Rostedt  * ftrace_run_stop_machine, go back to the stop machine method
2653c88fd863SSteven Rostedt  * @command: The command to tell ftrace what to do
2654c88fd863SSteven Rostedt  *
2655c88fd863SSteven Rostedt  * If an arch needs to fall back to the stop machine method, the
2656c88fd863SSteven Rostedt  * it can call this function.
2657c88fd863SSteven Rostedt  */
2658c88fd863SSteven Rostedt void ftrace_run_stop_machine(int command)
2659c88fd863SSteven Rostedt {
2660c88fd863SSteven Rostedt 	stop_machine(__ftrace_modify_code, &command, NULL);
2661c88fd863SSteven Rostedt }
2662c88fd863SSteven Rostedt 
2663c88fd863SSteven Rostedt /**
2664c88fd863SSteven Rostedt  * arch_ftrace_update_code, modify the code to trace or not trace
2665c88fd863SSteven Rostedt  * @command: The command that needs to be done
2666c88fd863SSteven Rostedt  *
2667c88fd863SSteven Rostedt  * Archs can override this function if it does not need to
2668c88fd863SSteven Rostedt  * run stop_machine() to modify code.
2669c88fd863SSteven Rostedt  */
2670c88fd863SSteven Rostedt void __weak arch_ftrace_update_code(int command)
2671c88fd863SSteven Rostedt {
2672c88fd863SSteven Rostedt 	ftrace_run_stop_machine(command);
2673c88fd863SSteven Rostedt }
2674c88fd863SSteven Rostedt 
2675c88fd863SSteven Rostedt static void ftrace_run_update_code(int command)
2676c88fd863SSteven Rostedt {
2677c88fd863SSteven Rostedt 	int ret;
2678c88fd863SSteven Rostedt 
2679c88fd863SSteven Rostedt 	ret = ftrace_arch_code_modify_prepare();
2680c88fd863SSteven Rostedt 	FTRACE_WARN_ON(ret);
2681c88fd863SSteven Rostedt 	if (ret)
2682c88fd863SSteven Rostedt 		return;
2683c88fd863SSteven Rostedt 
2684c88fd863SSteven Rostedt 	/*
2685c88fd863SSteven Rostedt 	 * By default we use stop_machine() to modify the code.
2686c88fd863SSteven Rostedt 	 * But archs can do what ever they want as long as it
2687c88fd863SSteven Rostedt 	 * is safe. The stop_machine() is the safest, but also
2688c88fd863SSteven Rostedt 	 * produces the most overhead.
2689c88fd863SSteven Rostedt 	 */
2690c88fd863SSteven Rostedt 	arch_ftrace_update_code(command);
2691c88fd863SSteven Rostedt 
2692000ab691SSteven Rostedt 	ret = ftrace_arch_code_modify_post_process();
2693000ab691SSteven Rostedt 	FTRACE_WARN_ON(ret);
26943d083395SSteven Rostedt }
26953d083395SSteven Rostedt 
26968252ecf3SSteven Rostedt (Red Hat) static void ftrace_run_modify_code(struct ftrace_ops *ops, int command,
26977485058eSSteven Rostedt (Red Hat) 				   struct ftrace_ops_hash *old_hash)
2698e1effa01SSteven Rostedt (Red Hat) {
2699e1effa01SSteven Rostedt (Red Hat) 	ops->flags |= FTRACE_OPS_FL_MODIFYING;
27007485058eSSteven Rostedt (Red Hat) 	ops->old_hash.filter_hash = old_hash->filter_hash;
27017485058eSSteven Rostedt (Red Hat) 	ops->old_hash.notrace_hash = old_hash->notrace_hash;
2702e1effa01SSteven Rostedt (Red Hat) 	ftrace_run_update_code(command);
27038252ecf3SSteven Rostedt (Red Hat) 	ops->old_hash.filter_hash = NULL;
27047485058eSSteven Rostedt (Red Hat) 	ops->old_hash.notrace_hash = NULL;
2705e1effa01SSteven Rostedt (Red Hat) 	ops->flags &= ~FTRACE_OPS_FL_MODIFYING;
2706e1effa01SSteven Rostedt (Red Hat) }
2707e1effa01SSteven Rostedt (Red Hat) 
27083d083395SSteven Rostedt static ftrace_func_t saved_ftrace_func;
270960a7ecf4SSteven Rostedt static int ftrace_start_up;
2710df4fc315SSteven Rostedt 
271112cce594SSteven Rostedt (Red Hat) void __weak arch_ftrace_trampoline_free(struct ftrace_ops *ops)
271212cce594SSteven Rostedt (Red Hat) {
271312cce594SSteven Rostedt (Red Hat) }
271412cce594SSteven Rostedt (Red Hat) 
2715ba27f2bcSSteven Rostedt (Red Hat) static void per_cpu_ops_free(struct ftrace_ops *ops)
2716db0fbadcSJiri Slaby {
2717db0fbadcSJiri Slaby 	free_percpu(ops->disabled);
2718db0fbadcSJiri Slaby }
2719db0fbadcSJiri Slaby 
2720df4fc315SSteven Rostedt static void ftrace_startup_enable(int command)
2721df4fc315SSteven Rostedt {
2722df4fc315SSteven Rostedt 	if (saved_ftrace_func != ftrace_trace_function) {
2723df4fc315SSteven Rostedt 		saved_ftrace_func = ftrace_trace_function;
2724df4fc315SSteven Rostedt 		command |= FTRACE_UPDATE_TRACE_FUNC;
2725df4fc315SSteven Rostedt 	}
2726df4fc315SSteven Rostedt 
2727df4fc315SSteven Rostedt 	if (!command || !ftrace_enabled)
2728df4fc315SSteven Rostedt 		return;
2729df4fc315SSteven Rostedt 
2730df4fc315SSteven Rostedt 	ftrace_run_update_code(command);
2731df4fc315SSteven Rostedt }
27323d083395SSteven Rostedt 
2733e1effa01SSteven Rostedt (Red Hat) static void ftrace_startup_all(int command)
2734e1effa01SSteven Rostedt (Red Hat) {
2735e1effa01SSteven Rostedt (Red Hat) 	update_all_ops = true;
2736e1effa01SSteven Rostedt (Red Hat) 	ftrace_startup_enable(command);
2737e1effa01SSteven Rostedt (Red Hat) 	update_all_ops = false;
2738e1effa01SSteven Rostedt (Red Hat) }
2739e1effa01SSteven Rostedt (Red Hat) 
2740a1cd6173SSteven Rostedt static int ftrace_startup(struct ftrace_ops *ops, int command)
27413d083395SSteven Rostedt {
27428a56d776SSteven Rostedt (Red Hat) 	int ret;
2743b848914cSSteven Rostedt 
27444eebcc81SSteven Rostedt 	if (unlikely(ftrace_disabled))
2745a1cd6173SSteven Rostedt 		return -ENODEV;
27464eebcc81SSteven Rostedt 
27478a56d776SSteven Rostedt (Red Hat) 	ret = __register_ftrace_function(ops);
27488a56d776SSteven Rostedt (Red Hat) 	if (ret)
27498a56d776SSteven Rostedt (Red Hat) 		return ret;
27508a56d776SSteven Rostedt (Red Hat) 
275160a7ecf4SSteven Rostedt 	ftrace_start_up++;
27523d083395SSteven Rostedt 
2753e1effa01SSteven Rostedt (Red Hat) 	/*
2754e1effa01SSteven Rostedt (Red Hat) 	 * Note that ftrace probes uses this to start up
2755e1effa01SSteven Rostedt (Red Hat) 	 * and modify functions it will probe. But we still
2756e1effa01SSteven Rostedt (Red Hat) 	 * set the ADDING flag for modification, as probes
2757e1effa01SSteven Rostedt (Red Hat) 	 * do not have trampolines. If they add them in the
2758e1effa01SSteven Rostedt (Red Hat) 	 * future, then the probes will need to distinguish
2759e1effa01SSteven Rostedt (Red Hat) 	 * between adding and updating probes.
2760e1effa01SSteven Rostedt (Red Hat) 	 */
2761e1effa01SSteven Rostedt (Red Hat) 	ops->flags |= FTRACE_OPS_FL_ENABLED | FTRACE_OPS_FL_ADDING;
276266209a5bSSteven Rostedt (Red Hat) 
2763f8b8be8aSMasami Hiramatsu 	ret = ftrace_hash_ipmodify_enable(ops);
2764f8b8be8aSMasami Hiramatsu 	if (ret < 0) {
2765f8b8be8aSMasami Hiramatsu 		/* Rollback registration process */
2766f8b8be8aSMasami Hiramatsu 		__unregister_ftrace_function(ops);
2767f8b8be8aSMasami Hiramatsu 		ftrace_start_up--;
2768f8b8be8aSMasami Hiramatsu 		ops->flags &= ~FTRACE_OPS_FL_ENABLED;
2769f8b8be8aSMasami Hiramatsu 		return ret;
2770f8b8be8aSMasami Hiramatsu 	}
2771f8b8be8aSMasami Hiramatsu 
27727f50d06bSJiri Olsa 	if (ftrace_hash_rec_enable(ops, 1))
27737f50d06bSJiri Olsa 		command |= FTRACE_UPDATE_CALLS;
2774ed926f9bSSteven Rostedt 
2775df4fc315SSteven Rostedt 	ftrace_startup_enable(command);
2776a1cd6173SSteven Rostedt 
2777e1effa01SSteven Rostedt (Red Hat) 	ops->flags &= ~FTRACE_OPS_FL_ADDING;
2778e1effa01SSteven Rostedt (Red Hat) 
2779a1cd6173SSteven Rostedt 	return 0;
27803d083395SSteven Rostedt }
27813d083395SSteven Rostedt 
27828a56d776SSteven Rostedt (Red Hat) static int ftrace_shutdown(struct ftrace_ops *ops, int command)
27833d083395SSteven Rostedt {
27848a56d776SSteven Rostedt (Red Hat) 	int ret;
2785b848914cSSteven Rostedt 
27864eebcc81SSteven Rostedt 	if (unlikely(ftrace_disabled))
27878a56d776SSteven Rostedt (Red Hat) 		return -ENODEV;
27888a56d776SSteven Rostedt (Red Hat) 
27898a56d776SSteven Rostedt (Red Hat) 	ret = __unregister_ftrace_function(ops);
27908a56d776SSteven Rostedt (Red Hat) 	if (ret)
27918a56d776SSteven Rostedt (Red Hat) 		return ret;
27924eebcc81SSteven Rostedt 
279360a7ecf4SSteven Rostedt 	ftrace_start_up--;
27949ea1a153SFrederic Weisbecker 	/*
27959ea1a153SFrederic Weisbecker 	 * Just warn in case of unbalance, no need to kill ftrace, it's not
27969ea1a153SFrederic Weisbecker 	 * critical but the ftrace_call callers may be never nopped again after
27979ea1a153SFrederic Weisbecker 	 * further ftrace uses.
27989ea1a153SFrederic Weisbecker 	 */
27999ea1a153SFrederic Weisbecker 	WARN_ON_ONCE(ftrace_start_up < 0);
28009ea1a153SFrederic Weisbecker 
2801f8b8be8aSMasami Hiramatsu 	/* Disabling ipmodify never fails */
2802f8b8be8aSMasami Hiramatsu 	ftrace_hash_ipmodify_disable(ops);
28037f50d06bSJiri Olsa 
28047f50d06bSJiri Olsa 	if (ftrace_hash_rec_disable(ops, 1))
28057f50d06bSJiri Olsa 		command |= FTRACE_UPDATE_CALLS;
2806ed926f9bSSteven Rostedt 
2807ed926f9bSSteven Rostedt 	ops->flags &= ~FTRACE_OPS_FL_ENABLED;
2808b848914cSSteven Rostedt 
2809d61f82d0SSteven Rostedt 	if (saved_ftrace_func != ftrace_trace_function) {
2810d61f82d0SSteven Rostedt 		saved_ftrace_func = ftrace_trace_function;
2811d61f82d0SSteven Rostedt 		command |= FTRACE_UPDATE_TRACE_FUNC;
2812d61f82d0SSteven Rostedt 	}
2813d61f82d0SSteven Rostedt 
2814a4c35ed2SSteven Rostedt (Red Hat) 	if (!command || !ftrace_enabled) {
2815a4c35ed2SSteven Rostedt (Red Hat) 		/*
2816ba27f2bcSSteven Rostedt (Red Hat) 		 * If these are per_cpu ops, they still need their
2817a4c35ed2SSteven Rostedt (Red Hat) 		 * per_cpu field freed. Since, function tracing is
2818a4c35ed2SSteven Rostedt (Red Hat) 		 * not currently active, we can just free them
2819a4c35ed2SSteven Rostedt (Red Hat) 		 * without synchronizing all CPUs.
2820a4c35ed2SSteven Rostedt (Red Hat) 		 */
2821ba27f2bcSSteven Rostedt (Red Hat) 		if (ops->flags & FTRACE_OPS_FL_PER_CPU)
2822ba27f2bcSSteven Rostedt (Red Hat) 			per_cpu_ops_free(ops);
28238a56d776SSteven Rostedt (Red Hat) 		return 0;
2824a4c35ed2SSteven Rostedt (Red Hat) 	}
28253d083395SSteven Rostedt 
282679922b80SSteven Rostedt (Red Hat) 	/*
282779922b80SSteven Rostedt (Red Hat) 	 * If the ops uses a trampoline, then it needs to be
282879922b80SSteven Rostedt (Red Hat) 	 * tested first on update.
282979922b80SSteven Rostedt (Red Hat) 	 */
2830e1effa01SSteven Rostedt (Red Hat) 	ops->flags |= FTRACE_OPS_FL_REMOVING;
283179922b80SSteven Rostedt (Red Hat) 	removed_ops = ops;
283279922b80SSteven Rostedt (Red Hat) 
2833fef5aeeeSSteven Rostedt (Red Hat) 	/* The trampoline logic checks the old hashes */
2834fef5aeeeSSteven Rostedt (Red Hat) 	ops->old_hash.filter_hash = ops->func_hash->filter_hash;
2835fef5aeeeSSteven Rostedt (Red Hat) 	ops->old_hash.notrace_hash = ops->func_hash->notrace_hash;
2836fef5aeeeSSteven Rostedt (Red Hat) 
2837d61f82d0SSteven Rostedt 	ftrace_run_update_code(command);
2838a4c35ed2SSteven Rostedt (Red Hat) 
283984bde62cSSteven Rostedt (Red Hat) 	/*
284084bde62cSSteven Rostedt (Red Hat) 	 * If there's no more ops registered with ftrace, run a
284184bde62cSSteven Rostedt (Red Hat) 	 * sanity check to make sure all rec flags are cleared.
284284bde62cSSteven Rostedt (Red Hat) 	 */
284384bde62cSSteven Rostedt (Red Hat) 	if (ftrace_ops_list == &ftrace_list_end) {
284484bde62cSSteven Rostedt (Red Hat) 		struct ftrace_page *pg;
284584bde62cSSteven Rostedt (Red Hat) 		struct dyn_ftrace *rec;
284684bde62cSSteven Rostedt (Red Hat) 
284784bde62cSSteven Rostedt (Red Hat) 		do_for_each_ftrace_rec(pg, rec) {
2848977c1f9cSAlexei Starovoitov 			if (FTRACE_WARN_ON_ONCE(rec->flags & ~FTRACE_FL_DISABLED))
284984bde62cSSteven Rostedt (Red Hat) 				pr_warn("  %pS flags:%lx\n",
285084bde62cSSteven Rostedt (Red Hat) 					(void *)rec->ip, rec->flags);
285184bde62cSSteven Rostedt (Red Hat) 		} while_for_each_ftrace_rec();
285284bde62cSSteven Rostedt (Red Hat) 	}
285384bde62cSSteven Rostedt (Red Hat) 
2854fef5aeeeSSteven Rostedt (Red Hat) 	ops->old_hash.filter_hash = NULL;
2855fef5aeeeSSteven Rostedt (Red Hat) 	ops->old_hash.notrace_hash = NULL;
2856fef5aeeeSSteven Rostedt (Red Hat) 
2857fef5aeeeSSteven Rostedt (Red Hat) 	removed_ops = NULL;
2858e1effa01SSteven Rostedt (Red Hat) 	ops->flags &= ~FTRACE_OPS_FL_REMOVING;
285979922b80SSteven Rostedt (Red Hat) 
2860a4c35ed2SSteven Rostedt (Red Hat) 	/*
2861a4c35ed2SSteven Rostedt (Red Hat) 	 * Dynamic ops may be freed, we must make sure that all
2862a4c35ed2SSteven Rostedt (Red Hat) 	 * callers are done before leaving this function.
2863ba27f2bcSSteven Rostedt (Red Hat) 	 * The same goes for freeing the per_cpu data of the per_cpu
2864a4c35ed2SSteven Rostedt (Red Hat) 	 * ops.
28650598e4f0SSteven Rostedt (VMware) 	 */
28660598e4f0SSteven Rostedt (VMware) 	if (ops->flags & (FTRACE_OPS_FL_DYNAMIC | FTRACE_OPS_FL_PER_CPU)) {
28670598e4f0SSteven Rostedt (VMware) 		/*
2868a4c35ed2SSteven Rostedt (Red Hat) 		 * We need to do a hard force of sched synchronization.
2869a4c35ed2SSteven Rostedt (Red Hat) 		 * This is because we use preempt_disable() to do RCU, but
2870a4c35ed2SSteven Rostedt (Red Hat) 		 * the function tracers can be called where RCU is not watching
2871a4c35ed2SSteven Rostedt (Red Hat) 		 * (like before user_exit()). We can not rely on the RCU
2872a4c35ed2SSteven Rostedt (Red Hat) 		 * infrastructure to do the synchronization, thus we must do it
2873a4c35ed2SSteven Rostedt (Red Hat) 		 * ourselves.
2874a4c35ed2SSteven Rostedt (Red Hat) 		 */
2875a4c35ed2SSteven Rostedt (Red Hat) 		schedule_on_each_cpu(ftrace_sync);
2876a4c35ed2SSteven Rostedt (Red Hat) 
28770598e4f0SSteven Rostedt (VMware) 		/*
28780598e4f0SSteven Rostedt (VMware) 		 * When the kernel is preeptive, tasks can be preempted
28790598e4f0SSteven Rostedt (VMware) 		 * while on a ftrace trampoline. Just scheduling a task on
28800598e4f0SSteven Rostedt (VMware) 		 * a CPU is not good enough to flush them. Calling
28810598e4f0SSteven Rostedt (VMware) 		 * synchornize_rcu_tasks() will wait for those tasks to
28820598e4f0SSteven Rostedt (VMware) 		 * execute and either schedule voluntarily or enter user space.
28830598e4f0SSteven Rostedt (VMware) 		 */
28840598e4f0SSteven Rostedt (VMware) 		if (IS_ENABLED(CONFIG_PREEMPT))
28850598e4f0SSteven Rostedt (VMware) 			synchronize_rcu_tasks();
28860598e4f0SSteven Rostedt (VMware) 
288712cce594SSteven Rostedt (Red Hat) 		arch_ftrace_trampoline_free(ops);
288812cce594SSteven Rostedt (Red Hat) 
2889ba27f2bcSSteven Rostedt (Red Hat) 		if (ops->flags & FTRACE_OPS_FL_PER_CPU)
2890ba27f2bcSSteven Rostedt (Red Hat) 			per_cpu_ops_free(ops);
2891a4c35ed2SSteven Rostedt (Red Hat) 	}
2892a4c35ed2SSteven Rostedt (Red Hat) 
28938a56d776SSteven Rostedt (Red Hat) 	return 0;
28943d083395SSteven Rostedt }
28953d083395SSteven Rostedt 
2896e309b41dSIngo Molnar static void ftrace_startup_sysctl(void)
2897b0fc494fSSteven Rostedt {
28981619dc3fSPratyush Anand 	int command;
28991619dc3fSPratyush Anand 
29004eebcc81SSteven Rostedt 	if (unlikely(ftrace_disabled))
29014eebcc81SSteven Rostedt 		return;
29024eebcc81SSteven Rostedt 
2903d61f82d0SSteven Rostedt 	/* Force update next time */
2904d61f82d0SSteven Rostedt 	saved_ftrace_func = NULL;
290560a7ecf4SSteven Rostedt 	/* ftrace_start_up is true if we want ftrace running */
29061619dc3fSPratyush Anand 	if (ftrace_start_up) {
29071619dc3fSPratyush Anand 		command = FTRACE_UPDATE_CALLS;
29081619dc3fSPratyush Anand 		if (ftrace_graph_active)
29091619dc3fSPratyush Anand 			command |= FTRACE_START_FUNC_RET;
2910524a3868SSteven Rostedt (Red Hat) 		ftrace_startup_enable(command);
29111619dc3fSPratyush Anand 	}
2912b0fc494fSSteven Rostedt }
2913b0fc494fSSteven Rostedt 
2914e309b41dSIngo Molnar static void ftrace_shutdown_sysctl(void)
2915b0fc494fSSteven Rostedt {
29161619dc3fSPratyush Anand 	int command;
29171619dc3fSPratyush Anand 
29184eebcc81SSteven Rostedt 	if (unlikely(ftrace_disabled))
29194eebcc81SSteven Rostedt 		return;
29204eebcc81SSteven Rostedt 
292160a7ecf4SSteven Rostedt 	/* ftrace_start_up is true if ftrace is running */
29221619dc3fSPratyush Anand 	if (ftrace_start_up) {
29231619dc3fSPratyush Anand 		command = FTRACE_DISABLE_CALLS;
29241619dc3fSPratyush Anand 		if (ftrace_graph_active)
29251619dc3fSPratyush Anand 			command |= FTRACE_STOP_FUNC_RET;
29261619dc3fSPratyush Anand 		ftrace_run_update_code(command);
29271619dc3fSPratyush Anand 	}
2928b0fc494fSSteven Rostedt }
2929b0fc494fSSteven Rostedt 
2930a5a1d1c2SThomas Gleixner static u64		ftrace_update_time;
29313d083395SSteven Rostedt unsigned long		ftrace_update_tot_cnt;
29323d083395SSteven Rostedt 
29338c4f3c3fSSteven Rostedt (Red Hat) static inline int ops_traces_mod(struct ftrace_ops *ops)
2934f7bc8b61SSteven Rostedt {
29358c4f3c3fSSteven Rostedt (Red Hat) 	/*
29368c4f3c3fSSteven Rostedt (Red Hat) 	 * Filter_hash being empty will default to trace module.
29378c4f3c3fSSteven Rostedt (Red Hat) 	 * But notrace hash requires a test of individual module functions.
29388c4f3c3fSSteven Rostedt (Red Hat) 	 */
293933b7f99cSSteven Rostedt (Red Hat) 	return ftrace_hash_empty(ops->func_hash->filter_hash) &&
294033b7f99cSSteven Rostedt (Red Hat) 		ftrace_hash_empty(ops->func_hash->notrace_hash);
29418c4f3c3fSSteven Rostedt (Red Hat) }
2942f7bc8b61SSteven Rostedt 
29438c4f3c3fSSteven Rostedt (Red Hat) /*
29448c4f3c3fSSteven Rostedt (Red Hat)  * Check if the current ops references the record.
29458c4f3c3fSSteven Rostedt (Red Hat)  *
29468c4f3c3fSSteven Rostedt (Red Hat)  * If the ops traces all functions, then it was already accounted for.
29478c4f3c3fSSteven Rostedt (Red Hat)  * If the ops does not trace the current record function, skip it.
29488c4f3c3fSSteven Rostedt (Red Hat)  * If the ops ignores the function via notrace filter, skip it.
29498c4f3c3fSSteven Rostedt (Red Hat)  */
29508c4f3c3fSSteven Rostedt (Red Hat) static inline bool
29518c4f3c3fSSteven Rostedt (Red Hat) ops_references_rec(struct ftrace_ops *ops, struct dyn_ftrace *rec)
29528c4f3c3fSSteven Rostedt (Red Hat) {
29538c4f3c3fSSteven Rostedt (Red Hat) 	/* If ops isn't enabled, ignore it */
29548c4f3c3fSSteven Rostedt (Red Hat) 	if (!(ops->flags & FTRACE_OPS_FL_ENABLED))
29558c4f3c3fSSteven Rostedt (Red Hat) 		return 0;
29568c4f3c3fSSteven Rostedt (Red Hat) 
2957b7ffffbbSSteven Rostedt (Red Hat) 	/* If ops traces all then it includes this function */
29588c4f3c3fSSteven Rostedt (Red Hat) 	if (ops_traces_mod(ops))
2959b7ffffbbSSteven Rostedt (Red Hat) 		return 1;
29608c4f3c3fSSteven Rostedt (Red Hat) 
29618c4f3c3fSSteven Rostedt (Red Hat) 	/* The function must be in the filter */
296233b7f99cSSteven Rostedt (Red Hat) 	if (!ftrace_hash_empty(ops->func_hash->filter_hash) &&
29632b2c279cSSteven Rostedt (VMware) 	    !__ftrace_lookup_ip(ops->func_hash->filter_hash, rec->ip))
29648c4f3c3fSSteven Rostedt (Red Hat) 		return 0;
29658c4f3c3fSSteven Rostedt (Red Hat) 
29668c4f3c3fSSteven Rostedt (Red Hat) 	/* If in notrace hash, we ignore it too */
296733b7f99cSSteven Rostedt (Red Hat) 	if (ftrace_lookup_ip(ops->func_hash->notrace_hash, rec->ip))
29688c4f3c3fSSteven Rostedt (Red Hat) 		return 0;
29698c4f3c3fSSteven Rostedt (Red Hat) 
29708c4f3c3fSSteven Rostedt (Red Hat) 	return 1;
29718c4f3c3fSSteven Rostedt (Red Hat) }
29728c4f3c3fSSteven Rostedt (Red Hat) 
29731dc43cf0SJiri Slaby static int ftrace_update_code(struct module *mod, struct ftrace_page *new_pgs)
29743d083395SSteven Rostedt {
297585ae32aeSSteven Rostedt 	struct ftrace_page *pg;
2976e94142a6SLai Jiangshan 	struct dyn_ftrace *p;
2977a5a1d1c2SThomas Gleixner 	u64 start, stop;
29781dc43cf0SJiri Slaby 	unsigned long update_cnt = 0;
2979b7ffffbbSSteven Rostedt (Red Hat) 	unsigned long rec_flags = 0;
298085ae32aeSSteven Rostedt 	int i;
2981f7bc8b61SSteven Rostedt 
2982750ed1a4SIngo Molnar 	start = ftrace_now(raw_smp_processor_id());
29833d083395SSteven Rostedt 
2984b7ffffbbSSteven Rostedt (Red Hat) 	/*
2985b7ffffbbSSteven Rostedt (Red Hat) 	 * When a module is loaded, this function is called to convert
2986b7ffffbbSSteven Rostedt (Red Hat) 	 * the calls to mcount in its text to nops, and also to create
2987b7ffffbbSSteven Rostedt (Red Hat) 	 * an entry in the ftrace data. Now, if ftrace is activated
2988b7ffffbbSSteven Rostedt (Red Hat) 	 * after this call, but before the module sets its text to
2989b7ffffbbSSteven Rostedt (Red Hat) 	 * read-only, the modification of enabling ftrace can fail if
2990b7ffffbbSSteven Rostedt (Red Hat) 	 * the read-only is done while ftrace is converting the calls.
2991b7ffffbbSSteven Rostedt (Red Hat) 	 * To prevent this, the module's records are set as disabled
2992b7ffffbbSSteven Rostedt (Red Hat) 	 * and will be enabled after the call to set the module's text
2993b7ffffbbSSteven Rostedt (Red Hat) 	 * to read-only.
2994b7ffffbbSSteven Rostedt (Red Hat) 	 */
2995b7ffffbbSSteven Rostedt (Red Hat) 	if (mod)
2996b7ffffbbSSteven Rostedt (Red Hat) 		rec_flags |= FTRACE_FL_DISABLED;
2997b7ffffbbSSteven Rostedt (Red Hat) 
29981dc43cf0SJiri Slaby 	for (pg = new_pgs; pg; pg = pg->next) {
2999f22f9a89SAbhishek Sagar 
300085ae32aeSSteven Rostedt 		for (i = 0; i < pg->index; i++) {
30018c4f3c3fSSteven Rostedt (Red Hat) 
300208f5ac90SSteven Rostedt 			/* If something went wrong, bail without enabling anything */
300308f5ac90SSteven Rostedt 			if (unlikely(ftrace_disabled))
300408f5ac90SSteven Rostedt 				return -1;
30053d083395SSteven Rostedt 
300685ae32aeSSteven Rostedt 			p = &pg->records[i];
3007b7ffffbbSSteven Rostedt (Red Hat) 			p->flags = rec_flags;
3008f22f9a89SAbhishek Sagar 
30095cb084bbSJiri Olsa 			/*
301025985edcSLucas De Marchi 			 * Do the initial record conversion from mcount jump
30115cb084bbSJiri Olsa 			 * to the NOP instructions.
30125cb084bbSJiri Olsa 			 */
301332082309SSteven Rostedt 			if (!ftrace_code_disable(mod, p))
3014d2c8c3eaSSteven Rostedt 				break;
30155cb084bbSJiri Olsa 
30161dc43cf0SJiri Slaby 			update_cnt++;
30175cb084bbSJiri Olsa 		}
301885ae32aeSSteven Rostedt 	}
301985ae32aeSSteven Rostedt 
3020750ed1a4SIngo Molnar 	stop = ftrace_now(raw_smp_processor_id());
30213d083395SSteven Rostedt 	ftrace_update_time = stop - start;
30221dc43cf0SJiri Slaby 	ftrace_update_tot_cnt += update_cnt;
30233d083395SSteven Rostedt 
302416444a8aSArnaldo Carvalho de Melo 	return 0;
302516444a8aSArnaldo Carvalho de Melo }
302616444a8aSArnaldo Carvalho de Melo 
3027a7900875SSteven Rostedt static int ftrace_allocate_records(struct ftrace_page *pg, int count)
30283c1720f0SSteven Rostedt {
3029a7900875SSteven Rostedt 	int order;
30303c1720f0SSteven Rostedt 	int cnt;
30313c1720f0SSteven Rostedt 
3032a7900875SSteven Rostedt 	if (WARN_ON(!count))
3033a7900875SSteven Rostedt 		return -EINVAL;
3034a7900875SSteven Rostedt 
3035a7900875SSteven Rostedt 	order = get_count_order(DIV_ROUND_UP(count, ENTRIES_PER_PAGE));
30363c1720f0SSteven Rostedt 
30373c1720f0SSteven Rostedt 	/*
3038a7900875SSteven Rostedt 	 * We want to fill as much as possible. No more than a page
3039a7900875SSteven Rostedt 	 * may be empty.
30403c1720f0SSteven Rostedt 	 */
3041a7900875SSteven Rostedt 	while ((PAGE_SIZE << order) / ENTRY_SIZE >= count + ENTRIES_PER_PAGE)
3042a7900875SSteven Rostedt 		order--;
30433c1720f0SSteven Rostedt 
3044a7900875SSteven Rostedt  again:
3045a7900875SSteven Rostedt 	pg->records = (void *)__get_free_pages(GFP_KERNEL | __GFP_ZERO, order);
3046a7900875SSteven Rostedt 
3047a7900875SSteven Rostedt 	if (!pg->records) {
3048a7900875SSteven Rostedt 		/* if we can't allocate this size, try something smaller */
3049a7900875SSteven Rostedt 		if (!order)
3050a7900875SSteven Rostedt 			return -ENOMEM;
3051a7900875SSteven Rostedt 		order >>= 1;
3052a7900875SSteven Rostedt 		goto again;
3053a7900875SSteven Rostedt 	}
3054a7900875SSteven Rostedt 
3055a7900875SSteven Rostedt 	cnt = (PAGE_SIZE << order) / ENTRY_SIZE;
3056a7900875SSteven Rostedt 	pg->size = cnt;
3057a7900875SSteven Rostedt 
3058a7900875SSteven Rostedt 	if (cnt > count)
3059a7900875SSteven Rostedt 		cnt = count;
3060a7900875SSteven Rostedt 
3061a7900875SSteven Rostedt 	return cnt;
3062a7900875SSteven Rostedt }
3063a7900875SSteven Rostedt 
3064a7900875SSteven Rostedt static struct ftrace_page *
3065a7900875SSteven Rostedt ftrace_allocate_pages(unsigned long num_to_init)
3066a7900875SSteven Rostedt {
3067a7900875SSteven Rostedt 	struct ftrace_page *start_pg;
3068a7900875SSteven Rostedt 	struct ftrace_page *pg;
3069a7900875SSteven Rostedt 	int order;
3070a7900875SSteven Rostedt 	int cnt;
3071a7900875SSteven Rostedt 
3072a7900875SSteven Rostedt 	if (!num_to_init)
3073a7900875SSteven Rostedt 		return 0;
3074a7900875SSteven Rostedt 
3075a7900875SSteven Rostedt 	start_pg = pg = kzalloc(sizeof(*pg), GFP_KERNEL);
3076a7900875SSteven Rostedt 	if (!pg)
3077a7900875SSteven Rostedt 		return NULL;
3078a7900875SSteven Rostedt 
3079a7900875SSteven Rostedt 	/*
3080a7900875SSteven Rostedt 	 * Try to allocate as much as possible in one continues
3081a7900875SSteven Rostedt 	 * location that fills in all of the space. We want to
3082a7900875SSteven Rostedt 	 * waste as little space as possible.
3083a7900875SSteven Rostedt 	 */
3084a7900875SSteven Rostedt 	for (;;) {
3085a7900875SSteven Rostedt 		cnt = ftrace_allocate_records(pg, num_to_init);
3086a7900875SSteven Rostedt 		if (cnt < 0)
3087a7900875SSteven Rostedt 			goto free_pages;
3088a7900875SSteven Rostedt 
3089a7900875SSteven Rostedt 		num_to_init -= cnt;
3090a7900875SSteven Rostedt 		if (!num_to_init)
3091a7900875SSteven Rostedt 			break;
3092a7900875SSteven Rostedt 
3093a7900875SSteven Rostedt 		pg->next = kzalloc(sizeof(*pg), GFP_KERNEL);
3094a7900875SSteven Rostedt 		if (!pg->next)
3095a7900875SSteven Rostedt 			goto free_pages;
3096a7900875SSteven Rostedt 
3097a7900875SSteven Rostedt 		pg = pg->next;
3098a7900875SSteven Rostedt 	}
3099a7900875SSteven Rostedt 
3100a7900875SSteven Rostedt 	return start_pg;
3101a7900875SSteven Rostedt 
3102a7900875SSteven Rostedt  free_pages:
31031f61be00SNamhyung Kim 	pg = start_pg;
31041f61be00SNamhyung Kim 	while (pg) {
3105a7900875SSteven Rostedt 		order = get_count_order(pg->size / ENTRIES_PER_PAGE);
3106a7900875SSteven Rostedt 		free_pages((unsigned long)pg->records, order);
3107a7900875SSteven Rostedt 		start_pg = pg->next;
3108a7900875SSteven Rostedt 		kfree(pg);
3109a7900875SSteven Rostedt 		pg = start_pg;
3110a7900875SSteven Rostedt 	}
3111a7900875SSteven Rostedt 	pr_info("ftrace: FAILED to allocate memory for functions\n");
3112a7900875SSteven Rostedt 	return NULL;
3113a7900875SSteven Rostedt }
3114a7900875SSteven Rostedt 
31155072c59fSSteven Rostedt #define FTRACE_BUFF_MAX (KSYM_SYMBOL_LEN+4) /* room for wildcards */
31165072c59fSSteven Rostedt 
31175072c59fSSteven Rostedt struct ftrace_iterator {
311898c4fd04SSteven Rostedt 	loff_t				pos;
31192bccfffdSSteven Rostedt 	loff_t				func_pos;
31205985ea8bSSteven Rostedt (VMware) 	loff_t				mod_pos;
31215072c59fSSteven Rostedt 	struct ftrace_page		*pg;
31224aeb6967SSteven Rostedt 	struct dyn_ftrace		*func;
31234aeb6967SSteven Rostedt 	struct ftrace_func_probe	*probe;
3124eee8ded1SSteven Rostedt (VMware) 	struct ftrace_func_entry	*probe_entry;
31254aeb6967SSteven Rostedt 	struct trace_parser		parser;
31261cf41dd7SSteven Rostedt 	struct ftrace_hash		*hash;
312733dc9b12SSteven Rostedt 	struct ftrace_ops		*ops;
31285985ea8bSSteven Rostedt (VMware) 	struct trace_array		*tr;
31295985ea8bSSteven Rostedt (VMware) 	struct list_head		*mod_list;
3130eee8ded1SSteven Rostedt (VMware) 	int				pidx;
3131431aa3fbSSteven Rostedt 	int				idx;
31325072c59fSSteven Rostedt 	unsigned			flags;
31335072c59fSSteven Rostedt };
31345072c59fSSteven Rostedt 
3135e309b41dSIngo Molnar static void *
3136eee8ded1SSteven Rostedt (VMware) t_probe_next(struct seq_file *m, loff_t *pos)
31378fc0c701SSteven Rostedt {
31388fc0c701SSteven Rostedt 	struct ftrace_iterator *iter = m->private;
3139d2afd57aSSteven Rostedt (VMware) 	struct trace_array *tr = iter->ops->private;
314004ec7bb6SSteven Rostedt (VMware) 	struct list_head *func_probes;
3141eee8ded1SSteven Rostedt (VMware) 	struct ftrace_hash *hash;
3142eee8ded1SSteven Rostedt (VMware) 	struct list_head *next;
31434aeb6967SSteven Rostedt 	struct hlist_node *hnd = NULL;
31448fc0c701SSteven Rostedt 	struct hlist_head *hhd;
3145eee8ded1SSteven Rostedt (VMware) 	int size;
31468fc0c701SSteven Rostedt 
31478fc0c701SSteven Rostedt 	(*pos)++;
314898c4fd04SSteven Rostedt 	iter->pos = *pos;
31498fc0c701SSteven Rostedt 
315004ec7bb6SSteven Rostedt (VMware) 	if (!tr)
31518fc0c701SSteven Rostedt 		return NULL;
31528fc0c701SSteven Rostedt 
315304ec7bb6SSteven Rostedt (VMware) 	func_probes = &tr->func_probes;
315404ec7bb6SSteven Rostedt (VMware) 	if (list_empty(func_probes))
31558fc0c701SSteven Rostedt 		return NULL;
31568fc0c701SSteven Rostedt 
3157eee8ded1SSteven Rostedt (VMware) 	if (!iter->probe) {
315804ec7bb6SSteven Rostedt (VMware) 		next = func_probes->next;
31597b60f3d8SSteven Rostedt (VMware) 		iter->probe = list_entry(next, struct ftrace_func_probe, list);
3160eee8ded1SSteven Rostedt (VMware) 	}
3161eee8ded1SSteven Rostedt (VMware) 
3162eee8ded1SSteven Rostedt (VMware) 	if (iter->probe_entry)
3163eee8ded1SSteven Rostedt (VMware) 		hnd = &iter->probe_entry->hlist;
3164eee8ded1SSteven Rostedt (VMware) 
3165eee8ded1SSteven Rostedt (VMware) 	hash = iter->probe->ops.func_hash->filter_hash;
3166eee8ded1SSteven Rostedt (VMware) 	size = 1 << hash->size_bits;
3167eee8ded1SSteven Rostedt (VMware) 
3168eee8ded1SSteven Rostedt (VMware)  retry:
3169eee8ded1SSteven Rostedt (VMware) 	if (iter->pidx >= size) {
317004ec7bb6SSteven Rostedt (VMware) 		if (iter->probe->list.next == func_probes)
3171eee8ded1SSteven Rostedt (VMware) 			return NULL;
3172eee8ded1SSteven Rostedt (VMware) 		next = iter->probe->list.next;
31737b60f3d8SSteven Rostedt (VMware) 		iter->probe = list_entry(next, struct ftrace_func_probe, list);
3174eee8ded1SSteven Rostedt (VMware) 		hash = iter->probe->ops.func_hash->filter_hash;
3175eee8ded1SSteven Rostedt (VMware) 		size = 1 << hash->size_bits;
3176eee8ded1SSteven Rostedt (VMware) 		iter->pidx = 0;
3177eee8ded1SSteven Rostedt (VMware) 	}
3178eee8ded1SSteven Rostedt (VMware) 
3179eee8ded1SSteven Rostedt (VMware) 	hhd = &hash->buckets[iter->pidx];
31808fc0c701SSteven Rostedt 
31818fc0c701SSteven Rostedt 	if (hlist_empty(hhd)) {
3182eee8ded1SSteven Rostedt (VMware) 		iter->pidx++;
31838fc0c701SSteven Rostedt 		hnd = NULL;
31848fc0c701SSteven Rostedt 		goto retry;
31858fc0c701SSteven Rostedt 	}
31868fc0c701SSteven Rostedt 
31878fc0c701SSteven Rostedt 	if (!hnd)
31888fc0c701SSteven Rostedt 		hnd = hhd->first;
31898fc0c701SSteven Rostedt 	else {
31908fc0c701SSteven Rostedt 		hnd = hnd->next;
31918fc0c701SSteven Rostedt 		if (!hnd) {
3192eee8ded1SSteven Rostedt (VMware) 			iter->pidx++;
31938fc0c701SSteven Rostedt 			goto retry;
31948fc0c701SSteven Rostedt 		}
31958fc0c701SSteven Rostedt 	}
31968fc0c701SSteven Rostedt 
31974aeb6967SSteven Rostedt 	if (WARN_ON_ONCE(!hnd))
31984aeb6967SSteven Rostedt 		return NULL;
31994aeb6967SSteven Rostedt 
3200eee8ded1SSteven Rostedt (VMware) 	iter->probe_entry = hlist_entry(hnd, struct ftrace_func_entry, hlist);
32014aeb6967SSteven Rostedt 
32024aeb6967SSteven Rostedt 	return iter;
32038fc0c701SSteven Rostedt }
32048fc0c701SSteven Rostedt 
3205eee8ded1SSteven Rostedt (VMware) static void *t_probe_start(struct seq_file *m, loff_t *pos)
32068fc0c701SSteven Rostedt {
32078fc0c701SSteven Rostedt 	struct ftrace_iterator *iter = m->private;
32088fc0c701SSteven Rostedt 	void *p = NULL;
3209d82d6244SLi Zefan 	loff_t l;
3210d82d6244SLi Zefan 
3211eee8ded1SSteven Rostedt (VMware) 	if (!(iter->flags & FTRACE_ITER_DO_PROBES))
321269a3083cSSteven Rostedt 		return NULL;
321369a3083cSSteven Rostedt 
32145985ea8bSSteven Rostedt (VMware) 	if (iter->mod_pos > *pos)
32152bccfffdSSteven Rostedt 		return NULL;
32168fc0c701SSteven Rostedt 
3217eee8ded1SSteven Rostedt (VMware) 	iter->probe = NULL;
3218eee8ded1SSteven Rostedt (VMware) 	iter->probe_entry = NULL;
3219eee8ded1SSteven Rostedt (VMware) 	iter->pidx = 0;
32205985ea8bSSteven Rostedt (VMware) 	for (l = 0; l <= (*pos - iter->mod_pos); ) {
3221eee8ded1SSteven Rostedt (VMware) 		p = t_probe_next(m, &l);
3222d82d6244SLi Zefan 		if (!p)
3223d82d6244SLi Zefan 			break;
3224d82d6244SLi Zefan 	}
32254aeb6967SSteven Rostedt 	if (!p)
32264aeb6967SSteven Rostedt 		return NULL;
32274aeb6967SSteven Rostedt 
322898c4fd04SSteven Rostedt 	/* Only set this if we have an item */
3229eee8ded1SSteven Rostedt (VMware) 	iter->flags |= FTRACE_ITER_PROBE;
323098c4fd04SSteven Rostedt 
32314aeb6967SSteven Rostedt 	return iter;
32328fc0c701SSteven Rostedt }
32338fc0c701SSteven Rostedt 
32344aeb6967SSteven Rostedt static int
3235eee8ded1SSteven Rostedt (VMware) t_probe_show(struct seq_file *m, struct ftrace_iterator *iter)
32368fc0c701SSteven Rostedt {
3237eee8ded1SSteven Rostedt (VMware) 	struct ftrace_func_entry *probe_entry;
32387b60f3d8SSteven Rostedt (VMware) 	struct ftrace_probe_ops *probe_ops;
32397b60f3d8SSteven Rostedt (VMware) 	struct ftrace_func_probe *probe;
32408fc0c701SSteven Rostedt 
3241eee8ded1SSteven Rostedt (VMware) 	probe = iter->probe;
3242eee8ded1SSteven Rostedt (VMware) 	probe_entry = iter->probe_entry;
3243eee8ded1SSteven Rostedt (VMware) 
3244eee8ded1SSteven Rostedt (VMware) 	if (WARN_ON_ONCE(!probe || !probe_entry))
32454aeb6967SSteven Rostedt 		return -EIO;
32468fc0c701SSteven Rostedt 
32477b60f3d8SSteven Rostedt (VMware) 	probe_ops = probe->probe_ops;
3248809dcf29SSteven Rostedt 
32497b60f3d8SSteven Rostedt (VMware) 	if (probe_ops->print)
32506e444319SSteven Rostedt (VMware) 		return probe_ops->print(m, probe_entry->ip, probe_ops, probe->data);
32518fc0c701SSteven Rostedt 
32527b60f3d8SSteven Rostedt (VMware) 	seq_printf(m, "%ps:%ps\n", (void *)probe_entry->ip,
32537b60f3d8SSteven Rostedt (VMware) 		   (void *)probe_ops->func);
32548fc0c701SSteven Rostedt 
32558fc0c701SSteven Rostedt 	return 0;
32568fc0c701SSteven Rostedt }
32578fc0c701SSteven Rostedt 
32588fc0c701SSteven Rostedt static void *
32595985ea8bSSteven Rostedt (VMware) t_mod_next(struct seq_file *m, loff_t *pos)
32605985ea8bSSteven Rostedt (VMware) {
32615985ea8bSSteven Rostedt (VMware) 	struct ftrace_iterator *iter = m->private;
32625985ea8bSSteven Rostedt (VMware) 	struct trace_array *tr = iter->tr;
32635985ea8bSSteven Rostedt (VMware) 
32645985ea8bSSteven Rostedt (VMware) 	(*pos)++;
32655985ea8bSSteven Rostedt (VMware) 	iter->pos = *pos;
32665985ea8bSSteven Rostedt (VMware) 
32675985ea8bSSteven Rostedt (VMware) 	iter->mod_list = iter->mod_list->next;
32685985ea8bSSteven Rostedt (VMware) 
32695985ea8bSSteven Rostedt (VMware) 	if (iter->mod_list == &tr->mod_trace ||
32705985ea8bSSteven Rostedt (VMware) 	    iter->mod_list == &tr->mod_notrace) {
32715985ea8bSSteven Rostedt (VMware) 		iter->flags &= ~FTRACE_ITER_MOD;
32725985ea8bSSteven Rostedt (VMware) 		return NULL;
32735985ea8bSSteven Rostedt (VMware) 	}
32745985ea8bSSteven Rostedt (VMware) 
32755985ea8bSSteven Rostedt (VMware) 	iter->mod_pos = *pos;
32765985ea8bSSteven Rostedt (VMware) 
32775985ea8bSSteven Rostedt (VMware) 	return iter;
32785985ea8bSSteven Rostedt (VMware) }
32795985ea8bSSteven Rostedt (VMware) 
32805985ea8bSSteven Rostedt (VMware) static void *t_mod_start(struct seq_file *m, loff_t *pos)
32815985ea8bSSteven Rostedt (VMware) {
32825985ea8bSSteven Rostedt (VMware) 	struct ftrace_iterator *iter = m->private;
32835985ea8bSSteven Rostedt (VMware) 	void *p = NULL;
32845985ea8bSSteven Rostedt (VMware) 	loff_t l;
32855985ea8bSSteven Rostedt (VMware) 
32865985ea8bSSteven Rostedt (VMware) 	if (iter->func_pos > *pos)
32875985ea8bSSteven Rostedt (VMware) 		return NULL;
32885985ea8bSSteven Rostedt (VMware) 
32895985ea8bSSteven Rostedt (VMware) 	iter->mod_pos = iter->func_pos;
32905985ea8bSSteven Rostedt (VMware) 
32915985ea8bSSteven Rostedt (VMware) 	/* probes are only available if tr is set */
32925985ea8bSSteven Rostedt (VMware) 	if (!iter->tr)
32935985ea8bSSteven Rostedt (VMware) 		return NULL;
32945985ea8bSSteven Rostedt (VMware) 
32955985ea8bSSteven Rostedt (VMware) 	for (l = 0; l <= (*pos - iter->func_pos); ) {
32965985ea8bSSteven Rostedt (VMware) 		p = t_mod_next(m, &l);
32975985ea8bSSteven Rostedt (VMware) 		if (!p)
32985985ea8bSSteven Rostedt (VMware) 			break;
32995985ea8bSSteven Rostedt (VMware) 	}
33005985ea8bSSteven Rostedt (VMware) 	if (!p) {
33015985ea8bSSteven Rostedt (VMware) 		iter->flags &= ~FTRACE_ITER_MOD;
33025985ea8bSSteven Rostedt (VMware) 		return t_probe_start(m, pos);
33035985ea8bSSteven Rostedt (VMware) 	}
33045985ea8bSSteven Rostedt (VMware) 
33055985ea8bSSteven Rostedt (VMware) 	/* Only set this if we have an item */
33065985ea8bSSteven Rostedt (VMware) 	iter->flags |= FTRACE_ITER_MOD;
33075985ea8bSSteven Rostedt (VMware) 
33085985ea8bSSteven Rostedt (VMware) 	return iter;
33095985ea8bSSteven Rostedt (VMware) }
33105985ea8bSSteven Rostedt (VMware) 
33115985ea8bSSteven Rostedt (VMware) static int
33125985ea8bSSteven Rostedt (VMware) t_mod_show(struct seq_file *m, struct ftrace_iterator *iter)
33135985ea8bSSteven Rostedt (VMware) {
33145985ea8bSSteven Rostedt (VMware) 	struct ftrace_mod_load *ftrace_mod;
33155985ea8bSSteven Rostedt (VMware) 	struct trace_array *tr = iter->tr;
33165985ea8bSSteven Rostedt (VMware) 
33175985ea8bSSteven Rostedt (VMware) 	if (WARN_ON_ONCE(!iter->mod_list) ||
33185985ea8bSSteven Rostedt (VMware) 			 iter->mod_list == &tr->mod_trace ||
33195985ea8bSSteven Rostedt (VMware) 			 iter->mod_list == &tr->mod_notrace)
33205985ea8bSSteven Rostedt (VMware) 		return -EIO;
33215985ea8bSSteven Rostedt (VMware) 
33225985ea8bSSteven Rostedt (VMware) 	ftrace_mod = list_entry(iter->mod_list, struct ftrace_mod_load, list);
33235985ea8bSSteven Rostedt (VMware) 
33245985ea8bSSteven Rostedt (VMware) 	if (ftrace_mod->func)
33255985ea8bSSteven Rostedt (VMware) 		seq_printf(m, "%s", ftrace_mod->func);
33265985ea8bSSteven Rostedt (VMware) 	else
33275985ea8bSSteven Rostedt (VMware) 		seq_putc(m, '*');
33285985ea8bSSteven Rostedt (VMware) 
33295985ea8bSSteven Rostedt (VMware) 	seq_printf(m, ":mod:%s\n", ftrace_mod->module);
33305985ea8bSSteven Rostedt (VMware) 
33315985ea8bSSteven Rostedt (VMware) 	return 0;
33325985ea8bSSteven Rostedt (VMware) }
33335985ea8bSSteven Rostedt (VMware) 
33345985ea8bSSteven Rostedt (VMware) static void *
33355bd84629SSteven Rostedt (VMware) t_func_next(struct seq_file *m, loff_t *pos)
33365072c59fSSteven Rostedt {
33375072c59fSSteven Rostedt 	struct ftrace_iterator *iter = m->private;
33385072c59fSSteven Rostedt 	struct dyn_ftrace *rec = NULL;
33395072c59fSSteven Rostedt 
33405072c59fSSteven Rostedt 	(*pos)++;
33410c75a3edSSteven Rostedt 
33425072c59fSSteven Rostedt  retry:
33435072c59fSSteven Rostedt 	if (iter->idx >= iter->pg->index) {
33445072c59fSSteven Rostedt 		if (iter->pg->next) {
33455072c59fSSteven Rostedt 			iter->pg = iter->pg->next;
33465072c59fSSteven Rostedt 			iter->idx = 0;
33475072c59fSSteven Rostedt 			goto retry;
33485072c59fSSteven Rostedt 		}
33495072c59fSSteven Rostedt 	} else {
33505072c59fSSteven Rostedt 		rec = &iter->pg->records[iter->idx++];
3351c20489daSSteven Rostedt (VMware) 		if (((iter->flags & (FTRACE_ITER_FILTER | FTRACE_ITER_NOTRACE)) &&
3352c20489daSSteven Rostedt (VMware) 		     !ftrace_lookup_ip(iter->hash, rec->ip)) ||
3353647bcd03SSteven Rostedt 
3354647bcd03SSteven Rostedt 		    ((iter->flags & FTRACE_ITER_ENABLED) &&
335523ea9c4dSSteven Rostedt (Red Hat) 		     !(rec->flags & FTRACE_FL_ENABLED))) {
3356647bcd03SSteven Rostedt 
33575072c59fSSteven Rostedt 			rec = NULL;
33585072c59fSSteven Rostedt 			goto retry;
33595072c59fSSteven Rostedt 		}
33605072c59fSSteven Rostedt 	}
33615072c59fSSteven Rostedt 
33624aeb6967SSteven Rostedt 	if (!rec)
33635bd84629SSteven Rostedt (VMware) 		return NULL;
33644aeb6967SSteven Rostedt 
33655bd84629SSteven Rostedt (VMware) 	iter->pos = iter->func_pos = *pos;
33664aeb6967SSteven Rostedt 	iter->func = rec;
33674aeb6967SSteven Rostedt 
33684aeb6967SSteven Rostedt 	return iter;
33695072c59fSSteven Rostedt }
33705072c59fSSteven Rostedt 
33715bd84629SSteven Rostedt (VMware) static void *
33725bd84629SSteven Rostedt (VMware) t_next(struct seq_file *m, void *v, loff_t *pos)
33735bd84629SSteven Rostedt (VMware) {
33745bd84629SSteven Rostedt (VMware) 	struct ftrace_iterator *iter = m->private;
33755985ea8bSSteven Rostedt (VMware) 	loff_t l = *pos; /* t_probe_start() must use original pos */
33765bd84629SSteven Rostedt (VMware) 	void *ret;
33775bd84629SSteven Rostedt (VMware) 
33785bd84629SSteven Rostedt (VMware) 	if (unlikely(ftrace_disabled))
33795bd84629SSteven Rostedt (VMware) 		return NULL;
33805bd84629SSteven Rostedt (VMware) 
3381eee8ded1SSteven Rostedt (VMware) 	if (iter->flags & FTRACE_ITER_PROBE)
3382eee8ded1SSteven Rostedt (VMware) 		return t_probe_next(m, pos);
33835bd84629SSteven Rostedt (VMware) 
33845985ea8bSSteven Rostedt (VMware) 	if (iter->flags & FTRACE_ITER_MOD)
33855985ea8bSSteven Rostedt (VMware) 		return t_mod_next(m, pos);
33865985ea8bSSteven Rostedt (VMware) 
33875bd84629SSteven Rostedt (VMware) 	if (iter->flags & FTRACE_ITER_PRINTALL) {
3388eee8ded1SSteven Rostedt (VMware) 		/* next must increment pos, and t_probe_start does not */
33895bd84629SSteven Rostedt (VMware) 		(*pos)++;
33905985ea8bSSteven Rostedt (VMware) 		return t_mod_start(m, &l);
33915bd84629SSteven Rostedt (VMware) 	}
33925bd84629SSteven Rostedt (VMware) 
33935bd84629SSteven Rostedt (VMware) 	ret = t_func_next(m, pos);
33945bd84629SSteven Rostedt (VMware) 
33955bd84629SSteven Rostedt (VMware) 	if (!ret)
33965985ea8bSSteven Rostedt (VMware) 		return t_mod_start(m, &l);
33975bd84629SSteven Rostedt (VMware) 
33985bd84629SSteven Rostedt (VMware) 	return ret;
33995bd84629SSteven Rostedt (VMware) }
34005bd84629SSteven Rostedt (VMware) 
340198c4fd04SSteven Rostedt static void reset_iter_read(struct ftrace_iterator *iter)
340298c4fd04SSteven Rostedt {
340398c4fd04SSteven Rostedt 	iter->pos = 0;
340498c4fd04SSteven Rostedt 	iter->func_pos = 0;
34055985ea8bSSteven Rostedt (VMware) 	iter->flags &= ~(FTRACE_ITER_PRINTALL | FTRACE_ITER_PROBE | FTRACE_ITER_MOD);
34065072c59fSSteven Rostedt }
34075072c59fSSteven Rostedt 
34085072c59fSSteven Rostedt static void *t_start(struct seq_file *m, loff_t *pos)
34095072c59fSSteven Rostedt {
34105072c59fSSteven Rostedt 	struct ftrace_iterator *iter = m->private;
34115072c59fSSteven Rostedt 	void *p = NULL;
3412694ce0a5SLi Zefan 	loff_t l;
34135072c59fSSteven Rostedt 
34148fc0c701SSteven Rostedt 	mutex_lock(&ftrace_lock);
341545a4a237SSteven Rostedt 
341645a4a237SSteven Rostedt 	if (unlikely(ftrace_disabled))
341745a4a237SSteven Rostedt 		return NULL;
341845a4a237SSteven Rostedt 
34190c75a3edSSteven Rostedt 	/*
342098c4fd04SSteven Rostedt 	 * If an lseek was done, then reset and start from beginning.
342198c4fd04SSteven Rostedt 	 */
342298c4fd04SSteven Rostedt 	if (*pos < iter->pos)
342398c4fd04SSteven Rostedt 		reset_iter_read(iter);
342498c4fd04SSteven Rostedt 
342598c4fd04SSteven Rostedt 	/*
34260c75a3edSSteven Rostedt 	 * For set_ftrace_filter reading, if we have the filter
34270c75a3edSSteven Rostedt 	 * off, we can short cut and just print out that all
34280c75a3edSSteven Rostedt 	 * functions are enabled.
34290c75a3edSSteven Rostedt 	 */
3430c20489daSSteven Rostedt (VMware) 	if ((iter->flags & (FTRACE_ITER_FILTER | FTRACE_ITER_NOTRACE)) &&
3431c20489daSSteven Rostedt (VMware) 	    ftrace_hash_empty(iter->hash)) {
343243ff926aSSteven Rostedt (VMware) 		iter->func_pos = 1; /* Account for the message */
34330c75a3edSSteven Rostedt 		if (*pos > 0)
34345985ea8bSSteven Rostedt (VMware) 			return t_mod_start(m, pos);
34350c75a3edSSteven Rostedt 		iter->flags |= FTRACE_ITER_PRINTALL;
3436df091625SChris Wright 		/* reset in case of seek/pread */
3437eee8ded1SSteven Rostedt (VMware) 		iter->flags &= ~FTRACE_ITER_PROBE;
34380c75a3edSSteven Rostedt 		return iter;
34390c75a3edSSteven Rostedt 	}
34400c75a3edSSteven Rostedt 
34415985ea8bSSteven Rostedt (VMware) 	if (iter->flags & FTRACE_ITER_MOD)
34425985ea8bSSteven Rostedt (VMware) 		return t_mod_start(m, pos);
34438fc0c701SSteven Rostedt 
344498c4fd04SSteven Rostedt 	/*
344598c4fd04SSteven Rostedt 	 * Unfortunately, we need to restart at ftrace_pages_start
344698c4fd04SSteven Rostedt 	 * every time we let go of the ftrace_mutex. This is because
344798c4fd04SSteven Rostedt 	 * those pointers can change without the lock.
344898c4fd04SSteven Rostedt 	 */
3449694ce0a5SLi Zefan 	iter->pg = ftrace_pages_start;
3450694ce0a5SLi Zefan 	iter->idx = 0;
3451694ce0a5SLi Zefan 	for (l = 0; l <= *pos; ) {
34525bd84629SSteven Rostedt (VMware) 		p = t_func_next(m, &l);
3453694ce0a5SLi Zefan 		if (!p)
3454694ce0a5SLi Zefan 			break;
345550cdaf08SLiming Wang 	}
34565821e1b7Swalimis 
345769a3083cSSteven Rostedt 	if (!p)
34585985ea8bSSteven Rostedt (VMware) 		return t_mod_start(m, pos);
34598fc0c701SSteven Rostedt 
34604aeb6967SSteven Rostedt 	return iter;
34615072c59fSSteven Rostedt }
34625072c59fSSteven Rostedt 
34635072c59fSSteven Rostedt static void t_stop(struct seq_file *m, void *p)
34645072c59fSSteven Rostedt {
34658fc0c701SSteven Rostedt 	mutex_unlock(&ftrace_lock);
34665072c59fSSteven Rostedt }
34675072c59fSSteven Rostedt 
346815d5b02cSSteven Rostedt (Red Hat) void * __weak
346915d5b02cSSteven Rostedt (Red Hat) arch_ftrace_trampoline_func(struct ftrace_ops *ops, struct dyn_ftrace *rec)
347015d5b02cSSteven Rostedt (Red Hat) {
347115d5b02cSSteven Rostedt (Red Hat) 	return NULL;
347215d5b02cSSteven Rostedt (Red Hat) }
347315d5b02cSSteven Rostedt (Red Hat) 
347415d5b02cSSteven Rostedt (Red Hat) static void add_trampoline_func(struct seq_file *m, struct ftrace_ops *ops,
347515d5b02cSSteven Rostedt (Red Hat) 				struct dyn_ftrace *rec)
347615d5b02cSSteven Rostedt (Red Hat) {
347715d5b02cSSteven Rostedt (Red Hat) 	void *ptr;
347815d5b02cSSteven Rostedt (Red Hat) 
347915d5b02cSSteven Rostedt (Red Hat) 	ptr = arch_ftrace_trampoline_func(ops, rec);
348015d5b02cSSteven Rostedt (Red Hat) 	if (ptr)
348115d5b02cSSteven Rostedt (Red Hat) 		seq_printf(m, " ->%pS", ptr);
348215d5b02cSSteven Rostedt (Red Hat) }
348315d5b02cSSteven Rostedt (Red Hat) 
34845072c59fSSteven Rostedt static int t_show(struct seq_file *m, void *v)
34855072c59fSSteven Rostedt {
34860c75a3edSSteven Rostedt 	struct ftrace_iterator *iter = m->private;
34874aeb6967SSteven Rostedt 	struct dyn_ftrace *rec;
34885072c59fSSteven Rostedt 
3489eee8ded1SSteven Rostedt (VMware) 	if (iter->flags & FTRACE_ITER_PROBE)
3490eee8ded1SSteven Rostedt (VMware) 		return t_probe_show(m, iter);
34918fc0c701SSteven Rostedt 
34925985ea8bSSteven Rostedt (VMware) 	if (iter->flags & FTRACE_ITER_MOD)
34935985ea8bSSteven Rostedt (VMware) 		return t_mod_show(m, iter);
34945985ea8bSSteven Rostedt (VMware) 
34950c75a3edSSteven Rostedt 	if (iter->flags & FTRACE_ITER_PRINTALL) {
34968c006cf7SNamhyung Kim 		if (iter->flags & FTRACE_ITER_NOTRACE)
3497fa6f0cc7SRasmus Villemoes 			seq_puts(m, "#### no functions disabled ####\n");
34988c006cf7SNamhyung Kim 		else
3499fa6f0cc7SRasmus Villemoes 			seq_puts(m, "#### all functions enabled ####\n");
35000c75a3edSSteven Rostedt 		return 0;
35010c75a3edSSteven Rostedt 	}
35020c75a3edSSteven Rostedt 
35034aeb6967SSteven Rostedt 	rec = iter->func;
35044aeb6967SSteven Rostedt 
35055072c59fSSteven Rostedt 	if (!rec)
35065072c59fSSteven Rostedt 		return 0;
35075072c59fSSteven Rostedt 
3508647bcd03SSteven Rostedt 	seq_printf(m, "%ps", (void *)rec->ip);
35099674b2faSSteven Rostedt (Red Hat) 	if (iter->flags & FTRACE_ITER_ENABLED) {
3510030f4e1cSSteven Rostedt (Red Hat) 		struct ftrace_ops *ops;
351115d5b02cSSteven Rostedt (Red Hat) 
3512f8b8be8aSMasami Hiramatsu 		seq_printf(m, " (%ld)%s%s",
35130376bde1SSteven Rostedt (Red Hat) 			   ftrace_rec_count(rec),
3514f8b8be8aSMasami Hiramatsu 			   rec->flags & FTRACE_FL_REGS ? " R" : "  ",
3515f8b8be8aSMasami Hiramatsu 			   rec->flags & FTRACE_FL_IPMODIFY ? " I" : "  ");
35169674b2faSSteven Rostedt (Red Hat) 		if (rec->flags & FTRACE_FL_TRAMP_EN) {
35175fecaa04SSteven Rostedt (Red Hat) 			ops = ftrace_find_tramp_ops_any(rec);
351839daa7b9SSteven Rostedt (Red Hat) 			if (ops) {
351939daa7b9SSteven Rostedt (Red Hat) 				do {
352039daa7b9SSteven Rostedt (Red Hat) 					seq_printf(m, "\ttramp: %pS (%pS)",
352139daa7b9SSteven Rostedt (Red Hat) 						   (void *)ops->trampoline,
352239daa7b9SSteven Rostedt (Red Hat) 						   (void *)ops->func);
3523030f4e1cSSteven Rostedt (Red Hat) 					add_trampoline_func(m, ops, rec);
352439daa7b9SSteven Rostedt (Red Hat) 					ops = ftrace_find_tramp_ops_next(rec, ops);
352539daa7b9SSteven Rostedt (Red Hat) 				} while (ops);
352639daa7b9SSteven Rostedt (Red Hat) 			} else
3527fa6f0cc7SRasmus Villemoes 				seq_puts(m, "\ttramp: ERROR!");
3528030f4e1cSSteven Rostedt (Red Hat) 		} else {
3529030f4e1cSSteven Rostedt (Red Hat) 			add_trampoline_func(m, NULL, rec);
35309674b2faSSteven Rostedt (Red Hat) 		}
35319674b2faSSteven Rostedt (Red Hat) 	}
35329674b2faSSteven Rostedt (Red Hat) 
3533fa6f0cc7SRasmus Villemoes 	seq_putc(m, '\n');
35345072c59fSSteven Rostedt 
35355072c59fSSteven Rostedt 	return 0;
35365072c59fSSteven Rostedt }
35375072c59fSSteven Rostedt 
353888e9d34cSJames Morris static const struct seq_operations show_ftrace_seq_ops = {
35395072c59fSSteven Rostedt 	.start = t_start,
35405072c59fSSteven Rostedt 	.next = t_next,
35415072c59fSSteven Rostedt 	.stop = t_stop,
35425072c59fSSteven Rostedt 	.show = t_show,
35435072c59fSSteven Rostedt };
35445072c59fSSteven Rostedt 
3545e309b41dSIngo Molnar static int
35465072c59fSSteven Rostedt ftrace_avail_open(struct inode *inode, struct file *file)
35475072c59fSSteven Rostedt {
35485072c59fSSteven Rostedt 	struct ftrace_iterator *iter;
35495072c59fSSteven Rostedt 
35504eebcc81SSteven Rostedt 	if (unlikely(ftrace_disabled))
35514eebcc81SSteven Rostedt 		return -ENODEV;
35524eebcc81SSteven Rostedt 
355350e18b94SJiri Olsa 	iter = __seq_open_private(file, &show_ftrace_seq_ops, sizeof(*iter));
3554c1bc5919SSteven Rostedt (VMware) 	if (!iter)
3555c1bc5919SSteven Rostedt (VMware) 		return -ENOMEM;
3556c1bc5919SSteven Rostedt (VMware) 
35575072c59fSSteven Rostedt 	iter->pg = ftrace_pages_start;
3558fc13cb0cSSteven Rostedt 	iter->ops = &global_ops;
35595072c59fSSteven Rostedt 
3560c1bc5919SSteven Rostedt (VMware) 	return 0;
35615072c59fSSteven Rostedt }
35625072c59fSSteven Rostedt 
3563647bcd03SSteven Rostedt static int
3564647bcd03SSteven Rostedt ftrace_enabled_open(struct inode *inode, struct file *file)
3565647bcd03SSteven Rostedt {
3566647bcd03SSteven Rostedt 	struct ftrace_iterator *iter;
3567647bcd03SSteven Rostedt 
356850e18b94SJiri Olsa 	iter = __seq_open_private(file, &show_ftrace_seq_ops, sizeof(*iter));
3569c1bc5919SSteven Rostedt (VMware) 	if (!iter)
3570c1bc5919SSteven Rostedt (VMware) 		return -ENOMEM;
3571c1bc5919SSteven Rostedt (VMware) 
3572647bcd03SSteven Rostedt 	iter->pg = ftrace_pages_start;
3573647bcd03SSteven Rostedt 	iter->flags = FTRACE_ITER_ENABLED;
3574fc13cb0cSSteven Rostedt 	iter->ops = &global_ops;
3575647bcd03SSteven Rostedt 
3576c1bc5919SSteven Rostedt (VMware) 	return 0;
3577647bcd03SSteven Rostedt }
3578647bcd03SSteven Rostedt 
3579fc13cb0cSSteven Rostedt /**
3580fc13cb0cSSteven Rostedt  * ftrace_regex_open - initialize function tracer filter files
3581fc13cb0cSSteven Rostedt  * @ops: The ftrace_ops that hold the hash filters
3582fc13cb0cSSteven Rostedt  * @flag: The type of filter to process
3583fc13cb0cSSteven Rostedt  * @inode: The inode, usually passed in to your open routine
3584fc13cb0cSSteven Rostedt  * @file: The file, usually passed in to your open routine
3585fc13cb0cSSteven Rostedt  *
3586fc13cb0cSSteven Rostedt  * ftrace_regex_open() initializes the filter files for the
3587fc13cb0cSSteven Rostedt  * @ops. Depending on @flag it may process the filter hash or
3588fc13cb0cSSteven Rostedt  * the notrace hash of @ops. With this called from the open
3589fc13cb0cSSteven Rostedt  * routine, you can use ftrace_filter_write() for the write
3590fc13cb0cSSteven Rostedt  * routine if @flag has FTRACE_ITER_FILTER set, or
3591fc13cb0cSSteven Rostedt  * ftrace_notrace_write() if @flag has FTRACE_ITER_NOTRACE set.
3592098c879eSSteven Rostedt (Red Hat)  * tracing_lseek() should be used as the lseek routine, and
3593fc13cb0cSSteven Rostedt  * release must call ftrace_regex_release().
3594fc13cb0cSSteven Rostedt  */
3595fc13cb0cSSteven Rostedt int
3596f45948e8SSteven Rostedt ftrace_regex_open(struct ftrace_ops *ops, int flag,
35971cf41dd7SSteven Rostedt 		  struct inode *inode, struct file *file)
35985072c59fSSteven Rostedt {
35995072c59fSSteven Rostedt 	struct ftrace_iterator *iter;
3600f45948e8SSteven Rostedt 	struct ftrace_hash *hash;
3601673feb9dSSteven Rostedt (VMware) 	struct list_head *mod_head;
3602673feb9dSSteven Rostedt (VMware) 	struct trace_array *tr = ops->private;
36035072c59fSSteven Rostedt 	int ret = 0;
36045072c59fSSteven Rostedt 
3605f04f24fbSMasami Hiramatsu 	ftrace_ops_init(ops);
3606f04f24fbSMasami Hiramatsu 
36074eebcc81SSteven Rostedt 	if (unlikely(ftrace_disabled))
36084eebcc81SSteven Rostedt 		return -ENODEV;
36094eebcc81SSteven Rostedt 
36105072c59fSSteven Rostedt 	iter = kzalloc(sizeof(*iter), GFP_KERNEL);
36115072c59fSSteven Rostedt 	if (!iter)
36125072c59fSSteven Rostedt 		return -ENOMEM;
36135072c59fSSteven Rostedt 
3614689fd8b6S[email protected] 	if (trace_parser_get_init(&iter->parser, FTRACE_BUFF_MAX)) {
3615689fd8b6S[email protected] 		kfree(iter);
3616689fd8b6S[email protected] 		return -ENOMEM;
3617689fd8b6S[email protected] 	}
3618689fd8b6S[email protected] 
36193f2367baSMasami Hiramatsu 	iter->ops = ops;
36203f2367baSMasami Hiramatsu 	iter->flags = flag;
36215985ea8bSSteven Rostedt (VMware) 	iter->tr = tr;
36223f2367baSMasami Hiramatsu 
362333b7f99cSSteven Rostedt (Red Hat) 	mutex_lock(&ops->func_hash->regex_lock);
36243f2367baSMasami Hiramatsu 
3625673feb9dSSteven Rostedt (VMware) 	if (flag & FTRACE_ITER_NOTRACE) {
362633b7f99cSSteven Rostedt (Red Hat) 		hash = ops->func_hash->notrace_hash;
36275985ea8bSSteven Rostedt (VMware) 		mod_head = tr ? &tr->mod_notrace : NULL;
3628673feb9dSSteven Rostedt (VMware) 	} else {
362933b7f99cSSteven Rostedt (Red Hat) 		hash = ops->func_hash->filter_hash;
36305985ea8bSSteven Rostedt (VMware) 		mod_head = tr ? &tr->mod_trace : NULL;
3631673feb9dSSteven Rostedt (VMware) 	}
3632f45948e8SSteven Rostedt 
36335985ea8bSSteven Rostedt (VMware) 	iter->mod_list = mod_head;
36345985ea8bSSteven Rostedt (VMware) 
363533dc9b12SSteven Rostedt 	if (file->f_mode & FMODE_WRITE) {
3636ef2fbe16SNamhyung Kim 		const int size_bits = FTRACE_HASH_DEFAULT_BITS;
3637ef2fbe16SNamhyung Kim 
3638673feb9dSSteven Rostedt (VMware) 		if (file->f_flags & O_TRUNC) {
3639ef2fbe16SNamhyung Kim 			iter->hash = alloc_ftrace_hash(size_bits);
3640673feb9dSSteven Rostedt (VMware) 			clear_ftrace_mod_list(mod_head);
3641673feb9dSSteven Rostedt (VMware) 	        } else {
3642ef2fbe16SNamhyung Kim 			iter->hash = alloc_and_copy_ftrace_hash(size_bits, hash);
3643673feb9dSSteven Rostedt (VMware) 		}
3644ef2fbe16SNamhyung Kim 
364533dc9b12SSteven Rostedt 		if (!iter->hash) {
364633dc9b12SSteven Rostedt 			trace_parser_put(&iter->parser);
364733dc9b12SSteven Rostedt 			kfree(iter);
36483f2367baSMasami Hiramatsu 			ret = -ENOMEM;
36493f2367baSMasami Hiramatsu 			goto out_unlock;
365033dc9b12SSteven Rostedt 		}
3651c20489daSSteven Rostedt (VMware) 	} else
3652c20489daSSteven Rostedt (VMware) 		iter->hash = hash;
36531cf41dd7SSteven Rostedt 
36545072c59fSSteven Rostedt 	if (file->f_mode & FMODE_READ) {
36555072c59fSSteven Rostedt 		iter->pg = ftrace_pages_start;
36565072c59fSSteven Rostedt 
36575072c59fSSteven Rostedt 		ret = seq_open(file, &show_ftrace_seq_ops);
36585072c59fSSteven Rostedt 		if (!ret) {
36595072c59fSSteven Rostedt 			struct seq_file *m = file->private_data;
36605072c59fSSteven Rostedt 			m->private = iter;
366179fe249cSLi Zefan 		} else {
366233dc9b12SSteven Rostedt 			/* Failed */
366333dc9b12SSteven Rostedt 			free_ftrace_hash(iter->hash);
366479fe249cSLi Zefan 			trace_parser_put(&iter->parser);
36655072c59fSSteven Rostedt 			kfree(iter);
366679fe249cSLi Zefan 		}
36675072c59fSSteven Rostedt 	} else
36685072c59fSSteven Rostedt 		file->private_data = iter;
36693f2367baSMasami Hiramatsu 
36703f2367baSMasami Hiramatsu  out_unlock:
367133b7f99cSSteven Rostedt (Red Hat) 	mutex_unlock(&ops->func_hash->regex_lock);
36725072c59fSSteven Rostedt 
36735072c59fSSteven Rostedt 	return ret;
36745072c59fSSteven Rostedt }
36755072c59fSSteven Rostedt 
367641c52c0dSSteven Rostedt static int
367741c52c0dSSteven Rostedt ftrace_filter_open(struct inode *inode, struct file *file)
367841c52c0dSSteven Rostedt {
3679e3b3e2e8SSteven Rostedt (Red Hat) 	struct ftrace_ops *ops = inode->i_private;
3680e3b3e2e8SSteven Rostedt (Red Hat) 
3681e3b3e2e8SSteven Rostedt (Red Hat) 	return ftrace_regex_open(ops,
3682eee8ded1SSteven Rostedt (VMware) 			FTRACE_ITER_FILTER | FTRACE_ITER_DO_PROBES,
36831cf41dd7SSteven Rostedt 			inode, file);
368441c52c0dSSteven Rostedt }
368541c52c0dSSteven Rostedt 
368641c52c0dSSteven Rostedt static int
368741c52c0dSSteven Rostedt ftrace_notrace_open(struct inode *inode, struct file *file)
368841c52c0dSSteven Rostedt {
3689e3b3e2e8SSteven Rostedt (Red Hat) 	struct ftrace_ops *ops = inode->i_private;
3690e3b3e2e8SSteven Rostedt (Red Hat) 
3691e3b3e2e8SSteven Rostedt (Red Hat) 	return ftrace_regex_open(ops, FTRACE_ITER_NOTRACE,
36921cf41dd7SSteven Rostedt 				 inode, file);
369341c52c0dSSteven Rostedt }
369441c52c0dSSteven Rostedt 
36953ba00929SDmitry Safonov /* Type for quick search ftrace basic regexes (globs) from filter_parse_regex */
36963ba00929SDmitry Safonov struct ftrace_glob {
36973ba00929SDmitry Safonov 	char *search;
36983ba00929SDmitry Safonov 	unsigned len;
36993ba00929SDmitry Safonov 	int type;
37003ba00929SDmitry Safonov };
37013ba00929SDmitry Safonov 
37027132e2d6SThiago Jung Bauermann /*
37037132e2d6SThiago Jung Bauermann  * If symbols in an architecture don't correspond exactly to the user-visible
37047132e2d6SThiago Jung Bauermann  * name of what they represent, it is possible to define this function to
37057132e2d6SThiago Jung Bauermann  * perform the necessary adjustments.
37067132e2d6SThiago Jung Bauermann */
37077132e2d6SThiago Jung Bauermann char * __weak arch_ftrace_match_adjust(char *str, const char *search)
37087132e2d6SThiago Jung Bauermann {
37097132e2d6SThiago Jung Bauermann 	return str;
37107132e2d6SThiago Jung Bauermann }
37117132e2d6SThiago Jung Bauermann 
37123ba00929SDmitry Safonov static int ftrace_match(char *str, struct ftrace_glob *g)
37139f4801e3SSteven Rostedt {
37149f4801e3SSteven Rostedt 	int matched = 0;
3715751e9983SLi Zefan 	int slen;
37169f4801e3SSteven Rostedt 
37177132e2d6SThiago Jung Bauermann 	str = arch_ftrace_match_adjust(str, g->search);
37187132e2d6SThiago Jung Bauermann 
37193ba00929SDmitry Safonov 	switch (g->type) {
37209f4801e3SSteven Rostedt 	case MATCH_FULL:
37213ba00929SDmitry Safonov 		if (strcmp(str, g->search) == 0)
37229f4801e3SSteven Rostedt 			matched = 1;
37239f4801e3SSteven Rostedt 		break;
37249f4801e3SSteven Rostedt 	case MATCH_FRONT_ONLY:
37253ba00929SDmitry Safonov 		if (strncmp(str, g->search, g->len) == 0)
37269f4801e3SSteven Rostedt 			matched = 1;
37279f4801e3SSteven Rostedt 		break;
37289f4801e3SSteven Rostedt 	case MATCH_MIDDLE_ONLY:
37293ba00929SDmitry Safonov 		if (strstr(str, g->search))
37309f4801e3SSteven Rostedt 			matched = 1;
37319f4801e3SSteven Rostedt 		break;
37329f4801e3SSteven Rostedt 	case MATCH_END_ONLY:
3733751e9983SLi Zefan 		slen = strlen(str);
37343ba00929SDmitry Safonov 		if (slen >= g->len &&
37353ba00929SDmitry Safonov 		    memcmp(str + slen - g->len, g->search, g->len) == 0)
37369f4801e3SSteven Rostedt 			matched = 1;
37379f4801e3SSteven Rostedt 		break;
373860f1d5e3SMasami Hiramatsu 	case MATCH_GLOB:
373960f1d5e3SMasami Hiramatsu 		if (glob_match(g->search, str))
374060f1d5e3SMasami Hiramatsu 			matched = 1;
374160f1d5e3SMasami Hiramatsu 		break;
37429f4801e3SSteven Rostedt 	}
37439f4801e3SSteven Rostedt 
37449f4801e3SSteven Rostedt 	return matched;
37459f4801e3SSteven Rostedt }
37469f4801e3SSteven Rostedt 
3747b448c4e3SSteven Rostedt static int
3748f0a3b154SDmitry Safonov enter_record(struct ftrace_hash *hash, struct dyn_ftrace *rec, int clear_filter)
374964e7c440SSteven Rostedt {
3750b448c4e3SSteven Rostedt 	struct ftrace_func_entry *entry;
3751b448c4e3SSteven Rostedt 	int ret = 0;
3752b448c4e3SSteven Rostedt 
37531cf41dd7SSteven Rostedt 	entry = ftrace_lookup_ip(hash, rec->ip);
3754f0a3b154SDmitry Safonov 	if (clear_filter) {
3755b448c4e3SSteven Rostedt 		/* Do nothing if it doesn't exist */
3756b448c4e3SSteven Rostedt 		if (!entry)
3757b448c4e3SSteven Rostedt 			return 0;
3758b448c4e3SSteven Rostedt 
375933dc9b12SSteven Rostedt 		free_hash_entry(hash, entry);
3760b448c4e3SSteven Rostedt 	} else {
3761b448c4e3SSteven Rostedt 		/* Do nothing if it exists */
3762b448c4e3SSteven Rostedt 		if (entry)
3763b448c4e3SSteven Rostedt 			return 0;
3764b448c4e3SSteven Rostedt 
3765b448c4e3SSteven Rostedt 		ret = add_hash_entry(hash, rec->ip);
3766b448c4e3SSteven Rostedt 	}
3767b448c4e3SSteven Rostedt 	return ret;
3768996e87beSSteven Rostedt }
3769996e87beSSteven Rostedt 
377064e7c440SSteven Rostedt static int
37710b507e1eSDmitry Safonov ftrace_match_record(struct dyn_ftrace *rec, struct ftrace_glob *func_g,
37720b507e1eSDmitry Safonov 		struct ftrace_glob *mod_g, int exclude_mod)
377364e7c440SSteven Rostedt {
377464e7c440SSteven Rostedt 	char str[KSYM_SYMBOL_LEN];
3775b9df92d2SSteven Rostedt 	char *modname;
377664e7c440SSteven Rostedt 
3777b9df92d2SSteven Rostedt 	kallsyms_lookup(rec->ip, NULL, NULL, &modname, str);
3778b9df92d2SSteven Rostedt 
37790b507e1eSDmitry Safonov 	if (mod_g) {
37800b507e1eSDmitry Safonov 		int mod_matches = (modname) ? ftrace_match(modname, mod_g) : 0;
37810b507e1eSDmitry Safonov 
37820b507e1eSDmitry Safonov 		/* blank module name to match all modules */
37830b507e1eSDmitry Safonov 		if (!mod_g->len) {
37840b507e1eSDmitry Safonov 			/* blank module globbing: modname xor exclude_mod */
378577c0eddeSSteven Rostedt (VMware) 			if (!exclude_mod != !modname)
37860b507e1eSDmitry Safonov 				goto func_match;
37870b507e1eSDmitry Safonov 			return 0;
37880b507e1eSDmitry Safonov 		}
37890b507e1eSDmitry Safonov 
379077c0eddeSSteven Rostedt (VMware) 		/*
379177c0eddeSSteven Rostedt (VMware) 		 * exclude_mod is set to trace everything but the given
379277c0eddeSSteven Rostedt (VMware) 		 * module. If it is set and the module matches, then
379377c0eddeSSteven Rostedt (VMware) 		 * return 0. If it is not set, and the module doesn't match
379477c0eddeSSteven Rostedt (VMware) 		 * also return 0. Otherwise, check the function to see if
379577c0eddeSSteven Rostedt (VMware) 		 * that matches.
379677c0eddeSSteven Rostedt (VMware) 		 */
379777c0eddeSSteven Rostedt (VMware) 		if (!mod_matches == !exclude_mod)
37980b507e1eSDmitry Safonov 			return 0;
37990b507e1eSDmitry Safonov func_match:
3800b9df92d2SSteven Rostedt 		/* blank search means to match all funcs in the mod */
38013ba00929SDmitry Safonov 		if (!func_g->len)
3802b9df92d2SSteven Rostedt 			return 1;
3803b9df92d2SSteven Rostedt 	}
3804b9df92d2SSteven Rostedt 
38053ba00929SDmitry Safonov 	return ftrace_match(str, func_g);
380664e7c440SSteven Rostedt }
380764e7c440SSteven Rostedt 
38081cf41dd7SSteven Rostedt static int
38093ba00929SDmitry Safonov match_records(struct ftrace_hash *hash, char *func, int len, char *mod)
38109f4801e3SSteven Rostedt {
38119f4801e3SSteven Rostedt 	struct ftrace_page *pg;
38129f4801e3SSteven Rostedt 	struct dyn_ftrace *rec;
38133ba00929SDmitry Safonov 	struct ftrace_glob func_g = { .type = MATCH_FULL };
38140b507e1eSDmitry Safonov 	struct ftrace_glob mod_g = { .type = MATCH_FULL };
38150b507e1eSDmitry Safonov 	struct ftrace_glob *mod_match = (mod) ? &mod_g : NULL;
38160b507e1eSDmitry Safonov 	int exclude_mod = 0;
3817311d16daSLi Zefan 	int found = 0;
3818b448c4e3SSteven Rostedt 	int ret;
3819f0a3b154SDmitry Safonov 	int clear_filter;
38209f4801e3SSteven Rostedt 
38210b507e1eSDmitry Safonov 	if (func) {
38223ba00929SDmitry Safonov 		func_g.type = filter_parse_regex(func, len, &func_g.search,
38233ba00929SDmitry Safonov 						 &clear_filter);
38243ba00929SDmitry Safonov 		func_g.len = strlen(func_g.search);
3825b9df92d2SSteven Rostedt 	}
3826b9df92d2SSteven Rostedt 
38270b507e1eSDmitry Safonov 	if (mod) {
38280b507e1eSDmitry Safonov 		mod_g.type = filter_parse_regex(mod, strlen(mod),
38290b507e1eSDmitry Safonov 				&mod_g.search, &exclude_mod);
38300b507e1eSDmitry Safonov 		mod_g.len = strlen(mod_g.search);
3831b9df92d2SSteven Rostedt 	}
3832b9df92d2SSteven Rostedt 
383352baf119SSteven Rostedt 	mutex_lock(&ftrace_lock);
3834b9df92d2SSteven Rostedt 
3835b9df92d2SSteven Rostedt 	if (unlikely(ftrace_disabled))
3836b9df92d2SSteven Rostedt 		goto out_unlock;
3837b9df92d2SSteven Rostedt 
3838265c831cSSteven Rostedt 	do_for_each_ftrace_rec(pg, rec) {
3839546fece4SSteven Rostedt (Red Hat) 
3840546fece4SSteven Rostedt (Red Hat) 		if (rec->flags & FTRACE_FL_DISABLED)
3841546fece4SSteven Rostedt (Red Hat) 			continue;
3842546fece4SSteven Rostedt (Red Hat) 
38430b507e1eSDmitry Safonov 		if (ftrace_match_record(rec, &func_g, mod_match, exclude_mod)) {
3844f0a3b154SDmitry Safonov 			ret = enter_record(hash, rec, clear_filter);
3845b448c4e3SSteven Rostedt 			if (ret < 0) {
3846b448c4e3SSteven Rostedt 				found = ret;
3847b448c4e3SSteven Rostedt 				goto out_unlock;
3848b448c4e3SSteven Rostedt 			}
3849311d16daSLi Zefan 			found = 1;
38505072c59fSSteven Rostedt 		}
3851265c831cSSteven Rostedt 	} while_for_each_ftrace_rec();
3852b9df92d2SSteven Rostedt  out_unlock:
385352baf119SSteven Rostedt 	mutex_unlock(&ftrace_lock);
3854311d16daSLi Zefan 
3855311d16daSLi Zefan 	return found;
38565072c59fSSteven Rostedt }
38575072c59fSSteven Rostedt 
385864e7c440SSteven Rostedt static int
38591cf41dd7SSteven Rostedt ftrace_match_records(struct ftrace_hash *hash, char *buff, int len)
386064e7c440SSteven Rostedt {
3861f0a3b154SDmitry Safonov 	return match_records(hash, buff, len, NULL);
386264e7c440SSteven Rostedt }
386364e7c440SSteven Rostedt 
3864e16b35ddSSteven Rostedt (VMware) static void ftrace_ops_update_code(struct ftrace_ops *ops,
3865e16b35ddSSteven Rostedt (VMware) 				   struct ftrace_ops_hash *old_hash)
3866e16b35ddSSteven Rostedt (VMware) {
3867e16b35ddSSteven Rostedt (VMware) 	struct ftrace_ops *op;
3868e16b35ddSSteven Rostedt (VMware) 
3869e16b35ddSSteven Rostedt (VMware) 	if (!ftrace_enabled)
3870e16b35ddSSteven Rostedt (VMware) 		return;
3871e16b35ddSSteven Rostedt (VMware) 
3872e16b35ddSSteven Rostedt (VMware) 	if (ops->flags & FTRACE_OPS_FL_ENABLED) {
3873e16b35ddSSteven Rostedt (VMware) 		ftrace_run_modify_code(ops, FTRACE_UPDATE_CALLS, old_hash);
3874e16b35ddSSteven Rostedt (VMware) 		return;
3875e16b35ddSSteven Rostedt (VMware) 	}
3876e16b35ddSSteven Rostedt (VMware) 
3877e16b35ddSSteven Rostedt (VMware) 	/*
3878e16b35ddSSteven Rostedt (VMware) 	 * If this is the shared global_ops filter, then we need to
3879e16b35ddSSteven Rostedt (VMware) 	 * check if there is another ops that shares it, is enabled.
3880e16b35ddSSteven Rostedt (VMware) 	 * If so, we still need to run the modify code.
3881e16b35ddSSteven Rostedt (VMware) 	 */
3882e16b35ddSSteven Rostedt (VMware) 	if (ops->func_hash != &global_ops.local_hash)
3883e16b35ddSSteven Rostedt (VMware) 		return;
3884e16b35ddSSteven Rostedt (VMware) 
3885e16b35ddSSteven Rostedt (VMware) 	do_for_each_ftrace_op(op, ftrace_ops_list) {
3886e16b35ddSSteven Rostedt (VMware) 		if (op->func_hash == &global_ops.local_hash &&
3887e16b35ddSSteven Rostedt (VMware) 		    op->flags & FTRACE_OPS_FL_ENABLED) {
3888e16b35ddSSteven Rostedt (VMware) 			ftrace_run_modify_code(op, FTRACE_UPDATE_CALLS, old_hash);
3889e16b35ddSSteven Rostedt (VMware) 			/* Only need to do this once */
3890e16b35ddSSteven Rostedt (VMware) 			return;
3891e16b35ddSSteven Rostedt (VMware) 		}
3892e16b35ddSSteven Rostedt (VMware) 	} while_for_each_ftrace_op(op);
3893e16b35ddSSteven Rostedt (VMware) }
3894e16b35ddSSteven Rostedt (VMware) 
3895e16b35ddSSteven Rostedt (VMware) static int ftrace_hash_move_and_update_ops(struct ftrace_ops *ops,
3896e16b35ddSSteven Rostedt (VMware) 					   struct ftrace_hash **orig_hash,
3897e16b35ddSSteven Rostedt (VMware) 					   struct ftrace_hash *hash,
3898e16b35ddSSteven Rostedt (VMware) 					   int enable)
3899e16b35ddSSteven Rostedt (VMware) {
3900e16b35ddSSteven Rostedt (VMware) 	struct ftrace_ops_hash old_hash_ops;
3901e16b35ddSSteven Rostedt (VMware) 	struct ftrace_hash *old_hash;
3902e16b35ddSSteven Rostedt (VMware) 	int ret;
3903e16b35ddSSteven Rostedt (VMware) 
3904e16b35ddSSteven Rostedt (VMware) 	old_hash = *orig_hash;
3905e16b35ddSSteven Rostedt (VMware) 	old_hash_ops.filter_hash = ops->func_hash->filter_hash;
3906e16b35ddSSteven Rostedt (VMware) 	old_hash_ops.notrace_hash = ops->func_hash->notrace_hash;
3907e16b35ddSSteven Rostedt (VMware) 	ret = ftrace_hash_move(ops, enable, orig_hash, hash);
3908e16b35ddSSteven Rostedt (VMware) 	if (!ret) {
3909e16b35ddSSteven Rostedt (VMware) 		ftrace_ops_update_code(ops, &old_hash_ops);
3910e16b35ddSSteven Rostedt (VMware) 		free_ftrace_hash_rcu(old_hash);
3911e16b35ddSSteven Rostedt (VMware) 	}
3912e16b35ddSSteven Rostedt (VMware) 	return ret;
3913e16b35ddSSteven Rostedt (VMware) }
391464e7c440SSteven Rostedt 
3915673feb9dSSteven Rostedt (VMware) static bool module_exists(const char *module)
3916673feb9dSSteven Rostedt (VMware) {
3917673feb9dSSteven Rostedt (VMware) 	/* All modules have the symbol __this_module */
3918673feb9dSSteven Rostedt (VMware) 	const char this_mod[] = "__this_module";
3919673feb9dSSteven Rostedt (VMware) 	const int modname_size = MAX_PARAM_PREFIX_LEN + sizeof(this_mod) + 1;
3920673feb9dSSteven Rostedt (VMware) 	char modname[modname_size + 1];
3921673feb9dSSteven Rostedt (VMware) 	unsigned long val;
3922673feb9dSSteven Rostedt (VMware) 	int n;
3923673feb9dSSteven Rostedt (VMware) 
3924673feb9dSSteven Rostedt (VMware) 	n = snprintf(modname, modname_size + 1, "%s:%s", module, this_mod);
3925673feb9dSSteven Rostedt (VMware) 
3926673feb9dSSteven Rostedt (VMware) 	if (n > modname_size)
3927673feb9dSSteven Rostedt (VMware) 		return false;
3928673feb9dSSteven Rostedt (VMware) 
3929673feb9dSSteven Rostedt (VMware) 	val = module_kallsyms_lookup_name(modname);
3930673feb9dSSteven Rostedt (VMware) 	return val != 0;
3931673feb9dSSteven Rostedt (VMware) }
3932673feb9dSSteven Rostedt (VMware) 
3933673feb9dSSteven Rostedt (VMware) static int cache_mod(struct trace_array *tr,
3934673feb9dSSteven Rostedt (VMware) 		     const char *func, char *module, int enable)
3935673feb9dSSteven Rostedt (VMware) {
3936673feb9dSSteven Rostedt (VMware) 	struct ftrace_mod_load *ftrace_mod, *n;
3937673feb9dSSteven Rostedt (VMware) 	struct list_head *head = enable ? &tr->mod_trace : &tr->mod_notrace;
3938673feb9dSSteven Rostedt (VMware) 	int ret;
3939673feb9dSSteven Rostedt (VMware) 
3940673feb9dSSteven Rostedt (VMware) 	mutex_lock(&ftrace_lock);
3941673feb9dSSteven Rostedt (VMware) 
3942673feb9dSSteven Rostedt (VMware) 	/* We do not cache inverse filters */
3943673feb9dSSteven Rostedt (VMware) 	if (func[0] == '!') {
3944673feb9dSSteven Rostedt (VMware) 		func++;
3945673feb9dSSteven Rostedt (VMware) 		ret = -EINVAL;
3946673feb9dSSteven Rostedt (VMware) 
3947673feb9dSSteven Rostedt (VMware) 		/* Look to remove this hash */
3948673feb9dSSteven Rostedt (VMware) 		list_for_each_entry_safe(ftrace_mod, n, head, list) {
3949673feb9dSSteven Rostedt (VMware) 			if (strcmp(ftrace_mod->module, module) != 0)
3950673feb9dSSteven Rostedt (VMware) 				continue;
3951673feb9dSSteven Rostedt (VMware) 
3952673feb9dSSteven Rostedt (VMware) 			/* no func matches all */
3953*44925dffSDan Carpenter 			if (strcmp(func, "*") == 0 ||
3954673feb9dSSteven Rostedt (VMware) 			    (ftrace_mod->func &&
3955673feb9dSSteven Rostedt (VMware) 			     strcmp(ftrace_mod->func, func) == 0)) {
3956673feb9dSSteven Rostedt (VMware) 				ret = 0;
3957673feb9dSSteven Rostedt (VMware) 				free_ftrace_mod(ftrace_mod);
3958673feb9dSSteven Rostedt (VMware) 				continue;
3959673feb9dSSteven Rostedt (VMware) 			}
3960673feb9dSSteven Rostedt (VMware) 		}
3961673feb9dSSteven Rostedt (VMware) 		goto out;
3962673feb9dSSteven Rostedt (VMware) 	}
3963673feb9dSSteven Rostedt (VMware) 
3964673feb9dSSteven Rostedt (VMware) 	ret = -EINVAL;
3965673feb9dSSteven Rostedt (VMware) 	/* We only care about modules that have not been loaded yet */
3966673feb9dSSteven Rostedt (VMware) 	if (module_exists(module))
3967673feb9dSSteven Rostedt (VMware) 		goto out;
3968673feb9dSSteven Rostedt (VMware) 
3969673feb9dSSteven Rostedt (VMware) 	/* Save this string off, and execute it when the module is loaded */
3970673feb9dSSteven Rostedt (VMware) 	ret = ftrace_add_mod(tr, func, module, enable);
3971673feb9dSSteven Rostedt (VMware)  out:
3972673feb9dSSteven Rostedt (VMware) 	mutex_unlock(&ftrace_lock);
3973673feb9dSSteven Rostedt (VMware) 
3974673feb9dSSteven Rostedt (VMware) 	return ret;
3975673feb9dSSteven Rostedt (VMware) }
3976673feb9dSSteven Rostedt (VMware) 
3977d7fbf8dfSSteven Rostedt (VMware) static int
3978d7fbf8dfSSteven Rostedt (VMware) ftrace_set_regex(struct ftrace_ops *ops, unsigned char *buf, int len,
3979d7fbf8dfSSteven Rostedt (VMware) 		 int reset, int enable);
3980d7fbf8dfSSteven Rostedt (VMware) 
398169449bbdSArnd Bergmann #ifdef CONFIG_MODULES
3982d7fbf8dfSSteven Rostedt (VMware) static void process_mod_list(struct list_head *head, struct ftrace_ops *ops,
3983d7fbf8dfSSteven Rostedt (VMware) 			     char *mod, bool enable)
3984d7fbf8dfSSteven Rostedt (VMware) {
3985d7fbf8dfSSteven Rostedt (VMware) 	struct ftrace_mod_load *ftrace_mod, *n;
3986d7fbf8dfSSteven Rostedt (VMware) 	struct ftrace_hash **orig_hash, *new_hash;
3987d7fbf8dfSSteven Rostedt (VMware) 	LIST_HEAD(process_mods);
3988d7fbf8dfSSteven Rostedt (VMware) 	char *func;
3989d7fbf8dfSSteven Rostedt (VMware) 	int ret;
3990d7fbf8dfSSteven Rostedt (VMware) 
3991d7fbf8dfSSteven Rostedt (VMware) 	mutex_lock(&ops->func_hash->regex_lock);
3992d7fbf8dfSSteven Rostedt (VMware) 
3993d7fbf8dfSSteven Rostedt (VMware) 	if (enable)
3994d7fbf8dfSSteven Rostedt (VMware) 		orig_hash = &ops->func_hash->filter_hash;
3995d7fbf8dfSSteven Rostedt (VMware) 	else
3996d7fbf8dfSSteven Rostedt (VMware) 		orig_hash = &ops->func_hash->notrace_hash;
3997d7fbf8dfSSteven Rostedt (VMware) 
3998d7fbf8dfSSteven Rostedt (VMware) 	new_hash = alloc_and_copy_ftrace_hash(FTRACE_HASH_DEFAULT_BITS,
3999d7fbf8dfSSteven Rostedt (VMware) 					      *orig_hash);
4000d7fbf8dfSSteven Rostedt (VMware) 	if (!new_hash)
40013b58a3c7SSteven Rostedt (VMware) 		goto out; /* warn? */
4002d7fbf8dfSSteven Rostedt (VMware) 
4003d7fbf8dfSSteven Rostedt (VMware) 	mutex_lock(&ftrace_lock);
4004d7fbf8dfSSteven Rostedt (VMware) 
4005d7fbf8dfSSteven Rostedt (VMware) 	list_for_each_entry_safe(ftrace_mod, n, head, list) {
4006d7fbf8dfSSteven Rostedt (VMware) 
4007d7fbf8dfSSteven Rostedt (VMware) 		if (strcmp(ftrace_mod->module, mod) != 0)
4008d7fbf8dfSSteven Rostedt (VMware) 			continue;
4009d7fbf8dfSSteven Rostedt (VMware) 
4010d7fbf8dfSSteven Rostedt (VMware) 		if (ftrace_mod->func)
4011d7fbf8dfSSteven Rostedt (VMware) 			func = kstrdup(ftrace_mod->func, GFP_KERNEL);
4012d7fbf8dfSSteven Rostedt (VMware) 		else
4013d7fbf8dfSSteven Rostedt (VMware) 			func = kstrdup("*", GFP_KERNEL);
4014d7fbf8dfSSteven Rostedt (VMware) 
4015d7fbf8dfSSteven Rostedt (VMware) 		if (!func) /* warn? */
4016d7fbf8dfSSteven Rostedt (VMware) 			continue;
4017d7fbf8dfSSteven Rostedt (VMware) 
4018d7fbf8dfSSteven Rostedt (VMware) 		list_del(&ftrace_mod->list);
4019d7fbf8dfSSteven Rostedt (VMware) 		list_add(&ftrace_mod->list, &process_mods);
4020d7fbf8dfSSteven Rostedt (VMware) 
4021d7fbf8dfSSteven Rostedt (VMware) 		/* Use the newly allocated func, as it may be "*" */
4022d7fbf8dfSSteven Rostedt (VMware) 		kfree(ftrace_mod->func);
4023d7fbf8dfSSteven Rostedt (VMware) 		ftrace_mod->func = func;
4024d7fbf8dfSSteven Rostedt (VMware) 	}
4025d7fbf8dfSSteven Rostedt (VMware) 
4026d7fbf8dfSSteven Rostedt (VMware) 	mutex_unlock(&ftrace_lock);
4027d7fbf8dfSSteven Rostedt (VMware) 
4028d7fbf8dfSSteven Rostedt (VMware) 	list_for_each_entry_safe(ftrace_mod, n, &process_mods, list) {
4029d7fbf8dfSSteven Rostedt (VMware) 
4030d7fbf8dfSSteven Rostedt (VMware) 		func = ftrace_mod->func;
4031d7fbf8dfSSteven Rostedt (VMware) 
4032d7fbf8dfSSteven Rostedt (VMware) 		/* Grabs ftrace_lock, which is why we have this extra step */
4033d7fbf8dfSSteven Rostedt (VMware) 		match_records(new_hash, func, strlen(func), mod);
4034d7fbf8dfSSteven Rostedt (VMware) 		free_ftrace_mod(ftrace_mod);
4035d7fbf8dfSSteven Rostedt (VMware) 	}
4036d7fbf8dfSSteven Rostedt (VMware) 
40378c08f0d5SSteven Rostedt (VMware) 	if (enable && list_empty(head))
40388c08f0d5SSteven Rostedt (VMware) 		new_hash->flags &= ~FTRACE_HASH_FL_MOD;
40398c08f0d5SSteven Rostedt (VMware) 
4040d7fbf8dfSSteven Rostedt (VMware) 	mutex_lock(&ftrace_lock);
4041d7fbf8dfSSteven Rostedt (VMware) 
4042d7fbf8dfSSteven Rostedt (VMware) 	ret = ftrace_hash_move_and_update_ops(ops, orig_hash,
4043d7fbf8dfSSteven Rostedt (VMware) 					      new_hash, enable);
4044d7fbf8dfSSteven Rostedt (VMware) 	mutex_unlock(&ftrace_lock);
4045d7fbf8dfSSteven Rostedt (VMware) 
40463b58a3c7SSteven Rostedt (VMware)  out:
4047d7fbf8dfSSteven Rostedt (VMware) 	mutex_unlock(&ops->func_hash->regex_lock);
4048d7fbf8dfSSteven Rostedt (VMware) 
4049d7fbf8dfSSteven Rostedt (VMware) 	free_ftrace_hash(new_hash);
4050d7fbf8dfSSteven Rostedt (VMware) }
4051d7fbf8dfSSteven Rostedt (VMware) 
4052d7fbf8dfSSteven Rostedt (VMware) static void process_cached_mods(const char *mod_name)
4053d7fbf8dfSSteven Rostedt (VMware) {
4054d7fbf8dfSSteven Rostedt (VMware) 	struct trace_array *tr;
4055d7fbf8dfSSteven Rostedt (VMware) 	char *mod;
4056d7fbf8dfSSteven Rostedt (VMware) 
4057d7fbf8dfSSteven Rostedt (VMware) 	mod = kstrdup(mod_name, GFP_KERNEL);
4058d7fbf8dfSSteven Rostedt (VMware) 	if (!mod)
4059d7fbf8dfSSteven Rostedt (VMware) 		return;
4060d7fbf8dfSSteven Rostedt (VMware) 
4061d7fbf8dfSSteven Rostedt (VMware) 	mutex_lock(&trace_types_lock);
4062d7fbf8dfSSteven Rostedt (VMware) 	list_for_each_entry(tr, &ftrace_trace_arrays, list) {
4063d7fbf8dfSSteven Rostedt (VMware) 		if (!list_empty(&tr->mod_trace))
4064d7fbf8dfSSteven Rostedt (VMware) 			process_mod_list(&tr->mod_trace, tr->ops, mod, true);
4065d7fbf8dfSSteven Rostedt (VMware) 		if (!list_empty(&tr->mod_notrace))
4066d7fbf8dfSSteven Rostedt (VMware) 			process_mod_list(&tr->mod_notrace, tr->ops, mod, false);
4067d7fbf8dfSSteven Rostedt (VMware) 	}
4068d7fbf8dfSSteven Rostedt (VMware) 	mutex_unlock(&trace_types_lock);
4069d7fbf8dfSSteven Rostedt (VMware) 
4070d7fbf8dfSSteven Rostedt (VMware) 	kfree(mod);
4071d7fbf8dfSSteven Rostedt (VMware) }
407269449bbdSArnd Bergmann #endif
4073d7fbf8dfSSteven Rostedt (VMware) 
4074f6180773SSteven Rostedt /*
4075f6180773SSteven Rostedt  * We register the module command as a template to show others how
4076f6180773SSteven Rostedt  * to register the a command as well.
4077f6180773SSteven Rostedt  */
4078f6180773SSteven Rostedt 
4079f6180773SSteven Rostedt static int
408004ec7bb6SSteven Rostedt (VMware) ftrace_mod_callback(struct trace_array *tr, struct ftrace_hash *hash,
4081673feb9dSSteven Rostedt (VMware) 		    char *func_orig, char *cmd, char *module, int enable)
4082f6180773SSteven Rostedt {
4083673feb9dSSteven Rostedt (VMware) 	char *func;
40845e3949f0SDmitry Safonov 	int ret;
4085f6180773SSteven Rostedt 
4086673feb9dSSteven Rostedt (VMware) 	/* match_records() modifies func, and we need the original */
4087673feb9dSSteven Rostedt (VMware) 	func = kstrdup(func_orig, GFP_KERNEL);
4088673feb9dSSteven Rostedt (VMware) 	if (!func)
4089673feb9dSSteven Rostedt (VMware) 		return -ENOMEM;
4090673feb9dSSteven Rostedt (VMware) 
4091f6180773SSteven Rostedt 	/*
4092f6180773SSteven Rostedt 	 * cmd == 'mod' because we only registered this func
4093f6180773SSteven Rostedt 	 * for the 'mod' ftrace_func_command.
4094f6180773SSteven Rostedt 	 * But if you register one func with multiple commands,
4095f6180773SSteven Rostedt 	 * you can tell which command was used by the cmd
4096f6180773SSteven Rostedt 	 * parameter.
4097f6180773SSteven Rostedt 	 */
4098f0a3b154SDmitry Safonov 	ret = match_records(hash, func, strlen(func), module);
4099673feb9dSSteven Rostedt (VMware) 	kfree(func);
4100673feb9dSSteven Rostedt (VMware) 
4101b448c4e3SSteven Rostedt 	if (!ret)
4102673feb9dSSteven Rostedt (VMware) 		return cache_mod(tr, func_orig, module, enable);
4103b448c4e3SSteven Rostedt 	if (ret < 0)
4104b448c4e3SSteven Rostedt 		return ret;
4105f6180773SSteven Rostedt 	return 0;
4106f6180773SSteven Rostedt }
4107f6180773SSteven Rostedt 
4108f6180773SSteven Rostedt static struct ftrace_func_command ftrace_mod_cmd = {
4109f6180773SSteven Rostedt 	.name			= "mod",
4110f6180773SSteven Rostedt 	.func			= ftrace_mod_callback,
4111f6180773SSteven Rostedt };
4112f6180773SSteven Rostedt 
4113f6180773SSteven Rostedt static int __init ftrace_mod_cmd_init(void)
4114f6180773SSteven Rostedt {
4115f6180773SSteven Rostedt 	return register_ftrace_command(&ftrace_mod_cmd);
4116f6180773SSteven Rostedt }
41176f415672SSteven Rostedt core_initcall(ftrace_mod_cmd_init);
4118f6180773SSteven Rostedt 
41192f5f6ad9SSteven Rostedt static void function_trace_probe_call(unsigned long ip, unsigned long parent_ip,
4120a1e2e31dSSteven Rostedt 				      struct ftrace_ops *op, struct pt_regs *pt_regs)
412159df055fSSteven Rostedt {
4122eee8ded1SSteven Rostedt (VMware) 	struct ftrace_probe_ops *probe_ops;
41237b60f3d8SSteven Rostedt (VMware) 	struct ftrace_func_probe *probe;
412459df055fSSteven Rostedt 
41257b60f3d8SSteven Rostedt (VMware) 	probe = container_of(op, struct ftrace_func_probe, ops);
41267b60f3d8SSteven Rostedt (VMware) 	probe_ops = probe->probe_ops;
412759df055fSSteven Rostedt 
412859df055fSSteven Rostedt 	/*
412959df055fSSteven Rostedt 	 * Disable preemption for these calls to prevent a RCU grace
413059df055fSSteven Rostedt 	 * period. This syncs the hash iteration and freeing of items
413159df055fSSteven Rostedt 	 * on the hash. rcu_read_lock is too dangerous here.
413259df055fSSteven Rostedt 	 */
41335168ae50SSteven Rostedt 	preempt_disable_notrace();
41346e444319SSteven Rostedt (VMware) 	probe_ops->func(ip, parent_ip, probe->tr, probe_ops, probe->data);
41355168ae50SSteven Rostedt 	preempt_enable_notrace();
413659df055fSSteven Rostedt }
413759df055fSSteven Rostedt 
413841794f19SSteven Rostedt (VMware) struct ftrace_func_map {
413941794f19SSteven Rostedt (VMware) 	struct ftrace_func_entry	entry;
414041794f19SSteven Rostedt (VMware) 	void				*data;
414159df055fSSteven Rostedt };
414259df055fSSteven Rostedt 
414341794f19SSteven Rostedt (VMware) struct ftrace_func_mapper {
414441794f19SSteven Rostedt (VMware) 	struct ftrace_hash		hash;
414541794f19SSteven Rostedt (VMware) };
414659df055fSSteven Rostedt 
414741794f19SSteven Rostedt (VMware) /**
414841794f19SSteven Rostedt (VMware)  * allocate_ftrace_func_mapper - allocate a new ftrace_func_mapper
414941794f19SSteven Rostedt (VMware)  *
415041794f19SSteven Rostedt (VMware)  * Returns a ftrace_func_mapper descriptor that can be used to map ips to data.
415141794f19SSteven Rostedt (VMware)  */
415241794f19SSteven Rostedt (VMware) struct ftrace_func_mapper *allocate_ftrace_func_mapper(void)
415359df055fSSteven Rostedt {
4154e1df4cb6SSteven Rostedt (Red Hat) 	struct ftrace_hash *hash;
415559df055fSSteven Rostedt 
415641794f19SSteven Rostedt (VMware) 	/*
415741794f19SSteven Rostedt (VMware) 	 * The mapper is simply a ftrace_hash, but since the entries
415841794f19SSteven Rostedt (VMware) 	 * in the hash are not ftrace_func_entry type, we define it
415941794f19SSteven Rostedt (VMware) 	 * as a separate structure.
416041794f19SSteven Rostedt (VMware) 	 */
416141794f19SSteven Rostedt (VMware) 	hash = alloc_ftrace_hash(FTRACE_HASH_DEFAULT_BITS);
416241794f19SSteven Rostedt (VMware) 	return (struct ftrace_func_mapper *)hash;
4163e1df4cb6SSteven Rostedt (Red Hat) }
4164e1df4cb6SSteven Rostedt (Red Hat) 
416541794f19SSteven Rostedt (VMware) /**
416641794f19SSteven Rostedt (VMware)  * ftrace_func_mapper_find_ip - Find some data mapped to an ip
416741794f19SSteven Rostedt (VMware)  * @mapper: The mapper that has the ip maps
416841794f19SSteven Rostedt (VMware)  * @ip: the instruction pointer to find the data for
416941794f19SSteven Rostedt (VMware)  *
417041794f19SSteven Rostedt (VMware)  * Returns the data mapped to @ip if found otherwise NULL. The return
417141794f19SSteven Rostedt (VMware)  * is actually the address of the mapper data pointer. The address is
417241794f19SSteven Rostedt (VMware)  * returned for use cases where the data is no bigger than a long, and
417341794f19SSteven Rostedt (VMware)  * the user can use the data pointer as its data instead of having to
417441794f19SSteven Rostedt (VMware)  * allocate more memory for the reference.
417541794f19SSteven Rostedt (VMware)  */
417641794f19SSteven Rostedt (VMware) void **ftrace_func_mapper_find_ip(struct ftrace_func_mapper *mapper,
417741794f19SSteven Rostedt (VMware) 				  unsigned long ip)
417841794f19SSteven Rostedt (VMware) {
417941794f19SSteven Rostedt (VMware) 	struct ftrace_func_entry *entry;
418041794f19SSteven Rostedt (VMware) 	struct ftrace_func_map *map;
418141794f19SSteven Rostedt (VMware) 
418241794f19SSteven Rostedt (VMware) 	entry = ftrace_lookup_ip(&mapper->hash, ip);
418341794f19SSteven Rostedt (VMware) 	if (!entry)
418441794f19SSteven Rostedt (VMware) 		return NULL;
418541794f19SSteven Rostedt (VMware) 
418641794f19SSteven Rostedt (VMware) 	map = (struct ftrace_func_map *)entry;
418741794f19SSteven Rostedt (VMware) 	return &map->data;
4188e1df4cb6SSteven Rostedt (Red Hat) }
418945a4a237SSteven Rostedt 
419041794f19SSteven Rostedt (VMware) /**
419141794f19SSteven Rostedt (VMware)  * ftrace_func_mapper_add_ip - Map some data to an ip
419241794f19SSteven Rostedt (VMware)  * @mapper: The mapper that has the ip maps
419341794f19SSteven Rostedt (VMware)  * @ip: The instruction pointer address to map @data to
419441794f19SSteven Rostedt (VMware)  * @data: The data to map to @ip
419541794f19SSteven Rostedt (VMware)  *
419641794f19SSteven Rostedt (VMware)  * Returns 0 on succes otherwise an error.
419741794f19SSteven Rostedt (VMware)  */
419841794f19SSteven Rostedt (VMware) int ftrace_func_mapper_add_ip(struct ftrace_func_mapper *mapper,
419941794f19SSteven Rostedt (VMware) 			      unsigned long ip, void *data)
420041794f19SSteven Rostedt (VMware) {
420141794f19SSteven Rostedt (VMware) 	struct ftrace_func_entry *entry;
420241794f19SSteven Rostedt (VMware) 	struct ftrace_func_map *map;
420341794f19SSteven Rostedt (VMware) 
420441794f19SSteven Rostedt (VMware) 	entry = ftrace_lookup_ip(&mapper->hash, ip);
420541794f19SSteven Rostedt (VMware) 	if (entry)
420641794f19SSteven Rostedt (VMware) 		return -EBUSY;
420741794f19SSteven Rostedt (VMware) 
420841794f19SSteven Rostedt (VMware) 	map = kmalloc(sizeof(*map), GFP_KERNEL);
420941794f19SSteven Rostedt (VMware) 	if (!map)
421041794f19SSteven Rostedt (VMware) 		return -ENOMEM;
421141794f19SSteven Rostedt (VMware) 
421241794f19SSteven Rostedt (VMware) 	map->entry.ip = ip;
421341794f19SSteven Rostedt (VMware) 	map->data = data;
421441794f19SSteven Rostedt (VMware) 
421541794f19SSteven Rostedt (VMware) 	__add_hash_entry(&mapper->hash, &map->entry);
421641794f19SSteven Rostedt (VMware) 
421741794f19SSteven Rostedt (VMware) 	return 0;
421841794f19SSteven Rostedt (VMware) }
421941794f19SSteven Rostedt (VMware) 
422041794f19SSteven Rostedt (VMware) /**
422141794f19SSteven Rostedt (VMware)  * ftrace_func_mapper_remove_ip - Remove an ip from the mapping
422241794f19SSteven Rostedt (VMware)  * @mapper: The mapper that has the ip maps
422341794f19SSteven Rostedt (VMware)  * @ip: The instruction pointer address to remove the data from
422441794f19SSteven Rostedt (VMware)  *
422541794f19SSteven Rostedt (VMware)  * Returns the data if it is found, otherwise NULL.
422641794f19SSteven Rostedt (VMware)  * Note, if the data pointer is used as the data itself, (see
422741794f19SSteven Rostedt (VMware)  * ftrace_func_mapper_find_ip(), then the return value may be meaningless,
422841794f19SSteven Rostedt (VMware)  * if the data pointer was set to zero.
422941794f19SSteven Rostedt (VMware)  */
423041794f19SSteven Rostedt (VMware) void *ftrace_func_mapper_remove_ip(struct ftrace_func_mapper *mapper,
423141794f19SSteven Rostedt (VMware) 				   unsigned long ip)
423241794f19SSteven Rostedt (VMware) {
423341794f19SSteven Rostedt (VMware) 	struct ftrace_func_entry *entry;
423441794f19SSteven Rostedt (VMware) 	struct ftrace_func_map *map;
423541794f19SSteven Rostedt (VMware) 	void *data;
423641794f19SSteven Rostedt (VMware) 
423741794f19SSteven Rostedt (VMware) 	entry = ftrace_lookup_ip(&mapper->hash, ip);
423841794f19SSteven Rostedt (VMware) 	if (!entry)
423941794f19SSteven Rostedt (VMware) 		return NULL;
424041794f19SSteven Rostedt (VMware) 
424141794f19SSteven Rostedt (VMware) 	map = (struct ftrace_func_map *)entry;
424241794f19SSteven Rostedt (VMware) 	data = map->data;
424341794f19SSteven Rostedt (VMware) 
424441794f19SSteven Rostedt (VMware) 	remove_hash_entry(&mapper->hash, entry);
424541794f19SSteven Rostedt (VMware) 	kfree(entry);
424641794f19SSteven Rostedt (VMware) 
424741794f19SSteven Rostedt (VMware) 	return data;
424841794f19SSteven Rostedt (VMware) }
424941794f19SSteven Rostedt (VMware) 
425041794f19SSteven Rostedt (VMware) /**
425141794f19SSteven Rostedt (VMware)  * free_ftrace_func_mapper - free a mapping of ips and data
425241794f19SSteven Rostedt (VMware)  * @mapper: The mapper that has the ip maps
425341794f19SSteven Rostedt (VMware)  * @free_func: A function to be called on each data item.
425441794f19SSteven Rostedt (VMware)  *
425541794f19SSteven Rostedt (VMware)  * This is used to free the function mapper. The @free_func is optional
425641794f19SSteven Rostedt (VMware)  * and can be used if the data needs to be freed as well.
425741794f19SSteven Rostedt (VMware)  */
425841794f19SSteven Rostedt (VMware) void free_ftrace_func_mapper(struct ftrace_func_mapper *mapper,
425941794f19SSteven Rostedt (VMware) 			     ftrace_mapper_func free_func)
426041794f19SSteven Rostedt (VMware) {
426141794f19SSteven Rostedt (VMware) 	struct ftrace_func_entry *entry;
426241794f19SSteven Rostedt (VMware) 	struct ftrace_func_map *map;
426341794f19SSteven Rostedt (VMware) 	struct hlist_head *hhd;
426441794f19SSteven Rostedt (VMware) 	int size = 1 << mapper->hash.size_bits;
426541794f19SSteven Rostedt (VMware) 	int i;
426641794f19SSteven Rostedt (VMware) 
426741794f19SSteven Rostedt (VMware) 	if (free_func && mapper->hash.count) {
426841794f19SSteven Rostedt (VMware) 		for (i = 0; i < size; i++) {
426941794f19SSteven Rostedt (VMware) 			hhd = &mapper->hash.buckets[i];
427041794f19SSteven Rostedt (VMware) 			hlist_for_each_entry(entry, hhd, hlist) {
427141794f19SSteven Rostedt (VMware) 				map = (struct ftrace_func_map *)entry;
427241794f19SSteven Rostedt (VMware) 				free_func(map);
427341794f19SSteven Rostedt (VMware) 			}
427441794f19SSteven Rostedt (VMware) 		}
427541794f19SSteven Rostedt (VMware) 	}
427641794f19SSteven Rostedt (VMware) 	free_ftrace_hash(&mapper->hash);
427741794f19SSteven Rostedt (VMware) }
427841794f19SSteven Rostedt (VMware) 
42797b60f3d8SSteven Rostedt (VMware) static void release_probe(struct ftrace_func_probe *probe)
42807b60f3d8SSteven Rostedt (VMware) {
42817b60f3d8SSteven Rostedt (VMware) 	struct ftrace_probe_ops *probe_ops;
42827b60f3d8SSteven Rostedt (VMware) 
42835ae0bf59SSteven Rostedt (Red Hat) 	mutex_lock(&ftrace_lock);
42845ae0bf59SSteven Rostedt (Red Hat) 
42857b60f3d8SSteven Rostedt (VMware) 	WARN_ON(probe->ref <= 0);
428659df055fSSteven Rostedt 
42877b60f3d8SSteven Rostedt (VMware) 	/* Subtract the ref that was used to protect this instance */
42887b60f3d8SSteven Rostedt (VMware) 	probe->ref--;
4289546fece4SSteven Rostedt (Red Hat) 
42907b60f3d8SSteven Rostedt (VMware) 	if (!probe->ref) {
42917b60f3d8SSteven Rostedt (VMware) 		probe_ops = probe->probe_ops;
42926e444319SSteven Rostedt (VMware) 		/*
42936e444319SSteven Rostedt (VMware) 		 * Sending zero as ip tells probe_ops to free
42946e444319SSteven Rostedt (VMware) 		 * the probe->data itself
42956e444319SSteven Rostedt (VMware) 		 */
42966e444319SSteven Rostedt (VMware) 		if (probe_ops->free)
42976e444319SSteven Rostedt (VMware) 			probe_ops->free(probe_ops, probe->tr, 0, probe->data);
42987b60f3d8SSteven Rostedt (VMware) 		list_del(&probe->list);
42997b60f3d8SSteven Rostedt (VMware) 		kfree(probe);
43007b60f3d8SSteven Rostedt (VMware) 	}
43017b60f3d8SSteven Rostedt (VMware) 	mutex_unlock(&ftrace_lock);
430259df055fSSteven Rostedt }
430359df055fSSteven Rostedt 
43047b60f3d8SSteven Rostedt (VMware) static void acquire_probe_locked(struct ftrace_func_probe *probe)
43057b60f3d8SSteven Rostedt (VMware) {
43067b60f3d8SSteven Rostedt (VMware) 	/*
43077b60f3d8SSteven Rostedt (VMware) 	 * Add one ref to keep it from being freed when releasing the
43087b60f3d8SSteven Rostedt (VMware) 	 * ftrace_lock mutex.
43097b60f3d8SSteven Rostedt (VMware) 	 */
43107b60f3d8SSteven Rostedt (VMware) 	probe->ref++;
43117b60f3d8SSteven Rostedt (VMware) }
431259df055fSSteven Rostedt 
431359df055fSSteven Rostedt int
431404ec7bb6SSteven Rostedt (VMware) register_ftrace_function_probe(char *glob, struct trace_array *tr,
43157b60f3d8SSteven Rostedt (VMware) 			       struct ftrace_probe_ops *probe_ops,
43167b60f3d8SSteven Rostedt (VMware) 			       void *data)
431759df055fSSteven Rostedt {
43181ec3a81aSSteven Rostedt (VMware) 	struct ftrace_func_entry *entry;
43197b60f3d8SSteven Rostedt (VMware) 	struct ftrace_func_probe *probe;
43201ec3a81aSSteven Rostedt (VMware) 	struct ftrace_hash **orig_hash;
43211ec3a81aSSteven Rostedt (VMware) 	struct ftrace_hash *old_hash;
432259df055fSSteven Rostedt 	struct ftrace_hash *hash;
432359df055fSSteven Rostedt 	int count = 0;
43241ec3a81aSSteven Rostedt (VMware) 	int size;
432559df055fSSteven Rostedt 	int ret;
43261ec3a81aSSteven Rostedt (VMware) 	int i;
432759df055fSSteven Rostedt 
432804ec7bb6SSteven Rostedt (VMware) 	if (WARN_ON(!tr))
432904ec7bb6SSteven Rostedt (VMware) 		return -EINVAL;
433004ec7bb6SSteven Rostedt (VMware) 
43311ec3a81aSSteven Rostedt (VMware) 	/* We do not support '!' for function probes */
43321ec3a81aSSteven Rostedt (VMware) 	if (WARN_ON(glob[0] == '!'))
433359df055fSSteven Rostedt 		return -EINVAL;
433459df055fSSteven Rostedt 
43357b60f3d8SSteven Rostedt (VMware) 
43367b60f3d8SSteven Rostedt (VMware) 	mutex_lock(&ftrace_lock);
43377b60f3d8SSteven Rostedt (VMware) 	/* Check if the probe_ops is already registered */
43387b60f3d8SSteven Rostedt (VMware) 	list_for_each_entry(probe, &tr->func_probes, list) {
43397b60f3d8SSteven Rostedt (VMware) 		if (probe->probe_ops == probe_ops)
43407b60f3d8SSteven Rostedt (VMware) 			break;
43417b60f3d8SSteven Rostedt (VMware) 	}
43427b60f3d8SSteven Rostedt (VMware) 	if (&probe->list == &tr->func_probes) {
43437b60f3d8SSteven Rostedt (VMware) 		probe = kzalloc(sizeof(*probe), GFP_KERNEL);
43447b60f3d8SSteven Rostedt (VMware) 		if (!probe) {
43457b60f3d8SSteven Rostedt (VMware) 			mutex_unlock(&ftrace_lock);
43467b60f3d8SSteven Rostedt (VMware) 			return -ENOMEM;
43477b60f3d8SSteven Rostedt (VMware) 		}
43487b60f3d8SSteven Rostedt (VMware) 		probe->probe_ops = probe_ops;
43497b60f3d8SSteven Rostedt (VMware) 		probe->ops.func = function_trace_probe_call;
43507b60f3d8SSteven Rostedt (VMware) 		probe->tr = tr;
43517b60f3d8SSteven Rostedt (VMware) 		ftrace_ops_init(&probe->ops);
43527b60f3d8SSteven Rostedt (VMware) 		list_add(&probe->list, &tr->func_probes);
43531ec3a81aSSteven Rostedt (VMware) 	}
435459df055fSSteven Rostedt 
43557b60f3d8SSteven Rostedt (VMware) 	acquire_probe_locked(probe);
435659df055fSSteven Rostedt 
43577b60f3d8SSteven Rostedt (VMware) 	mutex_unlock(&ftrace_lock);
43587b60f3d8SSteven Rostedt (VMware) 
43597b60f3d8SSteven Rostedt (VMware) 	mutex_lock(&probe->ops.func_hash->regex_lock);
43607b60f3d8SSteven Rostedt (VMware) 
43617b60f3d8SSteven Rostedt (VMware) 	orig_hash = &probe->ops.func_hash->filter_hash;
43621ec3a81aSSteven Rostedt (VMware) 	old_hash = *orig_hash;
436359df055fSSteven Rostedt 	hash = alloc_and_copy_ftrace_hash(FTRACE_HASH_DEFAULT_BITS, old_hash);
43641ec3a81aSSteven Rostedt (VMware) 
43651ec3a81aSSteven Rostedt (VMware) 	ret = ftrace_match_records(hash, glob, strlen(glob));
43661ec3a81aSSteven Rostedt (VMware) 
43671ec3a81aSSteven Rostedt (VMware) 	/* Nothing found? */
43681ec3a81aSSteven Rostedt (VMware) 	if (!ret)
43691ec3a81aSSteven Rostedt (VMware) 		ret = -EINVAL;
43701ec3a81aSSteven Rostedt (VMware) 
43711ec3a81aSSteven Rostedt (VMware) 	if (ret < 0)
437259df055fSSteven Rostedt 		goto out;
437359df055fSSteven Rostedt 
43741ec3a81aSSteven Rostedt (VMware) 	size = 1 << hash->size_bits;
43751ec3a81aSSteven Rostedt (VMware) 	for (i = 0; i < size; i++) {
43761ec3a81aSSteven Rostedt (VMware) 		hlist_for_each_entry(entry, &hash->buckets[i], hlist) {
43771ec3a81aSSteven Rostedt (VMware) 			if (ftrace_lookup_ip(old_hash, entry->ip))
437859df055fSSteven Rostedt 				continue;
437959df055fSSteven Rostedt 			/*
438059df055fSSteven Rostedt 			 * The caller might want to do something special
438159df055fSSteven Rostedt 			 * for each function we find. We call the callback
438259df055fSSteven Rostedt 			 * to give the caller an opportunity to do so.
438359df055fSSteven Rostedt 			 */
43847b60f3d8SSteven Rostedt (VMware) 			if (probe_ops->init) {
43857b60f3d8SSteven Rostedt (VMware) 				ret = probe_ops->init(probe_ops, tr,
43866e444319SSteven Rostedt (VMware) 						      entry->ip, data,
43876e444319SSteven Rostedt (VMware) 						      &probe->data);
43886e444319SSteven Rostedt (VMware) 				if (ret < 0) {
43896e444319SSteven Rostedt (VMware) 					if (probe_ops->free && count)
43906e444319SSteven Rostedt (VMware) 						probe_ops->free(probe_ops, tr,
43916e444319SSteven Rostedt (VMware) 								0, probe->data);
43926e444319SSteven Rostedt (VMware) 					probe->data = NULL;
4393eee8ded1SSteven Rostedt (VMware) 					goto out;
43941ec3a81aSSteven Rostedt (VMware) 				}
43956e444319SSteven Rostedt (VMware) 			}
43961ec3a81aSSteven Rostedt (VMware) 			count++;
439759df055fSSteven Rostedt 		}
439859df055fSSteven Rostedt 	}
439959df055fSSteven Rostedt 
44001ec3a81aSSteven Rostedt (VMware) 	mutex_lock(&ftrace_lock);
44011ec3a81aSSteven Rostedt (VMware) 
44027b60f3d8SSteven Rostedt (VMware) 	if (!count) {
44037b60f3d8SSteven Rostedt (VMware) 		/* Nothing was added? */
44047b60f3d8SSteven Rostedt (VMware) 		ret = -EINVAL;
4405e1df4cb6SSteven Rostedt (Red Hat) 		goto out_unlock;
4406e1df4cb6SSteven Rostedt (Red Hat) 	}
4407e1df4cb6SSteven Rostedt (Red Hat) 
44087b60f3d8SSteven Rostedt (VMware) 	ret = ftrace_hash_move_and_update_ops(&probe->ops, orig_hash,
44091ec3a81aSSteven Rostedt (VMware) 					      hash, 1);
44101ec3a81aSSteven Rostedt (VMware) 	if (ret < 0)
44118d70725eSSteven Rostedt (VMware) 		goto err_unlock;
441259df055fSSteven Rostedt 
44137b60f3d8SSteven Rostedt (VMware) 	/* One ref for each new function traced */
44147b60f3d8SSteven Rostedt (VMware) 	probe->ref += count;
441559df055fSSteven Rostedt 
44167b60f3d8SSteven Rostedt (VMware) 	if (!(probe->ops.flags & FTRACE_OPS_FL_ENABLED))
44177b60f3d8SSteven Rostedt (VMware) 		ret = ftrace_startup(&probe->ops, 0);
4418e1df4cb6SSteven Rostedt (Red Hat) 
441959df055fSSteven Rostedt  out_unlock:
44205ae0bf59SSteven Rostedt (Red Hat) 	mutex_unlock(&ftrace_lock);
442159df055fSSteven Rostedt 
442259df055fSSteven Rostedt 	if (!ret)
44231ec3a81aSSteven Rostedt (VMware) 		ret = count;
44245ae0bf59SSteven Rostedt (Red Hat)  out:
44257b60f3d8SSteven Rostedt (VMware) 	mutex_unlock(&probe->ops.func_hash->regex_lock);
4426e1df4cb6SSteven Rostedt (Red Hat) 	free_ftrace_hash(hash);
442759df055fSSteven Rostedt 
44287b60f3d8SSteven Rostedt (VMware) 	release_probe(probe);
44297b60f3d8SSteven Rostedt (VMware) 
44301ec3a81aSSteven Rostedt (VMware) 	return ret;
44318d70725eSSteven Rostedt (VMware) 
44328d70725eSSteven Rostedt (VMware)  err_unlock:
44337b60f3d8SSteven Rostedt (VMware) 	if (!probe_ops->free || !count)
44348d70725eSSteven Rostedt (VMware) 		goto out_unlock;
44358d70725eSSteven Rostedt (VMware) 
44368d70725eSSteven Rostedt (VMware) 	/* Failed to do the move, need to call the free functions */
44378d70725eSSteven Rostedt (VMware) 	for (i = 0; i < size; i++) {
44388d70725eSSteven Rostedt (VMware) 		hlist_for_each_entry(entry, &hash->buckets[i], hlist) {
44398d70725eSSteven Rostedt (VMware) 			if (ftrace_lookup_ip(old_hash, entry->ip))
44408d70725eSSteven Rostedt (VMware) 				continue;
44416e444319SSteven Rostedt (VMware) 			probe_ops->free(probe_ops, tr, entry->ip, probe->data);
44428d70725eSSteven Rostedt (VMware) 		}
44438d70725eSSteven Rostedt (VMware) 	}
44448d70725eSSteven Rostedt (VMware) 	goto out_unlock;
444559df055fSSteven Rostedt }
444659df055fSSteven Rostedt 
4447d3d532d7SSteven Rostedt (VMware) int
44487b60f3d8SSteven Rostedt (VMware) unregister_ftrace_function_probe_func(char *glob, struct trace_array *tr,
44497b60f3d8SSteven Rostedt (VMware) 				      struct ftrace_probe_ops *probe_ops)
445059df055fSSteven Rostedt {
445182cc4fc2SSteven Rostedt (VMware) 	struct ftrace_ops_hash old_hash_ops;
4452eee8ded1SSteven Rostedt (VMware) 	struct ftrace_func_entry *entry;
44537b60f3d8SSteven Rostedt (VMware) 	struct ftrace_func_probe *probe;
44543ba00929SDmitry Safonov 	struct ftrace_glob func_g;
44551ec3a81aSSteven Rostedt (VMware) 	struct ftrace_hash **orig_hash;
44561ec3a81aSSteven Rostedt (VMware) 	struct ftrace_hash *old_hash;
44571ec3a81aSSteven Rostedt (VMware) 	struct ftrace_hash *hash = NULL;
4458b67bfe0dSSasha Levin 	struct hlist_node *tmp;
4459eee8ded1SSteven Rostedt (VMware) 	struct hlist_head hhd;
446059df055fSSteven Rostedt 	char str[KSYM_SYMBOL_LEN];
44617b60f3d8SSteven Rostedt (VMware) 	int count = 0;
44627b60f3d8SSteven Rostedt (VMware) 	int i, ret = -ENODEV;
4463eee8ded1SSteven Rostedt (VMware) 	int size;
446459df055fSSteven Rostedt 
4465cbab567cSNaveen N. Rao 	if (!glob || !strlen(glob) || !strcmp(glob, "*"))
44663ba00929SDmitry Safonov 		func_g.search = NULL;
4467cbab567cSNaveen N. Rao 	else {
446859df055fSSteven Rostedt 		int not;
446959df055fSSteven Rostedt 
44703ba00929SDmitry Safonov 		func_g.type = filter_parse_regex(glob, strlen(glob),
44713ba00929SDmitry Safonov 						 &func_g.search, &not);
44723ba00929SDmitry Safonov 		func_g.len = strlen(func_g.search);
44733ba00929SDmitry Safonov 		func_g.search = glob;
447459df055fSSteven Rostedt 
4475b6887d79SSteven Rostedt 		/* we do not support '!' for function probes */
447659df055fSSteven Rostedt 		if (WARN_ON(not))
4477d3d532d7SSteven Rostedt (VMware) 			return -EINVAL;
447859df055fSSteven Rostedt 	}
447959df055fSSteven Rostedt 
44807b60f3d8SSteven Rostedt (VMware) 	mutex_lock(&ftrace_lock);
44817b60f3d8SSteven Rostedt (VMware) 	/* Check if the probe_ops is already registered */
44827b60f3d8SSteven Rostedt (VMware) 	list_for_each_entry(probe, &tr->func_probes, list) {
44837b60f3d8SSteven Rostedt (VMware) 		if (probe->probe_ops == probe_ops)
44847b60f3d8SSteven Rostedt (VMware) 			break;
44857b60f3d8SSteven Rostedt (VMware) 	}
44867b60f3d8SSteven Rostedt (VMware) 	if (&probe->list == &tr->func_probes)
44877b60f3d8SSteven Rostedt (VMware) 		goto err_unlock_ftrace;
44881ec3a81aSSteven Rostedt (VMware) 
44891ec3a81aSSteven Rostedt (VMware) 	ret = -EINVAL;
44907b60f3d8SSteven Rostedt (VMware) 	if (!(probe->ops.flags & FTRACE_OPS_FL_INITIALIZED))
44917b60f3d8SSteven Rostedt (VMware) 		goto err_unlock_ftrace;
44927b60f3d8SSteven Rostedt (VMware) 
44937b60f3d8SSteven Rostedt (VMware) 	acquire_probe_locked(probe);
44947b60f3d8SSteven Rostedt (VMware) 
44957b60f3d8SSteven Rostedt (VMware) 	mutex_unlock(&ftrace_lock);
44967b60f3d8SSteven Rostedt (VMware) 
44977b60f3d8SSteven Rostedt (VMware) 	mutex_lock(&probe->ops.func_hash->regex_lock);
44987b60f3d8SSteven Rostedt (VMware) 
44997b60f3d8SSteven Rostedt (VMware) 	orig_hash = &probe->ops.func_hash->filter_hash;
45007b60f3d8SSteven Rostedt (VMware) 	old_hash = *orig_hash;
45017b60f3d8SSteven Rostedt (VMware) 
45021ec3a81aSSteven Rostedt (VMware) 	if (ftrace_hash_empty(old_hash))
45031ec3a81aSSteven Rostedt (VMware) 		goto out_unlock;
4504e1df4cb6SSteven Rostedt (Red Hat) 
450582cc4fc2SSteven Rostedt (VMware) 	old_hash_ops.filter_hash = old_hash;
450682cc4fc2SSteven Rostedt (VMware) 	/* Probes only have filters */
450782cc4fc2SSteven Rostedt (VMware) 	old_hash_ops.notrace_hash = NULL;
450882cc4fc2SSteven Rostedt (VMware) 
4509d3d532d7SSteven Rostedt (VMware) 	ret = -ENOMEM;
45101ec3a81aSSteven Rostedt (VMware) 	hash = alloc_and_copy_ftrace_hash(FTRACE_HASH_DEFAULT_BITS, old_hash);
4511e1df4cb6SSteven Rostedt (Red Hat) 	if (!hash)
4512e1df4cb6SSteven Rostedt (Red Hat) 		goto out_unlock;
4513e1df4cb6SSteven Rostedt (Red Hat) 
4514eee8ded1SSteven Rostedt (VMware) 	INIT_HLIST_HEAD(&hhd);
45157818b388SSteven Rostedt (Red Hat) 
4516eee8ded1SSteven Rostedt (VMware) 	size = 1 << hash->size_bits;
4517eee8ded1SSteven Rostedt (VMware) 	for (i = 0; i < size; i++) {
4518eee8ded1SSteven Rostedt (VMware) 		hlist_for_each_entry_safe(entry, tmp, &hash->buckets[i], hlist) {
451959df055fSSteven Rostedt 
45203ba00929SDmitry Safonov 			if (func_g.search) {
452159df055fSSteven Rostedt 				kallsyms_lookup(entry->ip, NULL, NULL,
452259df055fSSteven Rostedt 						NULL, str);
45233ba00929SDmitry Safonov 				if (!ftrace_match(str, &func_g))
452459df055fSSteven Rostedt 					continue;
452559df055fSSteven Rostedt 			}
45267b60f3d8SSteven Rostedt (VMware) 			count++;
4527eee8ded1SSteven Rostedt (VMware) 			remove_hash_entry(hash, entry);
4528eee8ded1SSteven Rostedt (VMware) 			hlist_add_head(&entry->hlist, &hhd);
452959df055fSSteven Rostedt 		}
453059df055fSSteven Rostedt 	}
4531d3d532d7SSteven Rostedt (VMware) 
4532d3d532d7SSteven Rostedt (VMware) 	/* Nothing found? */
45337b60f3d8SSteven Rostedt (VMware) 	if (!count) {
4534d3d532d7SSteven Rostedt (VMware) 		ret = -EINVAL;
4535d3d532d7SSteven Rostedt (VMware) 		goto out_unlock;
4536d3d532d7SSteven Rostedt (VMware) 	}
4537d3d532d7SSteven Rostedt (VMware) 
45383f2367baSMasami Hiramatsu 	mutex_lock(&ftrace_lock);
45391ec3a81aSSteven Rostedt (VMware) 
45407b60f3d8SSteven Rostedt (VMware) 	WARN_ON(probe->ref < count);
4541eee8ded1SSteven Rostedt (VMware) 
45427b60f3d8SSteven Rostedt (VMware) 	probe->ref -= count;
45431ec3a81aSSteven Rostedt (VMware) 
45447b60f3d8SSteven Rostedt (VMware) 	if (ftrace_hash_empty(hash))
45457b60f3d8SSteven Rostedt (VMware) 		ftrace_shutdown(&probe->ops, 0);
45467b60f3d8SSteven Rostedt (VMware) 
45477b60f3d8SSteven Rostedt (VMware) 	ret = ftrace_hash_move_and_update_ops(&probe->ops, orig_hash,
45481ec3a81aSSteven Rostedt (VMware) 					      hash, 1);
454982cc4fc2SSteven Rostedt (VMware) 
455082cc4fc2SSteven Rostedt (VMware) 	/* still need to update the function call sites */
45511ec3a81aSSteven Rostedt (VMware) 	if (ftrace_enabled && !ftrace_hash_empty(hash))
45527b60f3d8SSteven Rostedt (VMware) 		ftrace_run_modify_code(&probe->ops, FTRACE_UPDATE_CALLS,
455382cc4fc2SSteven Rostedt (VMware) 				       &old_hash_ops);
45547818b388SSteven Rostedt (Red Hat) 	synchronize_sched();
45553296fc4eSSteven Rostedt (Red Hat) 
4556eee8ded1SSteven Rostedt (VMware) 	hlist_for_each_entry_safe(entry, tmp, &hhd, hlist) {
4557eee8ded1SSteven Rostedt (VMware) 		hlist_del(&entry->hlist);
45587b60f3d8SSteven Rostedt (VMware) 		if (probe_ops->free)
45596e444319SSteven Rostedt (VMware) 			probe_ops->free(probe_ops, tr, entry->ip, probe->data);
4560eee8ded1SSteven Rostedt (VMware) 		kfree(entry);
45617818b388SSteven Rostedt (Red Hat) 	}
45623f2367baSMasami Hiramatsu 	mutex_unlock(&ftrace_lock);
45637818b388SSteven Rostedt (Red Hat) 
4564e1df4cb6SSteven Rostedt (Red Hat)  out_unlock:
45657b60f3d8SSteven Rostedt (VMware) 	mutex_unlock(&probe->ops.func_hash->regex_lock);
4566e1df4cb6SSteven Rostedt (Red Hat) 	free_ftrace_hash(hash);
456759df055fSSteven Rostedt 
45687b60f3d8SSteven Rostedt (VMware) 	release_probe(probe);
456959df055fSSteven Rostedt 
45707b60f3d8SSteven Rostedt (VMware) 	return ret;
457159df055fSSteven Rostedt 
45727b60f3d8SSteven Rostedt (VMware)  err_unlock_ftrace:
45737b60f3d8SSteven Rostedt (VMware) 	mutex_unlock(&ftrace_lock);
4574d3d532d7SSteven Rostedt (VMware) 	return ret;
457559df055fSSteven Rostedt }
457659df055fSSteven Rostedt 
4577a0e6369eSNaveen N. Rao void clear_ftrace_function_probes(struct trace_array *tr)
4578a0e6369eSNaveen N. Rao {
4579a0e6369eSNaveen N. Rao 	struct ftrace_func_probe *probe, *n;
4580a0e6369eSNaveen N. Rao 
4581a0e6369eSNaveen N. Rao 	list_for_each_entry_safe(probe, n, &tr->func_probes, list)
4582a0e6369eSNaveen N. Rao 		unregister_ftrace_function_probe_func(NULL, tr, probe->probe_ops);
4583a0e6369eSNaveen N. Rao }
4584a0e6369eSNaveen N. Rao 
4585f6180773SSteven Rostedt static LIST_HEAD(ftrace_commands);
4586f6180773SSteven Rostedt static DEFINE_MUTEX(ftrace_cmd_mutex);
4587f6180773SSteven Rostedt 
458838de93abSTom Zanussi /*
458938de93abSTom Zanussi  * Currently we only register ftrace commands from __init, so mark this
459038de93abSTom Zanussi  * __init too.
459138de93abSTom Zanussi  */
459238de93abSTom Zanussi __init int register_ftrace_command(struct ftrace_func_command *cmd)
4593f6180773SSteven Rostedt {
4594f6180773SSteven Rostedt 	struct ftrace_func_command *p;
4595f6180773SSteven Rostedt 	int ret = 0;
4596f6180773SSteven Rostedt 
4597f6180773SSteven Rostedt 	mutex_lock(&ftrace_cmd_mutex);
4598f6180773SSteven Rostedt 	list_for_each_entry(p, &ftrace_commands, list) {
4599f6180773SSteven Rostedt 		if (strcmp(cmd->name, p->name) == 0) {
4600f6180773SSteven Rostedt 			ret = -EBUSY;
4601f6180773SSteven Rostedt 			goto out_unlock;
4602f6180773SSteven Rostedt 		}
4603f6180773SSteven Rostedt 	}
4604f6180773SSteven Rostedt 	list_add(&cmd->list, &ftrace_commands);
4605f6180773SSteven Rostedt  out_unlock:
4606f6180773SSteven Rostedt 	mutex_unlock(&ftrace_cmd_mutex);
4607f6180773SSteven Rostedt 
4608f6180773SSteven Rostedt 	return ret;
4609f6180773SSteven Rostedt }
4610f6180773SSteven Rostedt 
461138de93abSTom Zanussi /*
461238de93abSTom Zanussi  * Currently we only unregister ftrace commands from __init, so mark
461338de93abSTom Zanussi  * this __init too.
461438de93abSTom Zanussi  */
461538de93abSTom Zanussi __init int unregister_ftrace_command(struct ftrace_func_command *cmd)
4616f6180773SSteven Rostedt {
4617f6180773SSteven Rostedt 	struct ftrace_func_command *p, *n;
4618f6180773SSteven Rostedt 	int ret = -ENODEV;
4619f6180773SSteven Rostedt 
4620f6180773SSteven Rostedt 	mutex_lock(&ftrace_cmd_mutex);
4621f6180773SSteven Rostedt 	list_for_each_entry_safe(p, n, &ftrace_commands, list) {
4622f6180773SSteven Rostedt 		if (strcmp(cmd->name, p->name) == 0) {
4623f6180773SSteven Rostedt 			ret = 0;
4624f6180773SSteven Rostedt 			list_del_init(&p->list);
4625f6180773SSteven Rostedt 			goto out_unlock;
4626f6180773SSteven Rostedt 		}
4627f6180773SSteven Rostedt 	}
4628f6180773SSteven Rostedt  out_unlock:
4629f6180773SSteven Rostedt 	mutex_unlock(&ftrace_cmd_mutex);
4630f6180773SSteven Rostedt 
4631f6180773SSteven Rostedt 	return ret;
4632f6180773SSteven Rostedt }
4633f6180773SSteven Rostedt 
463404ec7bb6SSteven Rostedt (VMware) static int ftrace_process_regex(struct ftrace_iterator *iter,
463533dc9b12SSteven Rostedt 				char *buff, int len, int enable)
463664e7c440SSteven Rostedt {
463704ec7bb6SSteven Rostedt (VMware) 	struct ftrace_hash *hash = iter->hash;
4638d2afd57aSSteven Rostedt (VMware) 	struct trace_array *tr = iter->ops->private;
4639f6180773SSteven Rostedt 	char *func, *command, *next = buff;
46406a24a244SSteven Rostedt 	struct ftrace_func_command *p;
46410aff1c0cSGuoWen Li 	int ret = -EINVAL;
464264e7c440SSteven Rostedt 
464364e7c440SSteven Rostedt 	func = strsep(&next, ":");
464464e7c440SSteven Rostedt 
464564e7c440SSteven Rostedt 	if (!next) {
46461cf41dd7SSteven Rostedt 		ret = ftrace_match_records(hash, func, len);
4647b448c4e3SSteven Rostedt 		if (!ret)
4648b448c4e3SSteven Rostedt 			ret = -EINVAL;
4649b448c4e3SSteven Rostedt 		if (ret < 0)
4650311d16daSLi Zefan 			return ret;
4651b448c4e3SSteven Rostedt 		return 0;
465264e7c440SSteven Rostedt 	}
465364e7c440SSteven Rostedt 
4654f6180773SSteven Rostedt 	/* command found */
465564e7c440SSteven Rostedt 
465664e7c440SSteven Rostedt 	command = strsep(&next, ":");
465764e7c440SSteven Rostedt 
4658f6180773SSteven Rostedt 	mutex_lock(&ftrace_cmd_mutex);
4659f6180773SSteven Rostedt 	list_for_each_entry(p, &ftrace_commands, list) {
4660f6180773SSteven Rostedt 		if (strcmp(p->name, command) == 0) {
466104ec7bb6SSteven Rostedt (VMware) 			ret = p->func(tr, hash, func, command, next, enable);
4662f6180773SSteven Rostedt 			goto out_unlock;
466364e7c440SSteven Rostedt 		}
4664f6180773SSteven Rostedt 	}
4665f6180773SSteven Rostedt  out_unlock:
4666f6180773SSteven Rostedt 	mutex_unlock(&ftrace_cmd_mutex);
466764e7c440SSteven Rostedt 
4668f6180773SSteven Rostedt 	return ret;
466964e7c440SSteven Rostedt }
467064e7c440SSteven Rostedt 
4671e309b41dSIngo Molnar static ssize_t
467241c52c0dSSteven Rostedt ftrace_regex_write(struct file *file, const char __user *ubuf,
467341c52c0dSSteven Rostedt 		   size_t cnt, loff_t *ppos, int enable)
46745072c59fSSteven Rostedt {
46755072c59fSSteven Rostedt 	struct ftrace_iterator *iter;
4676689fd8b6S[email protected] 	struct trace_parser *parser;
4677689fd8b6S[email protected] 	ssize_t ret, read;
46785072c59fSSteven Rostedt 
46794ba7978eSLi Zefan 	if (!cnt)
46805072c59fSSteven Rostedt 		return 0;
46815072c59fSSteven Rostedt 
46825072c59fSSteven Rostedt 	if (file->f_mode & FMODE_READ) {
46835072c59fSSteven Rostedt 		struct seq_file *m = file->private_data;
46845072c59fSSteven Rostedt 		iter = m->private;
46855072c59fSSteven Rostedt 	} else
46865072c59fSSteven Rostedt 		iter = file->private_data;
46875072c59fSSteven Rostedt 
4688f04f24fbSMasami Hiramatsu 	if (unlikely(ftrace_disabled))
46893f2367baSMasami Hiramatsu 		return -ENODEV;
46903f2367baSMasami Hiramatsu 
46913f2367baSMasami Hiramatsu 	/* iter->hash is a local copy, so we don't need regex_lock */
4692f04f24fbSMasami Hiramatsu 
4693689fd8b6S[email protected] 	parser = &iter->parser;
4694689fd8b6S[email protected] 	read = trace_get_user(parser, ubuf, cnt, ppos);
46955072c59fSSteven Rostedt 
46964ba7978eSLi Zefan 	if (read >= 0 && trace_parser_loaded(parser) &&
4697689fd8b6S[email protected] 	    !trace_parser_cont(parser)) {
469804ec7bb6SSteven Rostedt (VMware) 		ret = ftrace_process_regex(iter, parser->buffer,
4699689fd8b6S[email protected] 					   parser->idx, enable);
4700313254a9SLi Zefan 		trace_parser_clear(parser);
47017c088b51SSteven Rostedt (Red Hat) 		if (ret < 0)
47023f2367baSMasami Hiramatsu 			goto out;
47035072c59fSSteven Rostedt 	}
47045072c59fSSteven Rostedt 
47055072c59fSSteven Rostedt 	ret = read;
47063f2367baSMasami Hiramatsu  out:
47075072c59fSSteven Rostedt 	return ret;
47085072c59fSSteven Rostedt }
47095072c59fSSteven Rostedt 
4710fc13cb0cSSteven Rostedt ssize_t
471141c52c0dSSteven Rostedt ftrace_filter_write(struct file *file, const char __user *ubuf,
471241c52c0dSSteven Rostedt 		    size_t cnt, loff_t *ppos)
471341c52c0dSSteven Rostedt {
471441c52c0dSSteven Rostedt 	return ftrace_regex_write(file, ubuf, cnt, ppos, 1);
471541c52c0dSSteven Rostedt }
471641c52c0dSSteven Rostedt 
4717fc13cb0cSSteven Rostedt ssize_t
471841c52c0dSSteven Rostedt ftrace_notrace_write(struct file *file, const char __user *ubuf,
471941c52c0dSSteven Rostedt 		     size_t cnt, loff_t *ppos)
472041c52c0dSSteven Rostedt {
472141c52c0dSSteven Rostedt 	return ftrace_regex_write(file, ubuf, cnt, ppos, 0);
472241c52c0dSSteven Rostedt }
472341c52c0dSSteven Rostedt 
472433dc9b12SSteven Rostedt static int
4725647664eaSMasami Hiramatsu ftrace_match_addr(struct ftrace_hash *hash, unsigned long ip, int remove)
4726647664eaSMasami Hiramatsu {
4727647664eaSMasami Hiramatsu 	struct ftrace_func_entry *entry;
4728647664eaSMasami Hiramatsu 
4729647664eaSMasami Hiramatsu 	if (!ftrace_location(ip))
4730647664eaSMasami Hiramatsu 		return -EINVAL;
4731647664eaSMasami Hiramatsu 
4732647664eaSMasami Hiramatsu 	if (remove) {
4733647664eaSMasami Hiramatsu 		entry = ftrace_lookup_ip(hash, ip);
4734647664eaSMasami Hiramatsu 		if (!entry)
4735647664eaSMasami Hiramatsu 			return -ENOENT;
4736647664eaSMasami Hiramatsu 		free_hash_entry(hash, entry);
4737647664eaSMasami Hiramatsu 		return 0;
4738647664eaSMasami Hiramatsu 	}
4739647664eaSMasami Hiramatsu 
4740647664eaSMasami Hiramatsu 	return add_hash_entry(hash, ip);
4741647664eaSMasami Hiramatsu }
4742647664eaSMasami Hiramatsu 
4743647664eaSMasami Hiramatsu static int
4744647664eaSMasami Hiramatsu ftrace_set_hash(struct ftrace_ops *ops, unsigned char *buf, int len,
4745647664eaSMasami Hiramatsu 		unsigned long ip, int remove, int reset, int enable)
474641c52c0dSSteven Rostedt {
474733dc9b12SSteven Rostedt 	struct ftrace_hash **orig_hash;
4748f45948e8SSteven Rostedt 	struct ftrace_hash *hash;
474933dc9b12SSteven Rostedt 	int ret;
4750f45948e8SSteven Rostedt 
475141c52c0dSSteven Rostedt 	if (unlikely(ftrace_disabled))
475233dc9b12SSteven Rostedt 		return -ENODEV;
475341c52c0dSSteven Rostedt 
475433b7f99cSSteven Rostedt (Red Hat) 	mutex_lock(&ops->func_hash->regex_lock);
47553f2367baSMasami Hiramatsu 
4756f45948e8SSteven Rostedt 	if (enable)
475733b7f99cSSteven Rostedt (Red Hat) 		orig_hash = &ops->func_hash->filter_hash;
4758f45948e8SSteven Rostedt 	else
475933b7f99cSSteven Rostedt (Red Hat) 		orig_hash = &ops->func_hash->notrace_hash;
476033dc9b12SSteven Rostedt 
4761b972cc58SWang Nan 	if (reset)
4762b972cc58SWang Nan 		hash = alloc_ftrace_hash(FTRACE_HASH_DEFAULT_BITS);
4763b972cc58SWang Nan 	else
476433dc9b12SSteven Rostedt 		hash = alloc_and_copy_ftrace_hash(FTRACE_HASH_DEFAULT_BITS, *orig_hash);
4765b972cc58SWang Nan 
47663f2367baSMasami Hiramatsu 	if (!hash) {
47673f2367baSMasami Hiramatsu 		ret = -ENOMEM;
47683f2367baSMasami Hiramatsu 		goto out_regex_unlock;
47693f2367baSMasami Hiramatsu 	}
4770f45948e8SSteven Rostedt 
4771ac483c44SJiri Olsa 	if (buf && !ftrace_match_records(hash, buf, len)) {
4772ac483c44SJiri Olsa 		ret = -EINVAL;
4773ac483c44SJiri Olsa 		goto out_regex_unlock;
4774ac483c44SJiri Olsa 	}
4775647664eaSMasami Hiramatsu 	if (ip) {
4776647664eaSMasami Hiramatsu 		ret = ftrace_match_addr(hash, ip, remove);
4777647664eaSMasami Hiramatsu 		if (ret < 0)
4778647664eaSMasami Hiramatsu 			goto out_regex_unlock;
4779647664eaSMasami Hiramatsu 	}
478033dc9b12SSteven Rostedt 
478133dc9b12SSteven Rostedt 	mutex_lock(&ftrace_lock);
4782e16b35ddSSteven Rostedt (VMware) 	ret = ftrace_hash_move_and_update_ops(ops, orig_hash, hash, enable);
478333dc9b12SSteven Rostedt 	mutex_unlock(&ftrace_lock);
478433dc9b12SSteven Rostedt 
4785ac483c44SJiri Olsa  out_regex_unlock:
478633b7f99cSSteven Rostedt (Red Hat) 	mutex_unlock(&ops->func_hash->regex_lock);
478733dc9b12SSteven Rostedt 
478833dc9b12SSteven Rostedt 	free_ftrace_hash(hash);
478933dc9b12SSteven Rostedt 	return ret;
479041c52c0dSSteven Rostedt }
479141c52c0dSSteven Rostedt 
4792647664eaSMasami Hiramatsu static int
4793647664eaSMasami Hiramatsu ftrace_set_addr(struct ftrace_ops *ops, unsigned long ip, int remove,
4794647664eaSMasami Hiramatsu 		int reset, int enable)
4795647664eaSMasami Hiramatsu {
4796647664eaSMasami Hiramatsu 	return ftrace_set_hash(ops, 0, 0, ip, remove, reset, enable);
4797647664eaSMasami Hiramatsu }
4798647664eaSMasami Hiramatsu 
4799647664eaSMasami Hiramatsu /**
4800647664eaSMasami Hiramatsu  * ftrace_set_filter_ip - set a function to filter on in ftrace by address
4801647664eaSMasami Hiramatsu  * @ops - the ops to set the filter with
4802647664eaSMasami Hiramatsu  * @ip - the address to add to or remove from the filter.
4803647664eaSMasami Hiramatsu  * @remove - non zero to remove the ip from the filter
4804647664eaSMasami Hiramatsu  * @reset - non zero to reset all filters before applying this filter.
4805647664eaSMasami Hiramatsu  *
4806647664eaSMasami Hiramatsu  * Filters denote which functions should be enabled when tracing is enabled
4807647664eaSMasami Hiramatsu  * If @ip is NULL, it failes to update filter.
4808647664eaSMasami Hiramatsu  */
4809647664eaSMasami Hiramatsu int ftrace_set_filter_ip(struct ftrace_ops *ops, unsigned long ip,
4810647664eaSMasami Hiramatsu 			 int remove, int reset)
4811647664eaSMasami Hiramatsu {
4812f04f24fbSMasami Hiramatsu 	ftrace_ops_init(ops);
4813647664eaSMasami Hiramatsu 	return ftrace_set_addr(ops, ip, remove, reset, 1);
4814647664eaSMasami Hiramatsu }
4815647664eaSMasami Hiramatsu EXPORT_SYMBOL_GPL(ftrace_set_filter_ip);
4816647664eaSMasami Hiramatsu 
4817d032ae89SJoel Fernandes /**
4818d032ae89SJoel Fernandes  * ftrace_ops_set_global_filter - setup ops to use global filters
4819d032ae89SJoel Fernandes  * @ops - the ops which will use the global filters
4820d032ae89SJoel Fernandes  *
4821d032ae89SJoel Fernandes  * ftrace users who need global function trace filtering should call this.
4822d032ae89SJoel Fernandes  * It can set the global filter only if ops were not initialized before.
4823d032ae89SJoel Fernandes  */
4824d032ae89SJoel Fernandes void ftrace_ops_set_global_filter(struct ftrace_ops *ops)
4825d032ae89SJoel Fernandes {
4826d032ae89SJoel Fernandes 	if (ops->flags & FTRACE_OPS_FL_INITIALIZED)
4827d032ae89SJoel Fernandes 		return;
4828d032ae89SJoel Fernandes 
4829d032ae89SJoel Fernandes 	ftrace_ops_init(ops);
4830d032ae89SJoel Fernandes 	ops->func_hash = &global_ops.local_hash;
4831d032ae89SJoel Fernandes }
4832d032ae89SJoel Fernandes EXPORT_SYMBOL_GPL(ftrace_ops_set_global_filter);
4833d032ae89SJoel Fernandes 
4834647664eaSMasami Hiramatsu static int
4835647664eaSMasami Hiramatsu ftrace_set_regex(struct ftrace_ops *ops, unsigned char *buf, int len,
4836647664eaSMasami Hiramatsu 		 int reset, int enable)
4837647664eaSMasami Hiramatsu {
4838647664eaSMasami Hiramatsu 	return ftrace_set_hash(ops, buf, len, 0, 0, reset, enable);
4839647664eaSMasami Hiramatsu }
4840647664eaSMasami Hiramatsu 
484177a2b37dSSteven Rostedt /**
484277a2b37dSSteven Rostedt  * ftrace_set_filter - set a function to filter on in ftrace
4843936e074bSSteven Rostedt  * @ops - the ops to set the filter with
484477a2b37dSSteven Rostedt  * @buf - the string that holds the function filter text.
484577a2b37dSSteven Rostedt  * @len - the length of the string.
484677a2b37dSSteven Rostedt  * @reset - non zero to reset all filters before applying this filter.
484777a2b37dSSteven Rostedt  *
484877a2b37dSSteven Rostedt  * Filters denote which functions should be enabled when tracing is enabled.
484977a2b37dSSteven Rostedt  * If @buf is NULL and reset is set, all functions will be enabled for tracing.
485077a2b37dSSteven Rostedt  */
4851ac483c44SJiri Olsa int ftrace_set_filter(struct ftrace_ops *ops, unsigned char *buf,
4852936e074bSSteven Rostedt 		       int len, int reset)
485377a2b37dSSteven Rostedt {
4854f04f24fbSMasami Hiramatsu 	ftrace_ops_init(ops);
4855ac483c44SJiri Olsa 	return ftrace_set_regex(ops, buf, len, reset, 1);
485641c52c0dSSteven Rostedt }
4857936e074bSSteven Rostedt EXPORT_SYMBOL_GPL(ftrace_set_filter);
48584eebcc81SSteven Rostedt 
485941c52c0dSSteven Rostedt /**
486041c52c0dSSteven Rostedt  * ftrace_set_notrace - set a function to not trace in ftrace
4861936e074bSSteven Rostedt  * @ops - the ops to set the notrace filter with
486241c52c0dSSteven Rostedt  * @buf - the string that holds the function notrace text.
486341c52c0dSSteven Rostedt  * @len - the length of the string.
486441c52c0dSSteven Rostedt  * @reset - non zero to reset all filters before applying this filter.
486541c52c0dSSteven Rostedt  *
486641c52c0dSSteven Rostedt  * Notrace Filters denote which functions should not be enabled when tracing
486741c52c0dSSteven Rostedt  * is enabled. If @buf is NULL and reset is set, all functions will be enabled
486841c52c0dSSteven Rostedt  * for tracing.
486941c52c0dSSteven Rostedt  */
4870ac483c44SJiri Olsa int ftrace_set_notrace(struct ftrace_ops *ops, unsigned char *buf,
4871936e074bSSteven Rostedt 			int len, int reset)
4872936e074bSSteven Rostedt {
4873f04f24fbSMasami Hiramatsu 	ftrace_ops_init(ops);
4874ac483c44SJiri Olsa 	return ftrace_set_regex(ops, buf, len, reset, 0);
4875936e074bSSteven Rostedt }
4876936e074bSSteven Rostedt EXPORT_SYMBOL_GPL(ftrace_set_notrace);
4877936e074bSSteven Rostedt /**
48788d1b065dSJiaxing Wang  * ftrace_set_global_filter - set a function to filter on with global tracers
4879936e074bSSteven Rostedt  * @buf - the string that holds the function filter text.
4880936e074bSSteven Rostedt  * @len - the length of the string.
4881936e074bSSteven Rostedt  * @reset - non zero to reset all filters before applying this filter.
4882936e074bSSteven Rostedt  *
4883936e074bSSteven Rostedt  * Filters denote which functions should be enabled when tracing is enabled.
4884936e074bSSteven Rostedt  * If @buf is NULL and reset is set, all functions will be enabled for tracing.
4885936e074bSSteven Rostedt  */
4886936e074bSSteven Rostedt void ftrace_set_global_filter(unsigned char *buf, int len, int reset)
4887936e074bSSteven Rostedt {
4888936e074bSSteven Rostedt 	ftrace_set_regex(&global_ops, buf, len, reset, 1);
4889936e074bSSteven Rostedt }
4890936e074bSSteven Rostedt EXPORT_SYMBOL_GPL(ftrace_set_global_filter);
4891936e074bSSteven Rostedt 
4892936e074bSSteven Rostedt /**
48938d1b065dSJiaxing Wang  * ftrace_set_global_notrace - set a function to not trace with global tracers
4894936e074bSSteven Rostedt  * @buf - the string that holds the function notrace text.
4895936e074bSSteven Rostedt  * @len - the length of the string.
4896936e074bSSteven Rostedt  * @reset - non zero to reset all filters before applying this filter.
4897936e074bSSteven Rostedt  *
4898936e074bSSteven Rostedt  * Notrace Filters denote which functions should not be enabled when tracing
4899936e074bSSteven Rostedt  * is enabled. If @buf is NULL and reset is set, all functions will be enabled
4900936e074bSSteven Rostedt  * for tracing.
4901936e074bSSteven Rostedt  */
4902936e074bSSteven Rostedt void ftrace_set_global_notrace(unsigned char *buf, int len, int reset)
490341c52c0dSSteven Rostedt {
4904f45948e8SSteven Rostedt 	ftrace_set_regex(&global_ops, buf, len, reset, 0);
490577a2b37dSSteven Rostedt }
4906936e074bSSteven Rostedt EXPORT_SYMBOL_GPL(ftrace_set_global_notrace);
490777a2b37dSSteven Rostedt 
49082af15d6aSSteven Rostedt /*
49092af15d6aSSteven Rostedt  * command line interface to allow users to set filters on boot up.
49102af15d6aSSteven Rostedt  */
49112af15d6aSSteven Rostedt #define FTRACE_FILTER_SIZE		COMMAND_LINE_SIZE
49122af15d6aSSteven Rostedt static char ftrace_notrace_buf[FTRACE_FILTER_SIZE] __initdata;
49132af15d6aSSteven Rostedt static char ftrace_filter_buf[FTRACE_FILTER_SIZE] __initdata;
49142af15d6aSSteven Rostedt 
4915f1ed7c74SSteven Rostedt (Red Hat) /* Used by function selftest to not test if filter is set */
4916f1ed7c74SSteven Rostedt (Red Hat) bool ftrace_filter_param __initdata;
4917f1ed7c74SSteven Rostedt (Red Hat) 
49182af15d6aSSteven Rostedt static int __init set_ftrace_notrace(char *str)
49192af15d6aSSteven Rostedt {
4920f1ed7c74SSteven Rostedt (Red Hat) 	ftrace_filter_param = true;
492175761cc1SChen Gang 	strlcpy(ftrace_notrace_buf, str, FTRACE_FILTER_SIZE);
49222af15d6aSSteven Rostedt 	return 1;
49232af15d6aSSteven Rostedt }
49242af15d6aSSteven Rostedt __setup("ftrace_notrace=", set_ftrace_notrace);
49252af15d6aSSteven Rostedt 
49262af15d6aSSteven Rostedt static int __init set_ftrace_filter(char *str)
49272af15d6aSSteven Rostedt {
4928f1ed7c74SSteven Rostedt (Red Hat) 	ftrace_filter_param = true;
492975761cc1SChen Gang 	strlcpy(ftrace_filter_buf, str, FTRACE_FILTER_SIZE);
49302af15d6aSSteven Rostedt 	return 1;
49312af15d6aSSteven Rostedt }
49322af15d6aSSteven Rostedt __setup("ftrace_filter=", set_ftrace_filter);
49332af15d6aSSteven Rostedt 
4934369bc18fSStefan Assmann #ifdef CONFIG_FUNCTION_GRAPH_TRACER
4935f6060f46SLai Jiangshan static char ftrace_graph_buf[FTRACE_FILTER_SIZE] __initdata;
49360d7d9a16SNamhyung Kim static char ftrace_graph_notrace_buf[FTRACE_FILTER_SIZE] __initdata;
4937b9b0c831SNamhyung Kim static int ftrace_graph_set_hash(struct ftrace_hash *hash, char *buffer);
4938801c29fdSSteven Rostedt 
4939f3bea491SSteven Rostedt (Red Hat) static unsigned long save_global_trampoline;
4940f3bea491SSteven Rostedt (Red Hat) static unsigned long save_global_flags;
4941f3bea491SSteven Rostedt (Red Hat) 
4942369bc18fSStefan Assmann static int __init set_graph_function(char *str)
4943369bc18fSStefan Assmann {
494406f43d66SFrederic Weisbecker 	strlcpy(ftrace_graph_buf, str, FTRACE_FILTER_SIZE);
4945369bc18fSStefan Assmann 	return 1;
4946369bc18fSStefan Assmann }
4947369bc18fSStefan Assmann __setup("ftrace_graph_filter=", set_graph_function);
4948369bc18fSStefan Assmann 
49490d7d9a16SNamhyung Kim static int __init set_graph_notrace_function(char *str)
49500d7d9a16SNamhyung Kim {
49510d7d9a16SNamhyung Kim 	strlcpy(ftrace_graph_notrace_buf, str, FTRACE_FILTER_SIZE);
49520d7d9a16SNamhyung Kim 	return 1;
49530d7d9a16SNamhyung Kim }
49540d7d9a16SNamhyung Kim __setup("ftrace_graph_notrace=", set_graph_notrace_function);
49550d7d9a16SNamhyung Kim 
495665a50c65STodd Brandt static int __init set_graph_max_depth_function(char *str)
495765a50c65STodd Brandt {
495865a50c65STodd Brandt 	if (!str)
495965a50c65STodd Brandt 		return 0;
496065a50c65STodd Brandt 	fgraph_max_depth = simple_strtoul(str, NULL, 0);
496165a50c65STodd Brandt 	return 1;
496265a50c65STodd Brandt }
496365a50c65STodd Brandt __setup("ftrace_graph_max_depth=", set_graph_max_depth_function);
496465a50c65STodd Brandt 
49650d7d9a16SNamhyung Kim static void __init set_ftrace_early_graph(char *buf, int enable)
4966369bc18fSStefan Assmann {
4967369bc18fSStefan Assmann 	int ret;
4968369bc18fSStefan Assmann 	char *func;
4969b9b0c831SNamhyung Kim 	struct ftrace_hash *hash;
49700d7d9a16SNamhyung Kim 
497192ad18ecSSteven Rostedt (VMware) 	hash = alloc_ftrace_hash(FTRACE_HASH_DEFAULT_BITS);
497292ad18ecSSteven Rostedt (VMware) 	if (WARN_ON(!hash))
497392ad18ecSSteven Rostedt (VMware) 		return;
4974369bc18fSStefan Assmann 
4975369bc18fSStefan Assmann 	while (buf) {
4976369bc18fSStefan Assmann 		func = strsep(&buf, ",");
4977369bc18fSStefan Assmann 		/* we allow only one expression at a time */
4978b9b0c831SNamhyung Kim 		ret = ftrace_graph_set_hash(hash, func);
4979369bc18fSStefan Assmann 		if (ret)
4980369bc18fSStefan Assmann 			printk(KERN_DEBUG "ftrace: function %s not "
4981369bc18fSStefan Assmann 					  "traceable\n", func);
4982369bc18fSStefan Assmann 	}
498392ad18ecSSteven Rostedt (VMware) 
498492ad18ecSSteven Rostedt (VMware) 	if (enable)
498592ad18ecSSteven Rostedt (VMware) 		ftrace_graph_hash = hash;
498692ad18ecSSteven Rostedt (VMware) 	else
498792ad18ecSSteven Rostedt (VMware) 		ftrace_graph_notrace_hash = hash;
4988369bc18fSStefan Assmann }
4989369bc18fSStefan Assmann #endif /* CONFIG_FUNCTION_GRAPH_TRACER */
4990369bc18fSStefan Assmann 
49912a85a37fSSteven Rostedt void __init
49922a85a37fSSteven Rostedt ftrace_set_early_filter(struct ftrace_ops *ops, char *buf, int enable)
49932af15d6aSSteven Rostedt {
49942af15d6aSSteven Rostedt 	char *func;
49952af15d6aSSteven Rostedt 
4996f04f24fbSMasami Hiramatsu 	ftrace_ops_init(ops);
4997f04f24fbSMasami Hiramatsu 
49982af15d6aSSteven Rostedt 	while (buf) {
49992af15d6aSSteven Rostedt 		func = strsep(&buf, ",");
5000f45948e8SSteven Rostedt 		ftrace_set_regex(ops, func, strlen(func), 0, enable);
50012af15d6aSSteven Rostedt 	}
50022af15d6aSSteven Rostedt }
50032af15d6aSSteven Rostedt 
50042af15d6aSSteven Rostedt static void __init set_ftrace_early_filters(void)
50052af15d6aSSteven Rostedt {
50062af15d6aSSteven Rostedt 	if (ftrace_filter_buf[0])
50072a85a37fSSteven Rostedt 		ftrace_set_early_filter(&global_ops, ftrace_filter_buf, 1);
50082af15d6aSSteven Rostedt 	if (ftrace_notrace_buf[0])
50092a85a37fSSteven Rostedt 		ftrace_set_early_filter(&global_ops, ftrace_notrace_buf, 0);
5010369bc18fSStefan Assmann #ifdef CONFIG_FUNCTION_GRAPH_TRACER
5011369bc18fSStefan Assmann 	if (ftrace_graph_buf[0])
50120d7d9a16SNamhyung Kim 		set_ftrace_early_graph(ftrace_graph_buf, 1);
50130d7d9a16SNamhyung Kim 	if (ftrace_graph_notrace_buf[0])
50140d7d9a16SNamhyung Kim 		set_ftrace_early_graph(ftrace_graph_notrace_buf, 0);
5015369bc18fSStefan Assmann #endif /* CONFIG_FUNCTION_GRAPH_TRACER */
50162af15d6aSSteven Rostedt }
50172af15d6aSSteven Rostedt 
5018fc13cb0cSSteven Rostedt int ftrace_regex_release(struct inode *inode, struct file *file)
50195072c59fSSteven Rostedt {
50205072c59fSSteven Rostedt 	struct seq_file *m = (struct seq_file *)file->private_data;
50215072c59fSSteven Rostedt 	struct ftrace_iterator *iter;
502233dc9b12SSteven Rostedt 	struct ftrace_hash **orig_hash;
5023689fd8b6S[email protected] 	struct trace_parser *parser;
5024ed926f9bSSteven Rostedt 	int filter_hash;
502533dc9b12SSteven Rostedt 	int ret;
50265072c59fSSteven Rostedt 
50275072c59fSSteven Rostedt 	if (file->f_mode & FMODE_READ) {
50285072c59fSSteven Rostedt 		iter = m->private;
50295072c59fSSteven Rostedt 		seq_release(inode, file);
50305072c59fSSteven Rostedt 	} else
50315072c59fSSteven Rostedt 		iter = file->private_data;
50325072c59fSSteven Rostedt 
5033689fd8b6S[email protected] 	parser = &iter->parser;
5034689fd8b6S[email protected] 	if (trace_parser_loaded(parser)) {
5035689fd8b6S[email protected] 		parser->buffer[parser->idx] = 0;
50361cf41dd7SSteven Rostedt 		ftrace_match_records(iter->hash, parser->buffer, parser->idx);
50375072c59fSSteven Rostedt 	}
50385072c59fSSteven Rostedt 
5039058e297dSSteven Rostedt 	trace_parser_put(parser);
5040058e297dSSteven Rostedt 
504133b7f99cSSteven Rostedt (Red Hat) 	mutex_lock(&iter->ops->func_hash->regex_lock);
50423f2367baSMasami Hiramatsu 
5043058e297dSSteven Rostedt 	if (file->f_mode & FMODE_WRITE) {
5044ed926f9bSSteven Rostedt 		filter_hash = !!(iter->flags & FTRACE_ITER_FILTER);
5045ed926f9bSSteven Rostedt 
50468c08f0d5SSteven Rostedt (VMware) 		if (filter_hash) {
504733b7f99cSSteven Rostedt (Red Hat) 			orig_hash = &iter->ops->func_hash->filter_hash;
504869d71879SSteven Rostedt (VMware) 			if (iter->tr && !list_empty(&iter->tr->mod_trace))
50498c08f0d5SSteven Rostedt (VMware) 				iter->hash->flags |= FTRACE_HASH_FL_MOD;
50508c08f0d5SSteven Rostedt (VMware) 		} else
505133b7f99cSSteven Rostedt (Red Hat) 			orig_hash = &iter->ops->func_hash->notrace_hash;
505233dc9b12SSteven Rostedt 
5053e6ea44e9SSteven Rostedt 		mutex_lock(&ftrace_lock);
5054e16b35ddSSteven Rostedt (VMware) 		ret = ftrace_hash_move_and_update_ops(iter->ops, orig_hash,
5055e16b35ddSSteven Rostedt (VMware) 						      iter->hash, filter_hash);
5056e6ea44e9SSteven Rostedt 		mutex_unlock(&ftrace_lock);
5057c20489daSSteven Rostedt (VMware) 	} else {
5058c20489daSSteven Rostedt (VMware) 		/* For read only, the hash is the ops hash */
5059c20489daSSteven Rostedt (VMware) 		iter->hash = NULL;
5060058e297dSSteven Rostedt 	}
50613f2367baSMasami Hiramatsu 
506233b7f99cSSteven Rostedt (Red Hat) 	mutex_unlock(&iter->ops->func_hash->regex_lock);
506333dc9b12SSteven Rostedt 	free_ftrace_hash(iter->hash);
506433dc9b12SSteven Rostedt 	kfree(iter);
5065689fd8b6S[email protected] 
50665072c59fSSteven Rostedt 	return 0;
50675072c59fSSteven Rostedt }
50685072c59fSSteven Rostedt 
50695e2336a0SSteven Rostedt static const struct file_operations ftrace_avail_fops = {
50705072c59fSSteven Rostedt 	.open = ftrace_avail_open,
50715072c59fSSteven Rostedt 	.read = seq_read,
50725072c59fSSteven Rostedt 	.llseek = seq_lseek,
50733be04b47SLi Zefan 	.release = seq_release_private,
50745072c59fSSteven Rostedt };
50755072c59fSSteven Rostedt 
5076647bcd03SSteven Rostedt static const struct file_operations ftrace_enabled_fops = {
5077647bcd03SSteven Rostedt 	.open = ftrace_enabled_open,
5078647bcd03SSteven Rostedt 	.read = seq_read,
5079647bcd03SSteven Rostedt 	.llseek = seq_lseek,
5080647bcd03SSteven Rostedt 	.release = seq_release_private,
5081647bcd03SSteven Rostedt };
5082647bcd03SSteven Rostedt 
50835e2336a0SSteven Rostedt static const struct file_operations ftrace_filter_fops = {
50845072c59fSSteven Rostedt 	.open = ftrace_filter_open,
5085850a80cfSLai Jiangshan 	.read = seq_read,
50865072c59fSSteven Rostedt 	.write = ftrace_filter_write,
5087098c879eSSteven Rostedt (Red Hat) 	.llseek = tracing_lseek,
50881cf41dd7SSteven Rostedt 	.release = ftrace_regex_release,
50895072c59fSSteven Rostedt };
50905072c59fSSteven Rostedt 
50915e2336a0SSteven Rostedt static const struct file_operations ftrace_notrace_fops = {
509241c52c0dSSteven Rostedt 	.open = ftrace_notrace_open,
5093850a80cfSLai Jiangshan 	.read = seq_read,
509441c52c0dSSteven Rostedt 	.write = ftrace_notrace_write,
5095098c879eSSteven Rostedt (Red Hat) 	.llseek = tracing_lseek,
50961cf41dd7SSteven Rostedt 	.release = ftrace_regex_release,
509741c52c0dSSteven Rostedt };
509841c52c0dSSteven Rostedt 
5099ea4e2bc4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
5100ea4e2bc4SSteven Rostedt 
5101ea4e2bc4SSteven Rostedt static DEFINE_MUTEX(graph_lock);
5102ea4e2bc4SSteven Rostedt 
5103b9b0c831SNamhyung Kim struct ftrace_hash *ftrace_graph_hash = EMPTY_HASH;
5104b9b0c831SNamhyung Kim struct ftrace_hash *ftrace_graph_notrace_hash = EMPTY_HASH;
5105b9b0c831SNamhyung Kim 
5106b9b0c831SNamhyung Kim enum graph_filter_type {
5107b9b0c831SNamhyung Kim 	GRAPH_FILTER_NOTRACE	= 0,
5108b9b0c831SNamhyung Kim 	GRAPH_FILTER_FUNCTION,
5109b9b0c831SNamhyung Kim };
5110ea4e2bc4SSteven Rostedt 
5111555fc781SSteven Rostedt (VMware) #define FTRACE_GRAPH_EMPTY	((void *)1)
5112555fc781SSteven Rostedt (VMware) 
5113faf982a6SNamhyung Kim struct ftrace_graph_data {
5114b9b0c831SNamhyung Kim 	struct ftrace_hash		*hash;
5115b9b0c831SNamhyung Kim 	struct ftrace_func_entry	*entry;
5116b9b0c831SNamhyung Kim 	int				idx;   /* for hash table iteration */
5117b9b0c831SNamhyung Kim 	enum graph_filter_type		type;
5118b9b0c831SNamhyung Kim 	struct ftrace_hash		*new_hash;
5119faf982a6SNamhyung Kim 	const struct seq_operations	*seq_ops;
5120e704eff3SSteven Rostedt (VMware) 	struct trace_parser		parser;
5121faf982a6SNamhyung Kim };
5122faf982a6SNamhyung Kim 
5123ea4e2bc4SSteven Rostedt static void *
512485951842SLi Zefan __g_next(struct seq_file *m, loff_t *pos)
5125ea4e2bc4SSteven Rostedt {
5126faf982a6SNamhyung Kim 	struct ftrace_graph_data *fgd = m->private;
5127b9b0c831SNamhyung Kim 	struct ftrace_func_entry *entry = fgd->entry;
5128b9b0c831SNamhyung Kim 	struct hlist_head *head;
5129b9b0c831SNamhyung Kim 	int i, idx = fgd->idx;
5130faf982a6SNamhyung Kim 
5131b9b0c831SNamhyung Kim 	if (*pos >= fgd->hash->count)
5132ea4e2bc4SSteven Rostedt 		return NULL;
5133b9b0c831SNamhyung Kim 
5134b9b0c831SNamhyung Kim 	if (entry) {
5135b9b0c831SNamhyung Kim 		hlist_for_each_entry_continue(entry, hlist) {
5136b9b0c831SNamhyung Kim 			fgd->entry = entry;
5137b9b0c831SNamhyung Kim 			return entry;
5138b9b0c831SNamhyung Kim 		}
5139b9b0c831SNamhyung Kim 
5140b9b0c831SNamhyung Kim 		idx++;
5141b9b0c831SNamhyung Kim 	}
5142b9b0c831SNamhyung Kim 
5143b9b0c831SNamhyung Kim 	for (i = idx; i < 1 << fgd->hash->size_bits; i++) {
5144b9b0c831SNamhyung Kim 		head = &fgd->hash->buckets[i];
5145b9b0c831SNamhyung Kim 		hlist_for_each_entry(entry, head, hlist) {
5146b9b0c831SNamhyung Kim 			fgd->entry = entry;
5147b9b0c831SNamhyung Kim 			fgd->idx = i;
5148b9b0c831SNamhyung Kim 			return entry;
5149b9b0c831SNamhyung Kim 		}
5150b9b0c831SNamhyung Kim 	}
5151b9b0c831SNamhyung Kim 	return NULL;
515285951842SLi Zefan }
5153ea4e2bc4SSteven Rostedt 
515485951842SLi Zefan static void *
515585951842SLi Zefan g_next(struct seq_file *m, void *v, loff_t *pos)
515685951842SLi Zefan {
515785951842SLi Zefan 	(*pos)++;
515885951842SLi Zefan 	return __g_next(m, pos);
5159ea4e2bc4SSteven Rostedt }
5160ea4e2bc4SSteven Rostedt 
5161ea4e2bc4SSteven Rostedt static void *g_start(struct seq_file *m, loff_t *pos)
5162ea4e2bc4SSteven Rostedt {
5163faf982a6SNamhyung Kim 	struct ftrace_graph_data *fgd = m->private;
5164faf982a6SNamhyung Kim 
5165ea4e2bc4SSteven Rostedt 	mutex_lock(&graph_lock);
5166ea4e2bc4SSteven Rostedt 
5167649b988bSSteven Rostedt (VMware) 	if (fgd->type == GRAPH_FILTER_FUNCTION)
5168649b988bSSteven Rostedt (VMware) 		fgd->hash = rcu_dereference_protected(ftrace_graph_hash,
5169649b988bSSteven Rostedt (VMware) 					lockdep_is_held(&graph_lock));
5170649b988bSSteven Rostedt (VMware) 	else
5171649b988bSSteven Rostedt (VMware) 		fgd->hash = rcu_dereference_protected(ftrace_graph_notrace_hash,
5172649b988bSSteven Rostedt (VMware) 					lockdep_is_held(&graph_lock));
5173649b988bSSteven Rostedt (VMware) 
5174f9349a8fSFrederic Weisbecker 	/* Nothing, tell g_show to print all functions are enabled */
5175b9b0c831SNamhyung Kim 	if (ftrace_hash_empty(fgd->hash) && !*pos)
5176555fc781SSteven Rostedt (VMware) 		return FTRACE_GRAPH_EMPTY;
5177f9349a8fSFrederic Weisbecker 
5178b9b0c831SNamhyung Kim 	fgd->idx = 0;
5179b9b0c831SNamhyung Kim 	fgd->entry = NULL;
518085951842SLi Zefan 	return __g_next(m, pos);
5181ea4e2bc4SSteven Rostedt }
5182ea4e2bc4SSteven Rostedt 
5183ea4e2bc4SSteven Rostedt static void g_stop(struct seq_file *m, void *p)
5184ea4e2bc4SSteven Rostedt {
5185ea4e2bc4SSteven Rostedt 	mutex_unlock(&graph_lock);
5186ea4e2bc4SSteven Rostedt }
5187ea4e2bc4SSteven Rostedt 
5188ea4e2bc4SSteven Rostedt static int g_show(struct seq_file *m, void *v)
5189ea4e2bc4SSteven Rostedt {
5190b9b0c831SNamhyung Kim 	struct ftrace_func_entry *entry = v;
5191ea4e2bc4SSteven Rostedt 
5192b9b0c831SNamhyung Kim 	if (!entry)
5193ea4e2bc4SSteven Rostedt 		return 0;
5194ea4e2bc4SSteven Rostedt 
5195555fc781SSteven Rostedt (VMware) 	if (entry == FTRACE_GRAPH_EMPTY) {
5196280d1429SNamhyung Kim 		struct ftrace_graph_data *fgd = m->private;
5197280d1429SNamhyung Kim 
5198b9b0c831SNamhyung Kim 		if (fgd->type == GRAPH_FILTER_FUNCTION)
5199fa6f0cc7SRasmus Villemoes 			seq_puts(m, "#### all functions enabled ####\n");
5200280d1429SNamhyung Kim 		else
5201fa6f0cc7SRasmus Villemoes 			seq_puts(m, "#### no functions disabled ####\n");
5202f9349a8fSFrederic Weisbecker 		return 0;
5203f9349a8fSFrederic Weisbecker 	}
5204f9349a8fSFrederic Weisbecker 
5205b9b0c831SNamhyung Kim 	seq_printf(m, "%ps\n", (void *)entry->ip);
5206ea4e2bc4SSteven Rostedt 
5207ea4e2bc4SSteven Rostedt 	return 0;
5208ea4e2bc4SSteven Rostedt }
5209ea4e2bc4SSteven Rostedt 
521088e9d34cSJames Morris static const struct seq_operations ftrace_graph_seq_ops = {
5211ea4e2bc4SSteven Rostedt 	.start = g_start,
5212ea4e2bc4SSteven Rostedt 	.next = g_next,
5213ea4e2bc4SSteven Rostedt 	.stop = g_stop,
5214ea4e2bc4SSteven Rostedt 	.show = g_show,
5215ea4e2bc4SSteven Rostedt };
5216ea4e2bc4SSteven Rostedt 
5217ea4e2bc4SSteven Rostedt static int
5218faf982a6SNamhyung Kim __ftrace_graph_open(struct inode *inode, struct file *file,
5219faf982a6SNamhyung Kim 		    struct ftrace_graph_data *fgd)
5220ea4e2bc4SSteven Rostedt {
5221ea4e2bc4SSteven Rostedt 	int ret = 0;
5222b9b0c831SNamhyung Kim 	struct ftrace_hash *new_hash = NULL;
5223ea4e2bc4SSteven Rostedt 
5224b9b0c831SNamhyung Kim 	if (file->f_mode & FMODE_WRITE) {
5225b9b0c831SNamhyung Kim 		const int size_bits = FTRACE_HASH_DEFAULT_BITS;
5226b9b0c831SNamhyung Kim 
5227e704eff3SSteven Rostedt (VMware) 		if (trace_parser_get_init(&fgd->parser, FTRACE_BUFF_MAX))
5228e704eff3SSteven Rostedt (VMware) 			return -ENOMEM;
5229e704eff3SSteven Rostedt (VMware) 
5230b9b0c831SNamhyung Kim 		if (file->f_flags & O_TRUNC)
5231b9b0c831SNamhyung Kim 			new_hash = alloc_ftrace_hash(size_bits);
5232b9b0c831SNamhyung Kim 		else
5233b9b0c831SNamhyung Kim 			new_hash = alloc_and_copy_ftrace_hash(size_bits,
5234b9b0c831SNamhyung Kim 							      fgd->hash);
5235b9b0c831SNamhyung Kim 		if (!new_hash) {
5236b9b0c831SNamhyung Kim 			ret = -ENOMEM;
5237b9b0c831SNamhyung Kim 			goto out;
5238ea4e2bc4SSteven Rostedt 		}
5239b9b0c831SNamhyung Kim 	}
5240ea4e2bc4SSteven Rostedt 
5241faf982a6SNamhyung Kim 	if (file->f_mode & FMODE_READ) {
5242b9b0c831SNamhyung Kim 		ret = seq_open(file, &ftrace_graph_seq_ops);
5243faf982a6SNamhyung Kim 		if (!ret) {
5244faf982a6SNamhyung Kim 			struct seq_file *m = file->private_data;
5245faf982a6SNamhyung Kim 			m->private = fgd;
5246b9b0c831SNamhyung Kim 		} else {
5247b9b0c831SNamhyung Kim 			/* Failed */
5248b9b0c831SNamhyung Kim 			free_ftrace_hash(new_hash);
5249b9b0c831SNamhyung Kim 			new_hash = NULL;
5250faf982a6SNamhyung Kim 		}
5251faf982a6SNamhyung Kim 	} else
5252faf982a6SNamhyung Kim 		file->private_data = fgd;
5253a4ec5e0cSLi Zefan 
5254b9b0c831SNamhyung Kim out:
5255e704eff3SSteven Rostedt (VMware) 	if (ret < 0 && file->f_mode & FMODE_WRITE)
5256e704eff3SSteven Rostedt (VMware) 		trace_parser_put(&fgd->parser);
5257e704eff3SSteven Rostedt (VMware) 
5258b9b0c831SNamhyung Kim 	fgd->new_hash = new_hash;
5259649b988bSSteven Rostedt (VMware) 
5260649b988bSSteven Rostedt (VMware) 	/*
5261649b988bSSteven Rostedt (VMware) 	 * All uses of fgd->hash must be taken with the graph_lock
5262649b988bSSteven Rostedt (VMware) 	 * held. The graph_lock is going to be released, so force
5263649b988bSSteven Rostedt (VMware) 	 * fgd->hash to be reinitialized when it is taken again.
5264649b988bSSteven Rostedt (VMware) 	 */
5265649b988bSSteven Rostedt (VMware) 	fgd->hash = NULL;
5266649b988bSSteven Rostedt (VMware) 
5267ea4e2bc4SSteven Rostedt 	return ret;
5268ea4e2bc4SSteven Rostedt }
5269ea4e2bc4SSteven Rostedt 
5270ea4e2bc4SSteven Rostedt static int
5271faf982a6SNamhyung Kim ftrace_graph_open(struct inode *inode, struct file *file)
5272faf982a6SNamhyung Kim {
5273faf982a6SNamhyung Kim 	struct ftrace_graph_data *fgd;
5274b9b0c831SNamhyung Kim 	int ret;
5275faf982a6SNamhyung Kim 
5276faf982a6SNamhyung Kim 	if (unlikely(ftrace_disabled))
5277faf982a6SNamhyung Kim 		return -ENODEV;
5278faf982a6SNamhyung Kim 
5279faf982a6SNamhyung Kim 	fgd = kmalloc(sizeof(*fgd), GFP_KERNEL);
5280faf982a6SNamhyung Kim 	if (fgd == NULL)
5281faf982a6SNamhyung Kim 		return -ENOMEM;
5282faf982a6SNamhyung Kim 
5283b9b0c831SNamhyung Kim 	mutex_lock(&graph_lock);
5284b9b0c831SNamhyung Kim 
5285649b988bSSteven Rostedt (VMware) 	fgd->hash = rcu_dereference_protected(ftrace_graph_hash,
5286649b988bSSteven Rostedt (VMware) 					lockdep_is_held(&graph_lock));
5287b9b0c831SNamhyung Kim 	fgd->type = GRAPH_FILTER_FUNCTION;
5288faf982a6SNamhyung Kim 	fgd->seq_ops = &ftrace_graph_seq_ops;
5289faf982a6SNamhyung Kim 
5290b9b0c831SNamhyung Kim 	ret = __ftrace_graph_open(inode, file, fgd);
5291b9b0c831SNamhyung Kim 	if (ret < 0)
5292b9b0c831SNamhyung Kim 		kfree(fgd);
5293b9b0c831SNamhyung Kim 
5294b9b0c831SNamhyung Kim 	mutex_unlock(&graph_lock);
5295b9b0c831SNamhyung Kim 	return ret;
5296faf982a6SNamhyung Kim }
5297faf982a6SNamhyung Kim 
5298faf982a6SNamhyung Kim static int
529929ad23b0SNamhyung Kim ftrace_graph_notrace_open(struct inode *inode, struct file *file)
530029ad23b0SNamhyung Kim {
530129ad23b0SNamhyung Kim 	struct ftrace_graph_data *fgd;
5302b9b0c831SNamhyung Kim 	int ret;
530329ad23b0SNamhyung Kim 
530429ad23b0SNamhyung Kim 	if (unlikely(ftrace_disabled))
530529ad23b0SNamhyung Kim 		return -ENODEV;
530629ad23b0SNamhyung Kim 
530729ad23b0SNamhyung Kim 	fgd = kmalloc(sizeof(*fgd), GFP_KERNEL);
530829ad23b0SNamhyung Kim 	if (fgd == NULL)
530929ad23b0SNamhyung Kim 		return -ENOMEM;
531029ad23b0SNamhyung Kim 
5311b9b0c831SNamhyung Kim 	mutex_lock(&graph_lock);
5312b9b0c831SNamhyung Kim 
5313649b988bSSteven Rostedt (VMware) 	fgd->hash = rcu_dereference_protected(ftrace_graph_notrace_hash,
5314649b988bSSteven Rostedt (VMware) 					lockdep_is_held(&graph_lock));
5315b9b0c831SNamhyung Kim 	fgd->type = GRAPH_FILTER_NOTRACE;
531629ad23b0SNamhyung Kim 	fgd->seq_ops = &ftrace_graph_seq_ops;
531729ad23b0SNamhyung Kim 
5318b9b0c831SNamhyung Kim 	ret = __ftrace_graph_open(inode, file, fgd);
5319b9b0c831SNamhyung Kim 	if (ret < 0)
5320b9b0c831SNamhyung Kim 		kfree(fgd);
5321b9b0c831SNamhyung Kim 
5322b9b0c831SNamhyung Kim 	mutex_unlock(&graph_lock);
5323b9b0c831SNamhyung Kim 	return ret;
532429ad23b0SNamhyung Kim }
532529ad23b0SNamhyung Kim 
532629ad23b0SNamhyung Kim static int
532787827111SLi Zefan ftrace_graph_release(struct inode *inode, struct file *file)
532887827111SLi Zefan {
5329b9b0c831SNamhyung Kim 	struct ftrace_graph_data *fgd;
5330e704eff3SSteven Rostedt (VMware) 	struct ftrace_hash *old_hash, *new_hash;
5331e704eff3SSteven Rostedt (VMware) 	struct trace_parser *parser;
5332e704eff3SSteven Rostedt (VMware) 	int ret = 0;
5333b9b0c831SNamhyung Kim 
5334faf982a6SNamhyung Kim 	if (file->f_mode & FMODE_READ) {
5335faf982a6SNamhyung Kim 		struct seq_file *m = file->private_data;
5336faf982a6SNamhyung Kim 
5337b9b0c831SNamhyung Kim 		fgd = m->private;
533887827111SLi Zefan 		seq_release(inode, file);
5339faf982a6SNamhyung Kim 	} else {
5340b9b0c831SNamhyung Kim 		fgd = file->private_data;
5341faf982a6SNamhyung Kim 	}
5342faf982a6SNamhyung Kim 
5343e704eff3SSteven Rostedt (VMware) 
5344e704eff3SSteven Rostedt (VMware) 	if (file->f_mode & FMODE_WRITE) {
5345e704eff3SSteven Rostedt (VMware) 
5346e704eff3SSteven Rostedt (VMware) 		parser = &fgd->parser;
5347e704eff3SSteven Rostedt (VMware) 
5348e704eff3SSteven Rostedt (VMware) 		if (trace_parser_loaded((parser))) {
5349e704eff3SSteven Rostedt (VMware) 			parser->buffer[parser->idx] = 0;
5350e704eff3SSteven Rostedt (VMware) 			ret = ftrace_graph_set_hash(fgd->new_hash,
5351e704eff3SSteven Rostedt (VMware) 						    parser->buffer);
5352e704eff3SSteven Rostedt (VMware) 		}
5353e704eff3SSteven Rostedt (VMware) 
5354e704eff3SSteven Rostedt (VMware) 		trace_parser_put(parser);
5355e704eff3SSteven Rostedt (VMware) 
5356e704eff3SSteven Rostedt (VMware) 		new_hash = __ftrace_hash_move(fgd->new_hash);
5357e704eff3SSteven Rostedt (VMware) 		if (!new_hash) {
5358e704eff3SSteven Rostedt (VMware) 			ret = -ENOMEM;
5359e704eff3SSteven Rostedt (VMware) 			goto out;
5360e704eff3SSteven Rostedt (VMware) 		}
5361e704eff3SSteven Rostedt (VMware) 
5362e704eff3SSteven Rostedt (VMware) 		mutex_lock(&graph_lock);
5363e704eff3SSteven Rostedt (VMware) 
5364e704eff3SSteven Rostedt (VMware) 		if (fgd->type == GRAPH_FILTER_FUNCTION) {
5365e704eff3SSteven Rostedt (VMware) 			old_hash = rcu_dereference_protected(ftrace_graph_hash,
5366e704eff3SSteven Rostedt (VMware) 					lockdep_is_held(&graph_lock));
5367e704eff3SSteven Rostedt (VMware) 			rcu_assign_pointer(ftrace_graph_hash, new_hash);
5368e704eff3SSteven Rostedt (VMware) 		} else {
5369e704eff3SSteven Rostedt (VMware) 			old_hash = rcu_dereference_protected(ftrace_graph_notrace_hash,
5370e704eff3SSteven Rostedt (VMware) 					lockdep_is_held(&graph_lock));
5371e704eff3SSteven Rostedt (VMware) 			rcu_assign_pointer(ftrace_graph_notrace_hash, new_hash);
5372e704eff3SSteven Rostedt (VMware) 		}
5373e704eff3SSteven Rostedt (VMware) 
5374e704eff3SSteven Rostedt (VMware) 		mutex_unlock(&graph_lock);
5375e704eff3SSteven Rostedt (VMware) 
5376e704eff3SSteven Rostedt (VMware) 		/* Wait till all users are no longer using the old hash */
5377e704eff3SSteven Rostedt (VMware) 		synchronize_sched();
5378e704eff3SSteven Rostedt (VMware) 
5379e704eff3SSteven Rostedt (VMware) 		free_ftrace_hash(old_hash);
5380e704eff3SSteven Rostedt (VMware) 	}
5381e704eff3SSteven Rostedt (VMware) 
5382e704eff3SSteven Rostedt (VMware)  out:
5383f9797c2fSLuis Henriques 	free_ftrace_hash(fgd->new_hash);
5384b9b0c831SNamhyung Kim 	kfree(fgd);
5385b9b0c831SNamhyung Kim 
5386e704eff3SSteven Rostedt (VMware) 	return ret;
538787827111SLi Zefan }
538887827111SLi Zefan 
538987827111SLi Zefan static int
5390b9b0c831SNamhyung Kim ftrace_graph_set_hash(struct ftrace_hash *hash, char *buffer)
5391ea4e2bc4SSteven Rostedt {
53923ba00929SDmitry Safonov 	struct ftrace_glob func_g;
5393ea4e2bc4SSteven Rostedt 	struct dyn_ftrace *rec;
5394ea4e2bc4SSteven Rostedt 	struct ftrace_page *pg;
5395b9b0c831SNamhyung Kim 	struct ftrace_func_entry *entry;
5396c7c6b1feSLi Zefan 	int fail = 1;
53973ba00929SDmitry Safonov 	int not;
5398ea4e2bc4SSteven Rostedt 
5399f9349a8fSFrederic Weisbecker 	/* decode regex */
54003ba00929SDmitry Safonov 	func_g.type = filter_parse_regex(buffer, strlen(buffer),
54013ba00929SDmitry Safonov 					 &func_g.search, &not);
5402f9349a8fSFrederic Weisbecker 
54033ba00929SDmitry Safonov 	func_g.len = strlen(func_g.search);
5404f9349a8fSFrederic Weisbecker 
540552baf119SSteven Rostedt 	mutex_lock(&ftrace_lock);
540645a4a237SSteven Rostedt 
540745a4a237SSteven Rostedt 	if (unlikely(ftrace_disabled)) {
540845a4a237SSteven Rostedt 		mutex_unlock(&ftrace_lock);
540945a4a237SSteven Rostedt 		return -ENODEV;
541045a4a237SSteven Rostedt 	}
541145a4a237SSteven Rostedt 
5412265c831cSSteven Rostedt 	do_for_each_ftrace_rec(pg, rec) {
5413ea4e2bc4SSteven Rostedt 
5414546fece4SSteven Rostedt (Red Hat) 		if (rec->flags & FTRACE_FL_DISABLED)
5415546fece4SSteven Rostedt (Red Hat) 			continue;
5416546fece4SSteven Rostedt (Red Hat) 
54170b507e1eSDmitry Safonov 		if (ftrace_match_record(rec, &func_g, NULL, 0)) {
5418b9b0c831SNamhyung Kim 			entry = ftrace_lookup_ip(hash, rec->ip);
5419c7c6b1feSLi Zefan 
5420c7c6b1feSLi Zefan 			if (!not) {
5421c7c6b1feSLi Zefan 				fail = 0;
5422b9b0c831SNamhyung Kim 
5423b9b0c831SNamhyung Kim 				if (entry)
5424b9b0c831SNamhyung Kim 					continue;
5425b9b0c831SNamhyung Kim 				if (add_hash_entry(hash, rec->ip) < 0)
5426c7c6b1feSLi Zefan 					goto out;
5427c7c6b1feSLi Zefan 			} else {
5428b9b0c831SNamhyung Kim 				if (entry) {
5429b9b0c831SNamhyung Kim 					free_hash_entry(hash, entry);
5430c7c6b1feSLi Zefan 					fail = 0;
5431c7c6b1feSLi Zefan 				}
5432c7c6b1feSLi Zefan 			}
5433f9349a8fSFrederic Weisbecker 		}
5434265c831cSSteven Rostedt 	} while_for_each_ftrace_rec();
5435c7c6b1feSLi Zefan out:
543652baf119SSteven Rostedt 	mutex_unlock(&ftrace_lock);
5437ea4e2bc4SSteven Rostedt 
5438c7c6b1feSLi Zefan 	if (fail)
5439c7c6b1feSLi Zefan 		return -EINVAL;
5440c7c6b1feSLi Zefan 
5441c7c6b1feSLi Zefan 	return 0;
5442ea4e2bc4SSteven Rostedt }
5443ea4e2bc4SSteven Rostedt 
5444ea4e2bc4SSteven Rostedt static ssize_t
5445ea4e2bc4SSteven Rostedt ftrace_graph_write(struct file *file, const char __user *ubuf,
5446ea4e2bc4SSteven Rostedt 		   size_t cnt, loff_t *ppos)
5447ea4e2bc4SSteven Rostedt {
54486a10108bSNamhyung Kim 	ssize_t read, ret = 0;
5449faf982a6SNamhyung Kim 	struct ftrace_graph_data *fgd = file->private_data;
5450e704eff3SSteven Rostedt (VMware) 	struct trace_parser *parser;
5451ea4e2bc4SSteven Rostedt 
5452c7c6b1feSLi Zefan 	if (!cnt)
5453ea4e2bc4SSteven Rostedt 		return 0;
5454ea4e2bc4SSteven Rostedt 
5455ae98d27aSSteven Rostedt (VMware) 	/* Read mode uses seq functions */
5456ae98d27aSSteven Rostedt (VMware) 	if (file->f_mode & FMODE_READ) {
5457ae98d27aSSteven Rostedt (VMware) 		struct seq_file *m = file->private_data;
5458ae98d27aSSteven Rostedt (VMware) 		fgd = m->private;
5459ae98d27aSSteven Rostedt (VMware) 	}
5460ae98d27aSSteven Rostedt (VMware) 
5461e704eff3SSteven Rostedt (VMware) 	parser = &fgd->parser;
5462689fd8b6S[email protected] 
5463e704eff3SSteven Rostedt (VMware) 	read = trace_get_user(parser, ubuf, cnt, ppos);
5464ea4e2bc4SSteven Rostedt 
5465e704eff3SSteven Rostedt (VMware) 	if (read >= 0 && trace_parser_loaded(parser) &&
5466e704eff3SSteven Rostedt (VMware) 	    !trace_parser_cont(parser)) {
54676a10108bSNamhyung Kim 
5468b9b0c831SNamhyung Kim 		ret = ftrace_graph_set_hash(fgd->new_hash,
5469e704eff3SSteven Rostedt (VMware) 					    parser->buffer);
5470e704eff3SSteven Rostedt (VMware) 		trace_parser_clear(parser);
5471689fd8b6S[email protected] 	}
5472ea4e2bc4SSteven Rostedt 
54736a10108bSNamhyung Kim 	if (!ret)
5474ea4e2bc4SSteven Rostedt 		ret = read;
54751eb90f13SLi Zefan 
5476ea4e2bc4SSteven Rostedt 	return ret;
5477ea4e2bc4SSteven Rostedt }
5478ea4e2bc4SSteven Rostedt 
5479ea4e2bc4SSteven Rostedt static const struct file_operations ftrace_graph_fops = {
5480ea4e2bc4SSteven Rostedt 	.open		= ftrace_graph_open,
5481850a80cfSLai Jiangshan 	.read		= seq_read,
5482ea4e2bc4SSteven Rostedt 	.write		= ftrace_graph_write,
5483098c879eSSteven Rostedt (Red Hat) 	.llseek		= tracing_lseek,
548487827111SLi Zefan 	.release	= ftrace_graph_release,
5485ea4e2bc4SSteven Rostedt };
548629ad23b0SNamhyung Kim 
548729ad23b0SNamhyung Kim static const struct file_operations ftrace_graph_notrace_fops = {
548829ad23b0SNamhyung Kim 	.open		= ftrace_graph_notrace_open,
548929ad23b0SNamhyung Kim 	.read		= seq_read,
549029ad23b0SNamhyung Kim 	.write		= ftrace_graph_write,
5491098c879eSSteven Rostedt (Red Hat) 	.llseek		= tracing_lseek,
549229ad23b0SNamhyung Kim 	.release	= ftrace_graph_release,
549329ad23b0SNamhyung Kim };
5494ea4e2bc4SSteven Rostedt #endif /* CONFIG_FUNCTION_GRAPH_TRACER */
5495ea4e2bc4SSteven Rostedt 
5496591dffdaSSteven Rostedt (Red Hat) void ftrace_create_filter_files(struct ftrace_ops *ops,
5497591dffdaSSteven Rostedt (Red Hat) 				struct dentry *parent)
5498591dffdaSSteven Rostedt (Red Hat) {
5499591dffdaSSteven Rostedt (Red Hat) 
5500591dffdaSSteven Rostedt (Red Hat) 	trace_create_file("set_ftrace_filter", 0644, parent,
5501591dffdaSSteven Rostedt (Red Hat) 			  ops, &ftrace_filter_fops);
5502591dffdaSSteven Rostedt (Red Hat) 
5503591dffdaSSteven Rostedt (Red Hat) 	trace_create_file("set_ftrace_notrace", 0644, parent,
5504591dffdaSSteven Rostedt (Red Hat) 			  ops, &ftrace_notrace_fops);
5505591dffdaSSteven Rostedt (Red Hat) }
5506591dffdaSSteven Rostedt (Red Hat) 
5507591dffdaSSteven Rostedt (Red Hat) /*
5508591dffdaSSteven Rostedt (Red Hat)  * The name "destroy_filter_files" is really a misnomer. Although
5509591dffdaSSteven Rostedt (Red Hat)  * in the future, it may actualy delete the files, but this is
5510591dffdaSSteven Rostedt (Red Hat)  * really intended to make sure the ops passed in are disabled
5511591dffdaSSteven Rostedt (Red Hat)  * and that when this function returns, the caller is free to
5512591dffdaSSteven Rostedt (Red Hat)  * free the ops.
5513591dffdaSSteven Rostedt (Red Hat)  *
5514591dffdaSSteven Rostedt (Red Hat)  * The "destroy" name is only to match the "create" name that this
5515591dffdaSSteven Rostedt (Red Hat)  * should be paired with.
5516591dffdaSSteven Rostedt (Red Hat)  */
5517591dffdaSSteven Rostedt (Red Hat) void ftrace_destroy_filter_files(struct ftrace_ops *ops)
5518591dffdaSSteven Rostedt (Red Hat) {
5519591dffdaSSteven Rostedt (Red Hat) 	mutex_lock(&ftrace_lock);
5520591dffdaSSteven Rostedt (Red Hat) 	if (ops->flags & FTRACE_OPS_FL_ENABLED)
5521591dffdaSSteven Rostedt (Red Hat) 		ftrace_shutdown(ops, 0);
5522591dffdaSSteven Rostedt (Red Hat) 	ops->flags |= FTRACE_OPS_FL_DELETED;
5523591dffdaSSteven Rostedt (Red Hat) 	mutex_unlock(&ftrace_lock);
5524591dffdaSSteven Rostedt (Red Hat) }
5525591dffdaSSteven Rostedt (Red Hat) 
55268434dc93SSteven Rostedt (Red Hat) static __init int ftrace_init_dyn_tracefs(struct dentry *d_tracer)
55275072c59fSSteven Rostedt {
55285072c59fSSteven Rostedt 
55295452af66SFrederic Weisbecker 	trace_create_file("available_filter_functions", 0444,
55305072c59fSSteven Rostedt 			d_tracer, NULL, &ftrace_avail_fops);
55315072c59fSSteven Rostedt 
5532647bcd03SSteven Rostedt 	trace_create_file("enabled_functions", 0444,
5533647bcd03SSteven Rostedt 			d_tracer, NULL, &ftrace_enabled_fops);
5534647bcd03SSteven Rostedt 
5535591dffdaSSteven Rostedt (Red Hat) 	ftrace_create_filter_files(&global_ops, d_tracer);
5536ad90c0e3SSteven Rostedt 
5537ea4e2bc4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
55385452af66SFrederic Weisbecker 	trace_create_file("set_graph_function", 0444, d_tracer,
5539ea4e2bc4SSteven Rostedt 				    NULL,
5540ea4e2bc4SSteven Rostedt 				    &ftrace_graph_fops);
554129ad23b0SNamhyung Kim 	trace_create_file("set_graph_notrace", 0444, d_tracer,
554229ad23b0SNamhyung Kim 				    NULL,
554329ad23b0SNamhyung Kim 				    &ftrace_graph_notrace_fops);
5544ea4e2bc4SSteven Rostedt #endif /* CONFIG_FUNCTION_GRAPH_TRACER */
5545ea4e2bc4SSteven Rostedt 
55465072c59fSSteven Rostedt 	return 0;
55475072c59fSSteven Rostedt }
55485072c59fSSteven Rostedt 
55499fd49328SSteven Rostedt static int ftrace_cmp_ips(const void *a, const void *b)
555068950619SSteven Rostedt {
55519fd49328SSteven Rostedt 	const unsigned long *ipa = a;
55529fd49328SSteven Rostedt 	const unsigned long *ipb = b;
555368950619SSteven Rostedt 
55549fd49328SSteven Rostedt 	if (*ipa > *ipb)
55559fd49328SSteven Rostedt 		return 1;
55569fd49328SSteven Rostedt 	if (*ipa < *ipb)
55579fd49328SSteven Rostedt 		return -1;
55589fd49328SSteven Rostedt 	return 0;
55599fd49328SSteven Rostedt }
55609fd49328SSteven Rostedt 
55615cb084bbSJiri Olsa static int ftrace_process_locs(struct module *mod,
556231e88909SSteven Rostedt 			       unsigned long *start,
556368bf21aaSSteven Rostedt 			       unsigned long *end)
556468bf21aaSSteven Rostedt {
5565706c81f8SSteven Rostedt 	struct ftrace_page *start_pg;
5566a7900875SSteven Rostedt 	struct ftrace_page *pg;
5567706c81f8SSteven Rostedt 	struct dyn_ftrace *rec;
5568a7900875SSteven Rostedt 	unsigned long count;
556968bf21aaSSteven Rostedt 	unsigned long *p;
557068bf21aaSSteven Rostedt 	unsigned long addr;
55714376cac6SSteven Rostedt 	unsigned long flags = 0; /* Shut up gcc */
5572a7900875SSteven Rostedt 	int ret = -ENOMEM;
5573a7900875SSteven Rostedt 
5574a7900875SSteven Rostedt 	count = end - start;
5575a7900875SSteven Rostedt 
5576a7900875SSteven Rostedt 	if (!count)
5577a7900875SSteven Rostedt 		return 0;
5578a7900875SSteven Rostedt 
55799fd49328SSteven Rostedt 	sort(start, count, sizeof(*start),
55806db02903SRasmus Villemoes 	     ftrace_cmp_ips, NULL);
55819fd49328SSteven Rostedt 
5582706c81f8SSteven Rostedt 	start_pg = ftrace_allocate_pages(count);
5583706c81f8SSteven Rostedt 	if (!start_pg)
5584a7900875SSteven Rostedt 		return -ENOMEM;
558568bf21aaSSteven Rostedt 
5586e6ea44e9SSteven Rostedt 	mutex_lock(&ftrace_lock);
5587a7900875SSteven Rostedt 
558832082309SSteven Rostedt 	/*
558932082309SSteven Rostedt 	 * Core and each module needs their own pages, as
559032082309SSteven Rostedt 	 * modules will free them when they are removed.
559132082309SSteven Rostedt 	 * Force a new page to be allocated for modules.
559232082309SSteven Rostedt 	 */
5593a7900875SSteven Rostedt 	if (!mod) {
5594a7900875SSteven Rostedt 		WARN_ON(ftrace_pages || ftrace_pages_start);
5595a7900875SSteven Rostedt 		/* First initialization */
5596706c81f8SSteven Rostedt 		ftrace_pages = ftrace_pages_start = start_pg;
5597a7900875SSteven Rostedt 	} else {
559832082309SSteven Rostedt 		if (!ftrace_pages)
5599a7900875SSteven Rostedt 			goto out;
560032082309SSteven Rostedt 
5601a7900875SSteven Rostedt 		if (WARN_ON(ftrace_pages->next)) {
5602a7900875SSteven Rostedt 			/* Hmm, we have free pages? */
5603a7900875SSteven Rostedt 			while (ftrace_pages->next)
560432082309SSteven Rostedt 				ftrace_pages = ftrace_pages->next;
560532082309SSteven Rostedt 		}
5606a7900875SSteven Rostedt 
5607706c81f8SSteven Rostedt 		ftrace_pages->next = start_pg;
560832082309SSteven Rostedt 	}
560932082309SSteven Rostedt 
561068bf21aaSSteven Rostedt 	p = start;
5611706c81f8SSteven Rostedt 	pg = start_pg;
561268bf21aaSSteven Rostedt 	while (p < end) {
561368bf21aaSSteven Rostedt 		addr = ftrace_call_adjust(*p++);
561420e5227eSSteven Rostedt 		/*
561520e5227eSSteven Rostedt 		 * Some architecture linkers will pad between
561620e5227eSSteven Rostedt 		 * the different mcount_loc sections of different
561720e5227eSSteven Rostedt 		 * object files to satisfy alignments.
561820e5227eSSteven Rostedt 		 * Skip any NULL pointers.
561920e5227eSSteven Rostedt 		 */
562020e5227eSSteven Rostedt 		if (!addr)
562120e5227eSSteven Rostedt 			continue;
5622706c81f8SSteven Rostedt 
5623706c81f8SSteven Rostedt 		if (pg->index == pg->size) {
5624706c81f8SSteven Rostedt 			/* We should have allocated enough */
5625706c81f8SSteven Rostedt 			if (WARN_ON(!pg->next))
5626a7900875SSteven Rostedt 				break;
5627706c81f8SSteven Rostedt 			pg = pg->next;
562868bf21aaSSteven Rostedt 		}
562968bf21aaSSteven Rostedt 
5630706c81f8SSteven Rostedt 		rec = &pg->records[pg->index++];
5631706c81f8SSteven Rostedt 		rec->ip = addr;
5632706c81f8SSteven Rostedt 	}
5633706c81f8SSteven Rostedt 
5634706c81f8SSteven Rostedt 	/* We should have used all pages */
5635706c81f8SSteven Rostedt 	WARN_ON(pg->next);
5636706c81f8SSteven Rostedt 
5637706c81f8SSteven Rostedt 	/* Assign the last page to ftrace_pages */
5638706c81f8SSteven Rostedt 	ftrace_pages = pg;
5639706c81f8SSteven Rostedt 
5640a4f18ed1SSteven Rostedt 	/*
56414376cac6SSteven Rostedt 	 * We only need to disable interrupts on start up
56424376cac6SSteven Rostedt 	 * because we are modifying code that an interrupt
56434376cac6SSteven Rostedt 	 * may execute, and the modification is not atomic.
56444376cac6SSteven Rostedt 	 * But for modules, nothing runs the code we modify
56454376cac6SSteven Rostedt 	 * until we are finished with it, and there's no
56464376cac6SSteven Rostedt 	 * reason to cause large interrupt latencies while we do it.
5647a4f18ed1SSteven Rostedt 	 */
56484376cac6SSteven Rostedt 	if (!mod)
5649a4f18ed1SSteven Rostedt 		local_irq_save(flags);
56501dc43cf0SJiri Slaby 	ftrace_update_code(mod, start_pg);
56514376cac6SSteven Rostedt 	if (!mod)
5652a4f18ed1SSteven Rostedt 		local_irq_restore(flags);
5653a7900875SSteven Rostedt 	ret = 0;
5654a7900875SSteven Rostedt  out:
5655e6ea44e9SSteven Rostedt 	mutex_unlock(&ftrace_lock);
565668bf21aaSSteven Rostedt 
5657a7900875SSteven Rostedt 	return ret;
565868bf21aaSSteven Rostedt }
565968bf21aaSSteven Rostedt 
566093eb677dSSteven Rostedt #ifdef CONFIG_MODULES
566132082309SSteven Rostedt 
566232082309SSteven Rostedt #define next_to_ftrace_page(p) container_of(p, struct ftrace_page, next)
566332082309SSteven Rostedt 
5664b7ffffbbSSteven Rostedt (Red Hat) static int referenced_filters(struct dyn_ftrace *rec)
5665b7ffffbbSSteven Rostedt (Red Hat) {
5666b7ffffbbSSteven Rostedt (Red Hat) 	struct ftrace_ops *ops;
5667b7ffffbbSSteven Rostedt (Red Hat) 	int cnt = 0;
5668b7ffffbbSSteven Rostedt (Red Hat) 
5669b7ffffbbSSteven Rostedt (Red Hat) 	for (ops = ftrace_ops_list; ops != &ftrace_list_end; ops = ops->next) {
5670b7ffffbbSSteven Rostedt (Red Hat) 		if (ops_references_rec(ops, rec))
5671b7ffffbbSSteven Rostedt (Red Hat) 		    cnt++;
5672b7ffffbbSSteven Rostedt (Red Hat) 	}
5673b7ffffbbSSteven Rostedt (Red Hat) 
5674b7ffffbbSSteven Rostedt (Red Hat) 	return cnt;
5675b7ffffbbSSteven Rostedt (Red Hat) }
5676b7ffffbbSSteven Rostedt (Red Hat) 
5677e7247a15S[email protected] void ftrace_release_mod(struct module *mod)
567893eb677dSSteven Rostedt {
567993eb677dSSteven Rostedt 	struct dyn_ftrace *rec;
568032082309SSteven Rostedt 	struct ftrace_page **last_pg;
568193eb677dSSteven Rostedt 	struct ftrace_page *pg;
5682a7900875SSteven Rostedt 	int order;
568393eb677dSSteven Rostedt 
568493eb677dSSteven Rostedt 	mutex_lock(&ftrace_lock);
568545a4a237SSteven Rostedt 
568645a4a237SSteven Rostedt 	if (ftrace_disabled)
568745a4a237SSteven Rostedt 		goto out_unlock;
568845a4a237SSteven Rostedt 
568932082309SSteven Rostedt 	/*
569032082309SSteven Rostedt 	 * Each module has its own ftrace_pages, remove
569132082309SSteven Rostedt 	 * them from the list.
569232082309SSteven Rostedt 	 */
569332082309SSteven Rostedt 	last_pg = &ftrace_pages_start;
569432082309SSteven Rostedt 	for (pg = ftrace_pages_start; pg; pg = *last_pg) {
569532082309SSteven Rostedt 		rec = &pg->records[0];
5696e7247a15S[email protected] 		if (within_module_core(rec->ip, mod)) {
569793eb677dSSteven Rostedt 			/*
569832082309SSteven Rostedt 			 * As core pages are first, the first
569932082309SSteven Rostedt 			 * page should never be a module page.
570093eb677dSSteven Rostedt 			 */
570132082309SSteven Rostedt 			if (WARN_ON(pg == ftrace_pages_start))
570232082309SSteven Rostedt 				goto out_unlock;
570332082309SSteven Rostedt 
570432082309SSteven Rostedt 			/* Check if we are deleting the last page */
570532082309SSteven Rostedt 			if (pg == ftrace_pages)
570632082309SSteven Rostedt 				ftrace_pages = next_to_ftrace_page(last_pg);
570732082309SSteven Rostedt 
570883dd1493SSteven Rostedt (VMware) 			ftrace_update_tot_cnt -= pg->index;
570932082309SSteven Rostedt 			*last_pg = pg->next;
5710a7900875SSteven Rostedt 			order = get_count_order(pg->size / ENTRIES_PER_PAGE);
5711a7900875SSteven Rostedt 			free_pages((unsigned long)pg->records, order);
5712a7900875SSteven Rostedt 			kfree(pg);
571332082309SSteven Rostedt 		} else
571432082309SSteven Rostedt 			last_pg = &pg->next;
571593eb677dSSteven Rostedt 	}
571645a4a237SSteven Rostedt  out_unlock:
571793eb677dSSteven Rostedt 	mutex_unlock(&ftrace_lock);
571893eb677dSSteven Rostedt }
571993eb677dSSteven Rostedt 
57207dcd182bSJessica Yu void ftrace_module_enable(struct module *mod)
5721b7ffffbbSSteven Rostedt (Red Hat) {
5722b7ffffbbSSteven Rostedt (Red Hat) 	struct dyn_ftrace *rec;
5723b7ffffbbSSteven Rostedt (Red Hat) 	struct ftrace_page *pg;
5724b7ffffbbSSteven Rostedt (Red Hat) 
5725b7ffffbbSSteven Rostedt (Red Hat) 	mutex_lock(&ftrace_lock);
5726b7ffffbbSSteven Rostedt (Red Hat) 
5727b7ffffbbSSteven Rostedt (Red Hat) 	if (ftrace_disabled)
5728b7ffffbbSSteven Rostedt (Red Hat) 		goto out_unlock;
5729b7ffffbbSSteven Rostedt (Red Hat) 
5730b7ffffbbSSteven Rostedt (Red Hat) 	/*
5731b7ffffbbSSteven Rostedt (Red Hat) 	 * If the tracing is enabled, go ahead and enable the record.
5732b7ffffbbSSteven Rostedt (Red Hat) 	 *
5733b7ffffbbSSteven Rostedt (Red Hat) 	 * The reason not to enable the record immediatelly is the
5734b7ffffbbSSteven Rostedt (Red Hat) 	 * inherent check of ftrace_make_nop/ftrace_make_call for
5735b7ffffbbSSteven Rostedt (Red Hat) 	 * correct previous instructions.  Making first the NOP
5736b7ffffbbSSteven Rostedt (Red Hat) 	 * conversion puts the module to the correct state, thus
5737b7ffffbbSSteven Rostedt (Red Hat) 	 * passing the ftrace_make_call check.
5738b7ffffbbSSteven Rostedt (Red Hat) 	 *
5739b7ffffbbSSteven Rostedt (Red Hat) 	 * We also delay this to after the module code already set the
5740b7ffffbbSSteven Rostedt (Red Hat) 	 * text to read-only, as we now need to set it back to read-write
5741b7ffffbbSSteven Rostedt (Red Hat) 	 * so that we can modify the text.
5742b7ffffbbSSteven Rostedt (Red Hat) 	 */
5743b7ffffbbSSteven Rostedt (Red Hat) 	if (ftrace_start_up)
5744b7ffffbbSSteven Rostedt (Red Hat) 		ftrace_arch_code_modify_prepare();
5745b7ffffbbSSteven Rostedt (Red Hat) 
5746b7ffffbbSSteven Rostedt (Red Hat) 	do_for_each_ftrace_rec(pg, rec) {
5747b7ffffbbSSteven Rostedt (Red Hat) 		int cnt;
5748b7ffffbbSSteven Rostedt (Red Hat) 		/*
5749b7ffffbbSSteven Rostedt (Red Hat) 		 * do_for_each_ftrace_rec() is a double loop.
5750b7ffffbbSSteven Rostedt (Red Hat) 		 * module text shares the pg. If a record is
5751b7ffffbbSSteven Rostedt (Red Hat) 		 * not part of this module, then skip this pg,
5752b7ffffbbSSteven Rostedt (Red Hat) 		 * which the "break" will do.
5753b7ffffbbSSteven Rostedt (Red Hat) 		 */
5754b7ffffbbSSteven Rostedt (Red Hat) 		if (!within_module_core(rec->ip, mod))
5755b7ffffbbSSteven Rostedt (Red Hat) 			break;
5756b7ffffbbSSteven Rostedt (Red Hat) 
5757b7ffffbbSSteven Rostedt (Red Hat) 		cnt = 0;
5758b7ffffbbSSteven Rostedt (Red Hat) 
5759b7ffffbbSSteven Rostedt (Red Hat) 		/*
5760b7ffffbbSSteven Rostedt (Red Hat) 		 * When adding a module, we need to check if tracers are
5761b7ffffbbSSteven Rostedt (Red Hat) 		 * currently enabled and if they are, and can trace this record,
5762b7ffffbbSSteven Rostedt (Red Hat) 		 * we need to enable the module functions as well as update the
5763b7ffffbbSSteven Rostedt (Red Hat) 		 * reference counts for those function records.
5764b7ffffbbSSteven Rostedt (Red Hat) 		 */
5765b7ffffbbSSteven Rostedt (Red Hat) 		if (ftrace_start_up)
5766b7ffffbbSSteven Rostedt (Red Hat) 			cnt += referenced_filters(rec);
5767b7ffffbbSSteven Rostedt (Red Hat) 
5768b7ffffbbSSteven Rostedt (Red Hat) 		/* This clears FTRACE_FL_DISABLED */
5769b7ffffbbSSteven Rostedt (Red Hat) 		rec->flags = cnt;
5770b7ffffbbSSteven Rostedt (Red Hat) 
5771b7ffffbbSSteven Rostedt (Red Hat) 		if (ftrace_start_up && cnt) {
5772b7ffffbbSSteven Rostedt (Red Hat) 			int failed = __ftrace_replace_code(rec, 1);
5773b7ffffbbSSteven Rostedt (Red Hat) 			if (failed) {
5774b7ffffbbSSteven Rostedt (Red Hat) 				ftrace_bug(failed, rec);
5775b7ffffbbSSteven Rostedt (Red Hat) 				goto out_loop;
5776b7ffffbbSSteven Rostedt (Red Hat) 			}
5777b7ffffbbSSteven Rostedt (Red Hat) 		}
5778b7ffffbbSSteven Rostedt (Red Hat) 
5779b7ffffbbSSteven Rostedt (Red Hat) 	} while_for_each_ftrace_rec();
5780b7ffffbbSSteven Rostedt (Red Hat) 
5781b7ffffbbSSteven Rostedt (Red Hat)  out_loop:
5782b7ffffbbSSteven Rostedt (Red Hat) 	if (ftrace_start_up)
5783b7ffffbbSSteven Rostedt (Red Hat) 		ftrace_arch_code_modify_post_process();
5784b7ffffbbSSteven Rostedt (Red Hat) 
5785b7ffffbbSSteven Rostedt (Red Hat)  out_unlock:
5786b7ffffbbSSteven Rostedt (Red Hat) 	mutex_unlock(&ftrace_lock);
5787d7fbf8dfSSteven Rostedt (VMware) 
5788d7fbf8dfSSteven Rostedt (VMware) 	process_cached_mods(mod->name);
5789b7ffffbbSSteven Rostedt (Red Hat) }
5790b7ffffbbSSteven Rostedt (Red Hat) 
5791a949ae56SSteven Rostedt (Red Hat) void ftrace_module_init(struct module *mod)
579293eb677dSSteven Rostedt {
579397e9b4fcSSteven Rostedt (Red Hat) 	if (ftrace_disabled || !mod->num_ftrace_callsites)
5794b6b71f66SAbel Vesa 		return;
5795b6b71f66SAbel Vesa 
579697e9b4fcSSteven Rostedt (Red Hat) 	ftrace_process_locs(mod, mod->ftrace_callsites,
579797e9b4fcSSteven Rostedt (Red Hat) 			    mod->ftrace_callsites + mod->num_ftrace_callsites);
579893eb677dSSteven Rostedt }
579993eb677dSSteven Rostedt #endif /* CONFIG_MODULES */
580093eb677dSSteven Rostedt 
5801b80f0f6cSSteven Rostedt (VMware) void __init ftrace_free_init_mem(void)
580242c269c8SSteven Rostedt (VMware) {
5803b80f0f6cSSteven Rostedt (VMware) 	unsigned long start = (unsigned long)(&__init_begin);
5804b80f0f6cSSteven Rostedt (VMware) 	unsigned long end = (unsigned long)(&__init_end);
580542c269c8SSteven Rostedt (VMware) 	struct ftrace_page **last_pg = &ftrace_pages_start;
580642c269c8SSteven Rostedt (VMware) 	struct ftrace_page *pg;
580742c269c8SSteven Rostedt (VMware) 	struct dyn_ftrace *rec;
580842c269c8SSteven Rostedt (VMware) 	struct dyn_ftrace key;
580942c269c8SSteven Rostedt (VMware) 	int order;
581042c269c8SSteven Rostedt (VMware) 
581142c269c8SSteven Rostedt (VMware) 	key.ip = start;
581242c269c8SSteven Rostedt (VMware) 	key.flags = end;	/* overload flags, as it is unsigned long */
581342c269c8SSteven Rostedt (VMware) 
581442c269c8SSteven Rostedt (VMware) 	mutex_lock(&ftrace_lock);
581542c269c8SSteven Rostedt (VMware) 
581642c269c8SSteven Rostedt (VMware) 	for (pg = ftrace_pages_start; pg; last_pg = &pg->next, pg = *last_pg) {
581742c269c8SSteven Rostedt (VMware) 		if (end < pg->records[0].ip ||
581842c269c8SSteven Rostedt (VMware) 		    start >= (pg->records[pg->index - 1].ip + MCOUNT_INSN_SIZE))
581942c269c8SSteven Rostedt (VMware) 			continue;
582042c269c8SSteven Rostedt (VMware)  again:
582142c269c8SSteven Rostedt (VMware) 		rec = bsearch(&key, pg->records, pg->index,
582242c269c8SSteven Rostedt (VMware) 			      sizeof(struct dyn_ftrace),
582342c269c8SSteven Rostedt (VMware) 			      ftrace_cmp_recs);
582442c269c8SSteven Rostedt (VMware) 		if (!rec)
582542c269c8SSteven Rostedt (VMware) 			continue;
582642c269c8SSteven Rostedt (VMware) 		pg->index--;
58274ec78467SSteven Rostedt (VMware) 		ftrace_update_tot_cnt--;
582842c269c8SSteven Rostedt (VMware) 		if (!pg->index) {
582942c269c8SSteven Rostedt (VMware) 			*last_pg = pg->next;
583042c269c8SSteven Rostedt (VMware) 			order = get_count_order(pg->size / ENTRIES_PER_PAGE);
583142c269c8SSteven Rostedt (VMware) 			free_pages((unsigned long)pg->records, order);
583242c269c8SSteven Rostedt (VMware) 			kfree(pg);
583342c269c8SSteven Rostedt (VMware) 			pg = container_of(last_pg, struct ftrace_page, next);
583442c269c8SSteven Rostedt (VMware) 			if (!(*last_pg))
583542c269c8SSteven Rostedt (VMware) 				ftrace_pages = pg;
583642c269c8SSteven Rostedt (VMware) 			continue;
583742c269c8SSteven Rostedt (VMware) 		}
583842c269c8SSteven Rostedt (VMware) 		memmove(rec, rec + 1,
583942c269c8SSteven Rostedt (VMware) 			(pg->index - (rec - pg->records)) * sizeof(*rec));
584042c269c8SSteven Rostedt (VMware) 		/* More than one function may be in this block */
584142c269c8SSteven Rostedt (VMware) 		goto again;
584242c269c8SSteven Rostedt (VMware) 	}
584342c269c8SSteven Rostedt (VMware) 	mutex_unlock(&ftrace_lock);
584442c269c8SSteven Rostedt (VMware) }
584542c269c8SSteven Rostedt (VMware) 
584668bf21aaSSteven Rostedt void __init ftrace_init(void)
584768bf21aaSSteven Rostedt {
58481dc43cf0SJiri Slaby 	extern unsigned long __start_mcount_loc[];
58491dc43cf0SJiri Slaby 	extern unsigned long __stop_mcount_loc[];
58503a36cb11SJiri Slaby 	unsigned long count, flags;
585168bf21aaSSteven Rostedt 	int ret;
585268bf21aaSSteven Rostedt 
585368bf21aaSSteven Rostedt 	local_irq_save(flags);
58543a36cb11SJiri Slaby 	ret = ftrace_dyn_arch_init();
585568bf21aaSSteven Rostedt 	local_irq_restore(flags);
5856af64a7cbSJiri Slaby 	if (ret)
585768bf21aaSSteven Rostedt 		goto failed;
585868bf21aaSSteven Rostedt 
585968bf21aaSSteven Rostedt 	count = __stop_mcount_loc - __start_mcount_loc;
5860c867ccd8SJiri Slaby 	if (!count) {
5861c867ccd8SJiri Slaby 		pr_info("ftrace: No functions to be traced?\n");
586268bf21aaSSteven Rostedt 		goto failed;
5863c867ccd8SJiri Slaby 	}
5864c867ccd8SJiri Slaby 
5865c867ccd8SJiri Slaby 	pr_info("ftrace: allocating %ld entries in %ld pages\n",
5866c867ccd8SJiri Slaby 		count, count / ENTRIES_PER_PAGE + 1);
586768bf21aaSSteven Rostedt 
586868bf21aaSSteven Rostedt 	last_ftrace_enabled = ftrace_enabled = 1;
586968bf21aaSSteven Rostedt 
58705cb084bbSJiri Olsa 	ret = ftrace_process_locs(NULL,
587131e88909SSteven Rostedt 				  __start_mcount_loc,
587268bf21aaSSteven Rostedt 				  __stop_mcount_loc);
587368bf21aaSSteven Rostedt 
58742af15d6aSSteven Rostedt 	set_ftrace_early_filters();
58752af15d6aSSteven Rostedt 
587668bf21aaSSteven Rostedt 	return;
587768bf21aaSSteven Rostedt  failed:
587868bf21aaSSteven Rostedt 	ftrace_disabled = 1;
587968bf21aaSSteven Rostedt }
588068bf21aaSSteven Rostedt 
5881f3bea491SSteven Rostedt (Red Hat) /* Do nothing if arch does not support this */
5882f3bea491SSteven Rostedt (Red Hat) void __weak arch_ftrace_update_trampoline(struct ftrace_ops *ops)
5883f3bea491SSteven Rostedt (Red Hat) {
5884f3bea491SSteven Rostedt (Red Hat) }
5885f3bea491SSteven Rostedt (Red Hat) 
5886f3bea491SSteven Rostedt (Red Hat) static void ftrace_update_trampoline(struct ftrace_ops *ops)
5887f3bea491SSteven Rostedt (Red Hat) {
5888f3bea491SSteven Rostedt (Red Hat) 	arch_ftrace_update_trampoline(ops);
5889f3bea491SSteven Rostedt (Red Hat) }
5890f3bea491SSteven Rostedt (Red Hat) 
589104ec7bb6SSteven Rostedt (VMware) void ftrace_init_trace_array(struct trace_array *tr)
589204ec7bb6SSteven Rostedt (VMware) {
589304ec7bb6SSteven Rostedt (VMware) 	INIT_LIST_HEAD(&tr->func_probes);
5894673feb9dSSteven Rostedt (VMware) 	INIT_LIST_HEAD(&tr->mod_trace);
5895673feb9dSSteven Rostedt (VMware) 	INIT_LIST_HEAD(&tr->mod_notrace);
589604ec7bb6SSteven Rostedt (VMware) }
58973d083395SSteven Rostedt #else
58980b6e4d56SFrederic Weisbecker 
58992b499381SSteven Rostedt static struct ftrace_ops global_ops = {
5900bd69c30bSSteven Rostedt 	.func			= ftrace_stub,
5901e3eea140SSteven Rostedt (Red Hat) 	.flags			= FTRACE_OPS_FL_RECURSION_SAFE |
5902e3eea140SSteven Rostedt (Red Hat) 				  FTRACE_OPS_FL_INITIALIZED |
5903e3eea140SSteven Rostedt (Red Hat) 				  FTRACE_OPS_FL_PID,
5904bd69c30bSSteven Rostedt };
5905bd69c30bSSteven Rostedt 
59060b6e4d56SFrederic Weisbecker static int __init ftrace_nodyn_init(void)
59070b6e4d56SFrederic Weisbecker {
59080b6e4d56SFrederic Weisbecker 	ftrace_enabled = 1;
59090b6e4d56SFrederic Weisbecker 	return 0;
59100b6e4d56SFrederic Weisbecker }
59116f415672SSteven Rostedt core_initcall(ftrace_nodyn_init);
59120b6e4d56SFrederic Weisbecker 
59138434dc93SSteven Rostedt (Red Hat) static inline int ftrace_init_dyn_tracefs(struct dentry *d_tracer) { return 0; }
5914df4fc315SSteven Rostedt static inline void ftrace_startup_enable(int command) { }
5915e1effa01SSteven Rostedt (Red Hat) static inline void ftrace_startup_all(int command) { }
59165a45cfe1SSteven Rostedt /* Keep as macros so we do not need to define the commands */
59173b6cfdb1SSteven Rostedt # define ftrace_startup(ops, command)					\
59183b6cfdb1SSteven Rostedt 	({								\
59198a56d776SSteven Rostedt (Red Hat) 		int ___ret = __register_ftrace_function(ops);		\
59208a56d776SSteven Rostedt (Red Hat) 		if (!___ret)						\
59213b6cfdb1SSteven Rostedt 			(ops)->flags |= FTRACE_OPS_FL_ENABLED;		\
59228a56d776SSteven Rostedt (Red Hat) 		___ret;							\
59233b6cfdb1SSteven Rostedt 	})
59241fcc1553SSteven Rostedt (Red Hat) # define ftrace_shutdown(ops, command)					\
59251fcc1553SSteven Rostedt (Red Hat) 	({								\
59261fcc1553SSteven Rostedt (Red Hat) 		int ___ret = __unregister_ftrace_function(ops);		\
59271fcc1553SSteven Rostedt (Red Hat) 		if (!___ret)						\
59281fcc1553SSteven Rostedt (Red Hat) 			(ops)->flags &= ~FTRACE_OPS_FL_ENABLED;		\
59291fcc1553SSteven Rostedt (Red Hat) 		___ret;							\
59301fcc1553SSteven Rostedt (Red Hat) 	})
59318a56d776SSteven Rostedt (Red Hat) 
5932b0fc494fSSteven Rostedt # define ftrace_startup_sysctl()	do { } while (0)
5933b0fc494fSSteven Rostedt # define ftrace_shutdown_sysctl()	do { } while (0)
5934b848914cSSteven Rostedt 
5935b848914cSSteven Rostedt static inline int
5936195a8afcSSteven Rostedt (Red Hat) ftrace_ops_test(struct ftrace_ops *ops, unsigned long ip, void *regs)
5937b848914cSSteven Rostedt {
5938b848914cSSteven Rostedt 	return 1;
5939b848914cSSteven Rostedt }
5940b848914cSSteven Rostedt 
5941f3bea491SSteven Rostedt (Red Hat) static void ftrace_update_trampoline(struct ftrace_ops *ops)
5942f3bea491SSteven Rostedt (Red Hat) {
5943f3bea491SSteven Rostedt (Red Hat) }
5944f3bea491SSteven Rostedt (Red Hat) 
59453d083395SSteven Rostedt #endif /* CONFIG_DYNAMIC_FTRACE */
59463d083395SSteven Rostedt 
59474104d326SSteven Rostedt (Red Hat) __init void ftrace_init_global_array_ops(struct trace_array *tr)
59484104d326SSteven Rostedt (Red Hat) {
59494104d326SSteven Rostedt (Red Hat) 	tr->ops = &global_ops;
59504104d326SSteven Rostedt (Red Hat) 	tr->ops->private = tr;
595104ec7bb6SSteven Rostedt (VMware) 	ftrace_init_trace_array(tr);
59524104d326SSteven Rostedt (Red Hat) }
59534104d326SSteven Rostedt (Red Hat) 
59544104d326SSteven Rostedt (Red Hat) void ftrace_init_array_ops(struct trace_array *tr, ftrace_func_t func)
59554104d326SSteven Rostedt (Red Hat) {
59564104d326SSteven Rostedt (Red Hat) 	/* If we filter on pids, update to use the pid function */
59574104d326SSteven Rostedt (Red Hat) 	if (tr->flags & TRACE_ARRAY_FL_GLOBAL) {
59584104d326SSteven Rostedt (Red Hat) 		if (WARN_ON(tr->ops->func != ftrace_stub))
59594104d326SSteven Rostedt (Red Hat) 			printk("ftrace ops had %pS for function\n",
59604104d326SSteven Rostedt (Red Hat) 			       tr->ops->func);
59614104d326SSteven Rostedt (Red Hat) 	}
59624104d326SSteven Rostedt (Red Hat) 	tr->ops->func = func;
59634104d326SSteven Rostedt (Red Hat) 	tr->ops->private = tr;
59644104d326SSteven Rostedt (Red Hat) }
59654104d326SSteven Rostedt (Red Hat) 
59664104d326SSteven Rostedt (Red Hat) void ftrace_reset_array_ops(struct trace_array *tr)
59674104d326SSteven Rostedt (Red Hat) {
59684104d326SSteven Rostedt (Red Hat) 	tr->ops->func = ftrace_stub;
59694104d326SSteven Rostedt (Red Hat) }
59704104d326SSteven Rostedt (Red Hat) 
59712f5f6ad9SSteven Rostedt static inline void
59722f5f6ad9SSteven Rostedt __ftrace_ops_list_func(unsigned long ip, unsigned long parent_ip,
5973a1e2e31dSSteven Rostedt 		       struct ftrace_ops *ignored, struct pt_regs *regs)
5974b848914cSSteven Rostedt {
5975cdbe61bfSSteven Rostedt 	struct ftrace_ops *op;
5976edc15cafSSteven Rostedt 	int bit;
5977b848914cSSteven Rostedt 
5978edc15cafSSteven Rostedt 	bit = trace_test_and_set_recursion(TRACE_LIST_START, TRACE_LIST_MAX);
5979edc15cafSSteven Rostedt 	if (bit < 0)
5980b1cff0adSSteven Rostedt 		return;
5981b1cff0adSSteven Rostedt 
5982cdbe61bfSSteven Rostedt 	/*
5983cdbe61bfSSteven Rostedt 	 * Some of the ops may be dynamically allocated,
5984cdbe61bfSSteven Rostedt 	 * they must be freed after a synchronize_sched().
5985cdbe61bfSSteven Rostedt 	 */
5986cdbe61bfSSteven Rostedt 	preempt_disable_notrace();
5987ba27f2bcSSteven Rostedt (Red Hat) 
59880a016409SSteven Rostedt 	do_for_each_ftrace_op(op, ftrace_ops_list) {
5989ba27f2bcSSteven Rostedt (Red Hat) 		/*
5990ba27f2bcSSteven Rostedt (Red Hat) 		 * Check the following for each ops before calling their func:
5991ba27f2bcSSteven Rostedt (Red Hat) 		 *  if RCU flag is set, then rcu_is_watching() must be true
5992ba27f2bcSSteven Rostedt (Red Hat) 		 *  if PER_CPU is set, then ftrace_function_local_disable()
5993ba27f2bcSSteven Rostedt (Red Hat) 		 *                          must be false
5994ba27f2bcSSteven Rostedt (Red Hat) 		 *  Otherwise test if the ip matches the ops filter
5995ba27f2bcSSteven Rostedt (Red Hat) 		 *
5996ba27f2bcSSteven Rostedt (Red Hat) 		 * If any of the above fails then the op->func() is not executed.
5997ba27f2bcSSteven Rostedt (Red Hat) 		 */
5998ba27f2bcSSteven Rostedt (Red Hat) 		if ((!(op->flags & FTRACE_OPS_FL_RCU) || rcu_is_watching()) &&
5999ba27f2bcSSteven Rostedt (Red Hat) 		    (!(op->flags & FTRACE_OPS_FL_PER_CPU) ||
6000ba27f2bcSSteven Rostedt (Red Hat) 		     !ftrace_function_local_disabled(op)) &&
6001ba27f2bcSSteven Rostedt (Red Hat) 		    ftrace_ops_test(op, ip, regs)) {
6002ba27f2bcSSteven Rostedt (Red Hat) 
60031d48d596SSteven Rostedt (Red Hat) 			if (FTRACE_WARN_ON(!op->func)) {
60041d48d596SSteven Rostedt (Red Hat) 				pr_warn("op=%p %pS\n", op, op);
60054104d326SSteven Rostedt (Red Hat) 				goto out;
60064104d326SSteven Rostedt (Red Hat) 			}
6007a1e2e31dSSteven Rostedt 			op->func(ip, parent_ip, op, regs);
60084104d326SSteven Rostedt (Red Hat) 		}
60090a016409SSteven Rostedt 	} while_for_each_ftrace_op(op);
60104104d326SSteven Rostedt (Red Hat) out:
6011cdbe61bfSSteven Rostedt 	preempt_enable_notrace();
6012edc15cafSSteven Rostedt 	trace_clear_recursion(bit);
6013b848914cSSteven Rostedt }
6014b848914cSSteven Rostedt 
60152f5f6ad9SSteven Rostedt /*
60162f5f6ad9SSteven Rostedt  * Some archs only support passing ip and parent_ip. Even though
60172f5f6ad9SSteven Rostedt  * the list function ignores the op parameter, we do not want any
60182f5f6ad9SSteven Rostedt  * C side effects, where a function is called without the caller
60192f5f6ad9SSteven Rostedt  * sending a third parameter.
6020a1e2e31dSSteven Rostedt  * Archs are to support both the regs and ftrace_ops at the same time.
6021a1e2e31dSSteven Rostedt  * If they support ftrace_ops, it is assumed they support regs.
6022a1e2e31dSSteven Rostedt  * If call backs want to use regs, they must either check for regs
602306aeaaeaSMasami Hiramatsu  * being NULL, or CONFIG_DYNAMIC_FTRACE_WITH_REGS.
602406aeaaeaSMasami Hiramatsu  * Note, CONFIG_DYNAMIC_FTRACE_WITH_REGS expects a full regs to be saved.
6025a1e2e31dSSteven Rostedt  * An architecture can pass partial regs with ftrace_ops and still
6026b8ec330aSLi Bin  * set the ARCH_SUPPORTS_FTRACE_OPS.
60272f5f6ad9SSteven Rostedt  */
60282f5f6ad9SSteven Rostedt #if ARCH_SUPPORTS_FTRACE_OPS
60292f5f6ad9SSteven Rostedt static void ftrace_ops_list_func(unsigned long ip, unsigned long parent_ip,
6030a1e2e31dSSteven Rostedt 				 struct ftrace_ops *op, struct pt_regs *regs)
60312f5f6ad9SSteven Rostedt {
6032a1e2e31dSSteven Rostedt 	__ftrace_ops_list_func(ip, parent_ip, NULL, regs);
60332f5f6ad9SSteven Rostedt }
60342f5f6ad9SSteven Rostedt #else
60352f5f6ad9SSteven Rostedt static void ftrace_ops_no_ops(unsigned long ip, unsigned long parent_ip)
60362f5f6ad9SSteven Rostedt {
6037a1e2e31dSSteven Rostedt 	__ftrace_ops_list_func(ip, parent_ip, NULL, NULL);
60382f5f6ad9SSteven Rostedt }
60392f5f6ad9SSteven Rostedt #endif
60402f5f6ad9SSteven Rostedt 
6041f1ff6348SSteven Rostedt (Red Hat) /*
6042f1ff6348SSteven Rostedt (Red Hat)  * If there's only one function registered but it does not support
6043c68c0fa2SSteven Rostedt (Red Hat)  * recursion, needs RCU protection and/or requires per cpu handling, then
6044c68c0fa2SSteven Rostedt (Red Hat)  * this function will be called by the mcount trampoline.
6045f1ff6348SSteven Rostedt (Red Hat)  */
6046c68c0fa2SSteven Rostedt (Red Hat) static void ftrace_ops_assist_func(unsigned long ip, unsigned long parent_ip,
6047f1ff6348SSteven Rostedt (Red Hat) 				   struct ftrace_ops *op, struct pt_regs *regs)
6048f1ff6348SSteven Rostedt (Red Hat) {
6049f1ff6348SSteven Rostedt (Red Hat) 	int bit;
6050f1ff6348SSteven Rostedt (Red Hat) 
6051c68c0fa2SSteven Rostedt (Red Hat) 	if ((op->flags & FTRACE_OPS_FL_RCU) && !rcu_is_watching())
6052c68c0fa2SSteven Rostedt (Red Hat) 		return;
6053c68c0fa2SSteven Rostedt (Red Hat) 
6054f1ff6348SSteven Rostedt (Red Hat) 	bit = trace_test_and_set_recursion(TRACE_LIST_START, TRACE_LIST_MAX);
6055f1ff6348SSteven Rostedt (Red Hat) 	if (bit < 0)
6056f1ff6348SSteven Rostedt (Red Hat) 		return;
6057f1ff6348SSteven Rostedt (Red Hat) 
6058c68c0fa2SSteven Rostedt (Red Hat) 	preempt_disable_notrace();
6059f1ff6348SSteven Rostedt (Red Hat) 
6060c68c0fa2SSteven Rostedt (Red Hat) 	if (!(op->flags & FTRACE_OPS_FL_PER_CPU) ||
6061c68c0fa2SSteven Rostedt (Red Hat) 	    !ftrace_function_local_disabled(op)) {
6062c68c0fa2SSteven Rostedt (Red Hat) 		op->func(ip, parent_ip, op, regs);
6063c68c0fa2SSteven Rostedt (Red Hat) 	}
6064c68c0fa2SSteven Rostedt (Red Hat) 
6065c68c0fa2SSteven Rostedt (Red Hat) 	preempt_enable_notrace();
6066f1ff6348SSteven Rostedt (Red Hat) 	trace_clear_recursion(bit);
6067f1ff6348SSteven Rostedt (Red Hat) }
6068f1ff6348SSteven Rostedt (Red Hat) 
606987354059SSteven Rostedt (Red Hat) /**
607087354059SSteven Rostedt (Red Hat)  * ftrace_ops_get_func - get the function a trampoline should call
607187354059SSteven Rostedt (Red Hat)  * @ops: the ops to get the function for
607287354059SSteven Rostedt (Red Hat)  *
607387354059SSteven Rostedt (Red Hat)  * Normally the mcount trampoline will call the ops->func, but there
607487354059SSteven Rostedt (Red Hat)  * are times that it should not. For example, if the ops does not
607587354059SSteven Rostedt (Red Hat)  * have its own recursion protection, then it should call the
60763a150df9SChunyu Hu  * ftrace_ops_assist_func() instead.
607787354059SSteven Rostedt (Red Hat)  *
607887354059SSteven Rostedt (Red Hat)  * Returns the function that the trampoline should call for @ops.
607987354059SSteven Rostedt (Red Hat)  */
608087354059SSteven Rostedt (Red Hat) ftrace_func_t ftrace_ops_get_func(struct ftrace_ops *ops)
608187354059SSteven Rostedt (Red Hat) {
608287354059SSteven Rostedt (Red Hat) 	/*
6083c68c0fa2SSteven Rostedt (Red Hat) 	 * If the function does not handle recursion, needs to be RCU safe,
6084c68c0fa2SSteven Rostedt (Red Hat) 	 * or does per cpu logic, then we need to call the assist handler.
608587354059SSteven Rostedt (Red Hat) 	 */
6086c68c0fa2SSteven Rostedt (Red Hat) 	if (!(ops->flags & FTRACE_OPS_FL_RECURSION_SAFE) ||
6087c68c0fa2SSteven Rostedt (Red Hat) 	    ops->flags & (FTRACE_OPS_FL_RCU | FTRACE_OPS_FL_PER_CPU))
6088c68c0fa2SSteven Rostedt (Red Hat) 		return ftrace_ops_assist_func;
608987354059SSteven Rostedt (Red Hat) 
609087354059SSteven Rostedt (Red Hat) 	return ops->func;
609187354059SSteven Rostedt (Red Hat) }
609287354059SSteven Rostedt (Red Hat) 
6093345ddcc8SSteven Rostedt (Red Hat) static void
6094345ddcc8SSteven Rostedt (Red Hat) ftrace_filter_pid_sched_switch_probe(void *data, bool preempt,
6095345ddcc8SSteven Rostedt (Red Hat) 		    struct task_struct *prev, struct task_struct *next)
6096e32d8956SSteven Rostedt {
6097345ddcc8SSteven Rostedt (Red Hat) 	struct trace_array *tr = data;
6098345ddcc8SSteven Rostedt (Red Hat) 	struct trace_pid_list *pid_list;
6099345ddcc8SSteven Rostedt (Red Hat) 
6100345ddcc8SSteven Rostedt (Red Hat) 	pid_list = rcu_dereference_sched(tr->function_pids);
6101345ddcc8SSteven Rostedt (Red Hat) 
6102345ddcc8SSteven Rostedt (Red Hat) 	this_cpu_write(tr->trace_buffer.data->ftrace_ignore_pid,
6103345ddcc8SSteven Rostedt (Red Hat) 		       trace_ignore_this_task(pid_list, next));
6104345ddcc8SSteven Rostedt (Red Hat) }
6105345ddcc8SSteven Rostedt (Red Hat) 
61061e10486fSNamhyung Kim static void
61071e10486fSNamhyung Kim ftrace_pid_follow_sched_process_fork(void *data,
61081e10486fSNamhyung Kim 				     struct task_struct *self,
61091e10486fSNamhyung Kim 				     struct task_struct *task)
61101e10486fSNamhyung Kim {
61111e10486fSNamhyung Kim 	struct trace_pid_list *pid_list;
61121e10486fSNamhyung Kim 	struct trace_array *tr = data;
61131e10486fSNamhyung Kim 
61141e10486fSNamhyung Kim 	pid_list = rcu_dereference_sched(tr->function_pids);
61151e10486fSNamhyung Kim 	trace_filter_add_remove_task(pid_list, self, task);
61161e10486fSNamhyung Kim }
61171e10486fSNamhyung Kim 
61181e10486fSNamhyung Kim static void
61191e10486fSNamhyung Kim ftrace_pid_follow_sched_process_exit(void *data, struct task_struct *task)
61201e10486fSNamhyung Kim {
61211e10486fSNamhyung Kim 	struct trace_pid_list *pid_list;
61221e10486fSNamhyung Kim 	struct trace_array *tr = data;
61231e10486fSNamhyung Kim 
61241e10486fSNamhyung Kim 	pid_list = rcu_dereference_sched(tr->function_pids);
61251e10486fSNamhyung Kim 	trace_filter_add_remove_task(pid_list, NULL, task);
61261e10486fSNamhyung Kim }
61271e10486fSNamhyung Kim 
61281e10486fSNamhyung Kim void ftrace_pid_follow_fork(struct trace_array *tr, bool enable)
61291e10486fSNamhyung Kim {
61301e10486fSNamhyung Kim 	if (enable) {
61311e10486fSNamhyung Kim 		register_trace_sched_process_fork(ftrace_pid_follow_sched_process_fork,
61321e10486fSNamhyung Kim 						  tr);
61331e10486fSNamhyung Kim 		register_trace_sched_process_exit(ftrace_pid_follow_sched_process_exit,
61341e10486fSNamhyung Kim 						  tr);
61351e10486fSNamhyung Kim 	} else {
61361e10486fSNamhyung Kim 		unregister_trace_sched_process_fork(ftrace_pid_follow_sched_process_fork,
61371e10486fSNamhyung Kim 						    tr);
61381e10486fSNamhyung Kim 		unregister_trace_sched_process_exit(ftrace_pid_follow_sched_process_exit,
61391e10486fSNamhyung Kim 						    tr);
61401e10486fSNamhyung Kim 	}
61411e10486fSNamhyung Kim }
61421e10486fSNamhyung Kim 
6143345ddcc8SSteven Rostedt (Red Hat) static void clear_ftrace_pids(struct trace_array *tr)
6144345ddcc8SSteven Rostedt (Red Hat) {
6145345ddcc8SSteven Rostedt (Red Hat) 	struct trace_pid_list *pid_list;
6146e32d8956SSteven Rostedt 	int cpu;
6147e32d8956SSteven Rostedt 
6148345ddcc8SSteven Rostedt (Red Hat) 	pid_list = rcu_dereference_protected(tr->function_pids,
6149345ddcc8SSteven Rostedt (Red Hat) 					     lockdep_is_held(&ftrace_lock));
6150345ddcc8SSteven Rostedt (Red Hat) 	if (!pid_list)
6151345ddcc8SSteven Rostedt (Red Hat) 		return;
6152345ddcc8SSteven Rostedt (Red Hat) 
6153345ddcc8SSteven Rostedt (Red Hat) 	unregister_trace_sched_switch(ftrace_filter_pid_sched_switch_probe, tr);
6154345ddcc8SSteven Rostedt (Red Hat) 
6155345ddcc8SSteven Rostedt (Red Hat) 	for_each_possible_cpu(cpu)
6156345ddcc8SSteven Rostedt (Red Hat) 		per_cpu_ptr(tr->trace_buffer.data, cpu)->ftrace_ignore_pid = false;
6157345ddcc8SSteven Rostedt (Red Hat) 
6158345ddcc8SSteven Rostedt (Red Hat) 	rcu_assign_pointer(tr->function_pids, NULL);
6159345ddcc8SSteven Rostedt (Red Hat) 
6160345ddcc8SSteven Rostedt (Red Hat) 	/* Wait till all users are no longer using pid filtering */
6161345ddcc8SSteven Rostedt (Red Hat) 	synchronize_sched();
6162345ddcc8SSteven Rostedt (Red Hat) 
6163345ddcc8SSteven Rostedt (Red Hat) 	trace_free_pid_list(pid_list);
6164e32d8956SSteven Rostedt }
6165e32d8956SSteven Rostedt 
6166d879d0b8SNamhyung Kim void ftrace_clear_pids(struct trace_array *tr)
6167d879d0b8SNamhyung Kim {
6168d879d0b8SNamhyung Kim 	mutex_lock(&ftrace_lock);
6169d879d0b8SNamhyung Kim 
6170d879d0b8SNamhyung Kim 	clear_ftrace_pids(tr);
6171d879d0b8SNamhyung Kim 
6172d879d0b8SNamhyung Kim 	mutex_unlock(&ftrace_lock);
6173d879d0b8SNamhyung Kim }
6174d879d0b8SNamhyung Kim 
6175345ddcc8SSteven Rostedt (Red Hat) static void ftrace_pid_reset(struct trace_array *tr)
6176e32d8956SSteven Rostedt {
6177756d17eeS[email protected] 	mutex_lock(&ftrace_lock);
6178345ddcc8SSteven Rostedt (Red Hat) 	clear_ftrace_pids(tr);
6179756d17eeS[email protected] 
6180756d17eeS[email protected] 	ftrace_update_pid_func();
6181e1effa01SSteven Rostedt (Red Hat) 	ftrace_startup_all(0);
6182756d17eeS[email protected] 
6183756d17eeS[email protected] 	mutex_unlock(&ftrace_lock);
6184756d17eeS[email protected] }
6185756d17eeS[email protected] 
6186345ddcc8SSteven Rostedt (Red Hat) /* Greater than any max PID */
6187345ddcc8SSteven Rostedt (Red Hat) #define FTRACE_NO_PIDS		(void *)(PID_MAX_LIMIT + 1)
6188345ddcc8SSteven Rostedt (Red Hat) 
6189756d17eeS[email protected] static void *fpid_start(struct seq_file *m, loff_t *pos)
6190345ddcc8SSteven Rostedt (Red Hat) 	__acquires(RCU)
6191756d17eeS[email protected] {
6192345ddcc8SSteven Rostedt (Red Hat) 	struct trace_pid_list *pid_list;
6193345ddcc8SSteven Rostedt (Red Hat) 	struct trace_array *tr = m->private;
6194345ddcc8SSteven Rostedt (Red Hat) 
6195756d17eeS[email protected] 	mutex_lock(&ftrace_lock);
6196345ddcc8SSteven Rostedt (Red Hat) 	rcu_read_lock_sched();
6197756d17eeS[email protected] 
6198345ddcc8SSteven Rostedt (Red Hat) 	pid_list = rcu_dereference_sched(tr->function_pids);
6199756d17eeS[email protected] 
6200345ddcc8SSteven Rostedt (Red Hat) 	if (!pid_list)
6201345ddcc8SSteven Rostedt (Red Hat) 		return !(*pos) ? FTRACE_NO_PIDS : NULL;
6202345ddcc8SSteven Rostedt (Red Hat) 
6203345ddcc8SSteven Rostedt (Red Hat) 	return trace_pid_start(pid_list, pos);
6204756d17eeS[email protected] }
6205756d17eeS[email protected] 
6206756d17eeS[email protected] static void *fpid_next(struct seq_file *m, void *v, loff_t *pos)
6207756d17eeS[email protected] {
6208345ddcc8SSteven Rostedt (Red Hat) 	struct trace_array *tr = m->private;
6209345ddcc8SSteven Rostedt (Red Hat) 	struct trace_pid_list *pid_list = rcu_dereference_sched(tr->function_pids);
6210345ddcc8SSteven Rostedt (Red Hat) 
6211345ddcc8SSteven Rostedt (Red Hat) 	if (v == FTRACE_NO_PIDS)
6212756d17eeS[email protected] 		return NULL;
6213756d17eeS[email protected] 
6214345ddcc8SSteven Rostedt (Red Hat) 	return trace_pid_next(pid_list, v, pos);
6215756d17eeS[email protected] }
6216756d17eeS[email protected] 
6217756d17eeS[email protected] static void fpid_stop(struct seq_file *m, void *p)
6218345ddcc8SSteven Rostedt (Red Hat) 	__releases(RCU)
6219756d17eeS[email protected] {
6220345ddcc8SSteven Rostedt (Red Hat) 	rcu_read_unlock_sched();
6221756d17eeS[email protected] 	mutex_unlock(&ftrace_lock);
6222756d17eeS[email protected] }
6223756d17eeS[email protected] 
6224756d17eeS[email protected] static int fpid_show(struct seq_file *m, void *v)
6225756d17eeS[email protected] {
6226345ddcc8SSteven Rostedt (Red Hat) 	if (v == FTRACE_NO_PIDS) {
6227fa6f0cc7SRasmus Villemoes 		seq_puts(m, "no pid\n");
6228756d17eeS[email protected] 		return 0;
6229756d17eeS[email protected] 	}
6230756d17eeS[email protected] 
6231345ddcc8SSteven Rostedt (Red Hat) 	return trace_pid_show(m, v);
6232756d17eeS[email protected] }
6233756d17eeS[email protected] 
6234756d17eeS[email protected] static const struct seq_operations ftrace_pid_sops = {
6235756d17eeS[email protected] 	.start = fpid_start,
6236756d17eeS[email protected] 	.next = fpid_next,
6237756d17eeS[email protected] 	.stop = fpid_stop,
6238756d17eeS[email protected] 	.show = fpid_show,
6239756d17eeS[email protected] };
6240756d17eeS[email protected] 
6241756d17eeS[email protected] static int
6242756d17eeS[email protected] ftrace_pid_open(struct inode *inode, struct file *file)
6243756d17eeS[email protected] {
6244345ddcc8SSteven Rostedt (Red Hat) 	struct trace_array *tr = inode->i_private;
6245345ddcc8SSteven Rostedt (Red Hat) 	struct seq_file *m;
6246756d17eeS[email protected] 	int ret = 0;
6247756d17eeS[email protected] 
6248345ddcc8SSteven Rostedt (Red Hat) 	if (trace_array_get(tr) < 0)
6249345ddcc8SSteven Rostedt (Red Hat) 		return -ENODEV;
6250345ddcc8SSteven Rostedt (Red Hat) 
6251756d17eeS[email protected] 	if ((file->f_mode & FMODE_WRITE) &&
6252756d17eeS[email protected] 	    (file->f_flags & O_TRUNC))
6253345ddcc8SSteven Rostedt (Red Hat) 		ftrace_pid_reset(tr);
6254756d17eeS[email protected] 
6255756d17eeS[email protected] 	ret = seq_open(file, &ftrace_pid_sops);
6256345ddcc8SSteven Rostedt (Red Hat) 	if (ret < 0) {
6257345ddcc8SSteven Rostedt (Red Hat) 		trace_array_put(tr);
6258345ddcc8SSteven Rostedt (Red Hat) 	} else {
6259345ddcc8SSteven Rostedt (Red Hat) 		m = file->private_data;
6260345ddcc8SSteven Rostedt (Red Hat) 		/* copy tr over to seq ops */
6261345ddcc8SSteven Rostedt (Red Hat) 		m->private = tr;
6262345ddcc8SSteven Rostedt (Red Hat) 	}
6263756d17eeS[email protected] 
6264756d17eeS[email protected] 	return ret;
6265756d17eeS[email protected] }
6266756d17eeS[email protected] 
6267345ddcc8SSteven Rostedt (Red Hat) static void ignore_task_cpu(void *data)
6268345ddcc8SSteven Rostedt (Red Hat) {
6269345ddcc8SSteven Rostedt (Red Hat) 	struct trace_array *tr = data;
6270345ddcc8SSteven Rostedt (Red Hat) 	struct trace_pid_list *pid_list;
6271345ddcc8SSteven Rostedt (Red Hat) 
6272345ddcc8SSteven Rostedt (Red Hat) 	/*
6273345ddcc8SSteven Rostedt (Red Hat) 	 * This function is called by on_each_cpu() while the
6274345ddcc8SSteven Rostedt (Red Hat) 	 * event_mutex is held.
6275345ddcc8SSteven Rostedt (Red Hat) 	 */
6276345ddcc8SSteven Rostedt (Red Hat) 	pid_list = rcu_dereference_protected(tr->function_pids,
6277345ddcc8SSteven Rostedt (Red Hat) 					     mutex_is_locked(&ftrace_lock));
6278345ddcc8SSteven Rostedt (Red Hat) 
6279345ddcc8SSteven Rostedt (Red Hat) 	this_cpu_write(tr->trace_buffer.data->ftrace_ignore_pid,
6280345ddcc8SSteven Rostedt (Red Hat) 		       trace_ignore_this_task(pid_list, current));
6281345ddcc8SSteven Rostedt (Red Hat) }
6282345ddcc8SSteven Rostedt (Red Hat) 
6283df4fc315SSteven Rostedt static ssize_t
6284df4fc315SSteven Rostedt ftrace_pid_write(struct file *filp, const char __user *ubuf,
6285df4fc315SSteven Rostedt 		   size_t cnt, loff_t *ppos)
6286df4fc315SSteven Rostedt {
6287345ddcc8SSteven Rostedt (Red Hat) 	struct seq_file *m = filp->private_data;
6288345ddcc8SSteven Rostedt (Red Hat) 	struct trace_array *tr = m->private;
6289345ddcc8SSteven Rostedt (Red Hat) 	struct trace_pid_list *filtered_pids = NULL;
6290345ddcc8SSteven Rostedt (Red Hat) 	struct trace_pid_list *pid_list;
6291345ddcc8SSteven Rostedt (Red Hat) 	ssize_t ret;
6292df4fc315SSteven Rostedt 
6293345ddcc8SSteven Rostedt (Red Hat) 	if (!cnt)
6294345ddcc8SSteven Rostedt (Red Hat) 		return 0;
6295df4fc315SSteven Rostedt 
6296345ddcc8SSteven Rostedt (Red Hat) 	mutex_lock(&ftrace_lock);
6297df4fc315SSteven Rostedt 
6298345ddcc8SSteven Rostedt (Red Hat) 	filtered_pids = rcu_dereference_protected(tr->function_pids,
6299345ddcc8SSteven Rostedt (Red Hat) 					     lockdep_is_held(&ftrace_lock));
6300345ddcc8SSteven Rostedt (Red Hat) 
6301345ddcc8SSteven Rostedt (Red Hat) 	ret = trace_pid_write(filtered_pids, &pid_list, ubuf, cnt);
6302345ddcc8SSteven Rostedt (Red Hat) 	if (ret < 0)
6303345ddcc8SSteven Rostedt (Red Hat) 		goto out;
6304345ddcc8SSteven Rostedt (Red Hat) 
6305345ddcc8SSteven Rostedt (Red Hat) 	rcu_assign_pointer(tr->function_pids, pid_list);
6306345ddcc8SSteven Rostedt (Red Hat) 
6307345ddcc8SSteven Rostedt (Red Hat) 	if (filtered_pids) {
6308345ddcc8SSteven Rostedt (Red Hat) 		synchronize_sched();
6309345ddcc8SSteven Rostedt (Red Hat) 		trace_free_pid_list(filtered_pids);
6310345ddcc8SSteven Rostedt (Red Hat) 	} else if (pid_list) {
6311345ddcc8SSteven Rostedt (Red Hat) 		/* Register a probe to set whether to ignore the tracing of a task */
6312345ddcc8SSteven Rostedt (Red Hat) 		register_trace_sched_switch(ftrace_filter_pid_sched_switch_probe, tr);
6313345ddcc8SSteven Rostedt (Red Hat) 	}
6314df4fc315SSteven Rostedt 
6315756d17eeS[email protected] 	/*
6316345ddcc8SSteven Rostedt (Red Hat) 	 * Ignoring of pids is done at task switch. But we have to
6317345ddcc8SSteven Rostedt (Red Hat) 	 * check for those tasks that are currently running.
6318345ddcc8SSteven Rostedt (Red Hat) 	 * Always do this in case a pid was appended or removed.
6319756d17eeS[email protected] 	 */
6320345ddcc8SSteven Rostedt (Red Hat) 	on_each_cpu(ignore_task_cpu, tr, 1);
6321756d17eeS[email protected] 
6322345ddcc8SSteven Rostedt (Red Hat) 	ftrace_update_pid_func();
6323345ddcc8SSteven Rostedt (Red Hat) 	ftrace_startup_all(0);
6324345ddcc8SSteven Rostedt (Red Hat)  out:
6325345ddcc8SSteven Rostedt (Red Hat) 	mutex_unlock(&ftrace_lock);
6326345ddcc8SSteven Rostedt (Red Hat) 
6327345ddcc8SSteven Rostedt (Red Hat) 	if (ret > 0)
6328345ddcc8SSteven Rostedt (Red Hat) 		*ppos += ret;
6329345ddcc8SSteven Rostedt (Red Hat) 
6330df4fc315SSteven Rostedt 	return ret;
6331e32d8956SSteven Rostedt }
6332978f3a45SSteven Rostedt 
6333756d17eeS[email protected] static int
6334756d17eeS[email protected] ftrace_pid_release(struct inode *inode, struct file *file)
6335756d17eeS[email protected] {
6336345ddcc8SSteven Rostedt (Red Hat) 	struct trace_array *tr = inode->i_private;
6337978f3a45SSteven Rostedt 
6338345ddcc8SSteven Rostedt (Red Hat) 	trace_array_put(tr);
6339345ddcc8SSteven Rostedt (Red Hat) 
6340345ddcc8SSteven Rostedt (Red Hat) 	return seq_release(inode, file);
6341df4fc315SSteven Rostedt }
6342df4fc315SSteven Rostedt 
63435e2336a0SSteven Rostedt static const struct file_operations ftrace_pid_fops = {
6344756d17eeS[email protected] 	.open		= ftrace_pid_open,
6345df4fc315SSteven Rostedt 	.write		= ftrace_pid_write,
6346756d17eeS[email protected] 	.read		= seq_read,
6347098c879eSSteven Rostedt (Red Hat) 	.llseek		= tracing_lseek,
6348756d17eeS[email protected] 	.release	= ftrace_pid_release,
6349df4fc315SSteven Rostedt };
6350df4fc315SSteven Rostedt 
6351345ddcc8SSteven Rostedt (Red Hat) void ftrace_init_tracefs(struct trace_array *tr, struct dentry *d_tracer)
6352df4fc315SSteven Rostedt {
63535452af66SFrederic Weisbecker 	trace_create_file("set_ftrace_pid", 0644, d_tracer,
6354345ddcc8SSteven Rostedt (Red Hat) 			    tr, &ftrace_pid_fops);
6355df4fc315SSteven Rostedt }
6356df4fc315SSteven Rostedt 
6357501c2375SSteven Rostedt (Red Hat) void __init ftrace_init_tracefs_toplevel(struct trace_array *tr,
6358501c2375SSteven Rostedt (Red Hat) 					 struct dentry *d_tracer)
6359501c2375SSteven Rostedt (Red Hat) {
6360501c2375SSteven Rostedt (Red Hat) 	/* Only the top level directory has the dyn_tracefs and profile */
6361501c2375SSteven Rostedt (Red Hat) 	WARN_ON(!(tr->flags & TRACE_ARRAY_FL_GLOBAL));
6362501c2375SSteven Rostedt (Red Hat) 
6363501c2375SSteven Rostedt (Red Hat) 	ftrace_init_dyn_tracefs(d_tracer);
6364501c2375SSteven Rostedt (Red Hat) 	ftrace_profile_tracefs(d_tracer);
6365501c2375SSteven Rostedt (Red Hat) }
6366501c2375SSteven Rostedt (Red Hat) 
63673d083395SSteven Rostedt /**
636881adbdc0SSteven Rostedt  * ftrace_kill - kill ftrace
6369a2bb6a3dSSteven Rostedt  *
6370a2bb6a3dSSteven Rostedt  * This function should be used by panic code. It stops ftrace
6371a2bb6a3dSSteven Rostedt  * but in a not so nice way. If you need to simply kill ftrace
6372a2bb6a3dSSteven Rostedt  * from a non-atomic section, use ftrace_kill.
6373a2bb6a3dSSteven Rostedt  */
637481adbdc0SSteven Rostedt void ftrace_kill(void)
6375a2bb6a3dSSteven Rostedt {
6376a2bb6a3dSSteven Rostedt 	ftrace_disabled = 1;
6377a2bb6a3dSSteven Rostedt 	ftrace_enabled = 0;
6378a2bb6a3dSSteven Rostedt 	clear_ftrace_function();
6379a2bb6a3dSSteven Rostedt }
6380a2bb6a3dSSteven Rostedt 
6381a2bb6a3dSSteven Rostedt /**
6382e0a413f6SSteven Rostedt  * Test if ftrace is dead or not.
6383e0a413f6SSteven Rostedt  */
6384e0a413f6SSteven Rostedt int ftrace_is_dead(void)
6385e0a413f6SSteven Rostedt {
6386e0a413f6SSteven Rostedt 	return ftrace_disabled;
6387e0a413f6SSteven Rostedt }
6388e0a413f6SSteven Rostedt 
6389e0a413f6SSteven Rostedt /**
63903d083395SSteven Rostedt  * register_ftrace_function - register a function for profiling
63913d083395SSteven Rostedt  * @ops - ops structure that holds the function for profiling.
63923d083395SSteven Rostedt  *
63933d083395SSteven Rostedt  * Register a function to be called by all functions in the
63943d083395SSteven Rostedt  * kernel.
63953d083395SSteven Rostedt  *
63963d083395SSteven Rostedt  * Note: @ops->func and all the functions it calls must be labeled
63973d083395SSteven Rostedt  *       with "notrace", otherwise it will go into a
63983d083395SSteven Rostedt  *       recursive loop.
63993d083395SSteven Rostedt  */
64003d083395SSteven Rostedt int register_ftrace_function(struct ftrace_ops *ops)
64013d083395SSteven Rostedt {
640245a4a237SSteven Rostedt 	int ret = -1;
64034eebcc81SSteven Rostedt 
6404f04f24fbSMasami Hiramatsu 	ftrace_ops_init(ops);
6405f04f24fbSMasami Hiramatsu 
6406e6ea44e9SSteven Rostedt 	mutex_lock(&ftrace_lock);
6407e7d3737eSFrederic Weisbecker 
6408a1cd6173SSteven Rostedt 	ret = ftrace_startup(ops, 0);
6409b848914cSSteven Rostedt 
6410e6ea44e9SSteven Rostedt 	mutex_unlock(&ftrace_lock);
64118d240dd8SBorislav Petkov 
6412b0fc494fSSteven Rostedt 	return ret;
64133d083395SSteven Rostedt }
6414cdbe61bfSSteven Rostedt EXPORT_SYMBOL_GPL(register_ftrace_function);
64153d083395SSteven Rostedt 
64163d083395SSteven Rostedt /**
641732632920SUwe Kleine-Koenig  * unregister_ftrace_function - unregister a function for profiling.
64183d083395SSteven Rostedt  * @ops - ops structure that holds the function to unregister
64193d083395SSteven Rostedt  *
64203d083395SSteven Rostedt  * Unregister a function that was added to be called by ftrace profiling.
64213d083395SSteven Rostedt  */
64223d083395SSteven Rostedt int unregister_ftrace_function(struct ftrace_ops *ops)
64233d083395SSteven Rostedt {
64243d083395SSteven Rostedt 	int ret;
64253d083395SSteven Rostedt 
6426e6ea44e9SSteven Rostedt 	mutex_lock(&ftrace_lock);
64278a56d776SSteven Rostedt (Red Hat) 	ret = ftrace_shutdown(ops, 0);
6428e6ea44e9SSteven Rostedt 	mutex_unlock(&ftrace_lock);
6429b0fc494fSSteven Rostedt 
6430b0fc494fSSteven Rostedt 	return ret;
6431b0fc494fSSteven Rostedt }
6432cdbe61bfSSteven Rostedt EXPORT_SYMBOL_GPL(unregister_ftrace_function);
6433b0fc494fSSteven Rostedt 
6434e309b41dSIngo Molnar int
6435b0fc494fSSteven Rostedt ftrace_enable_sysctl(struct ctl_table *table, int write,
64368d65af78SAlexey Dobriyan 		     void __user *buffer, size_t *lenp,
6437b0fc494fSSteven Rostedt 		     loff_t *ppos)
6438b0fc494fSSteven Rostedt {
643945a4a237SSteven Rostedt 	int ret = -ENODEV;
64404eebcc81SSteven Rostedt 
6441e6ea44e9SSteven Rostedt 	mutex_lock(&ftrace_lock);
6442b0fc494fSSteven Rostedt 
644345a4a237SSteven Rostedt 	if (unlikely(ftrace_disabled))
644445a4a237SSteven Rostedt 		goto out;
644545a4a237SSteven Rostedt 
64468d65af78SAlexey Dobriyan 	ret = proc_dointvec(table, write, buffer, lenp, ppos);
6447b0fc494fSSteven Rostedt 
6448a32c7765SLi Zefan 	if (ret || !write || (last_ftrace_enabled == !!ftrace_enabled))
6449b0fc494fSSteven Rostedt 		goto out;
6450b0fc494fSSteven Rostedt 
6451a32c7765SLi Zefan 	last_ftrace_enabled = !!ftrace_enabled;
6452b0fc494fSSteven Rostedt 
6453b0fc494fSSteven Rostedt 	if (ftrace_enabled) {
6454b0fc494fSSteven Rostedt 
6455b0fc494fSSteven Rostedt 		/* we are starting ftrace again */
64565000c418SJan Kiszka 		if (ftrace_ops_list != &ftrace_list_end)
64575000c418SJan Kiszka 			update_ftrace_function();
6458b0fc494fSSteven Rostedt 
6459524a3868SSteven Rostedt (Red Hat) 		ftrace_startup_sysctl();
6460524a3868SSteven Rostedt (Red Hat) 
6461b0fc494fSSteven Rostedt 	} else {
6462b0fc494fSSteven Rostedt 		/* stopping ftrace calls (just send to ftrace_stub) */
6463b0fc494fSSteven Rostedt 		ftrace_trace_function = ftrace_stub;
6464b0fc494fSSteven Rostedt 
6465b0fc494fSSteven Rostedt 		ftrace_shutdown_sysctl();
6466b0fc494fSSteven Rostedt 	}
6467b0fc494fSSteven Rostedt 
6468b0fc494fSSteven Rostedt  out:
6469e6ea44e9SSteven Rostedt 	mutex_unlock(&ftrace_lock);
64703d083395SSteven Rostedt 	return ret;
647116444a8aSArnaldo Carvalho de Melo }
6472f17845e5SIngo Molnar 
6473fb52607aSFrederic Weisbecker #ifdef CONFIG_FUNCTION_GRAPH_TRACER
6474e7d3737eSFrederic Weisbecker 
64755f151b24SSteven Rostedt (Red Hat) static struct ftrace_ops graph_ops = {
64765f151b24SSteven Rostedt (Red Hat) 	.func			= ftrace_stub,
64775f151b24SSteven Rostedt (Red Hat) 	.flags			= FTRACE_OPS_FL_RECURSION_SAFE |
64785f151b24SSteven Rostedt (Red Hat) 				   FTRACE_OPS_FL_INITIALIZED |
6479e3eea140SSteven Rostedt (Red Hat) 				   FTRACE_OPS_FL_PID |
64805f151b24SSteven Rostedt (Red Hat) 				   FTRACE_OPS_FL_STUB,
64815f151b24SSteven Rostedt (Red Hat) #ifdef FTRACE_GRAPH_TRAMP_ADDR
64825f151b24SSteven Rostedt (Red Hat) 	.trampoline		= FTRACE_GRAPH_TRAMP_ADDR,
6483aec0be2dSSteven Rostedt (Red Hat) 	/* trampoline_size is only needed for dynamically allocated tramps */
64845f151b24SSteven Rostedt (Red Hat) #endif
64855f151b24SSteven Rostedt (Red Hat) 	ASSIGN_OPS_HASH(graph_ops, &global_ops.local_hash)
64865f151b24SSteven Rostedt (Red Hat) };
64875f151b24SSteven Rostedt (Red Hat) 
648855577204SSteven Rostedt (Red Hat) void ftrace_graph_sleep_time_control(bool enable)
648955577204SSteven Rostedt (Red Hat) {
649055577204SSteven Rostedt (Red Hat) 	fgraph_sleep_time = enable;
649155577204SSteven Rostedt (Red Hat) }
649255577204SSteven Rostedt (Red Hat) 
649355577204SSteven Rostedt (Red Hat) void ftrace_graph_graph_time_control(bool enable)
649455577204SSteven Rostedt (Red Hat) {
649555577204SSteven Rostedt (Red Hat) 	fgraph_graph_time = enable;
649655577204SSteven Rostedt (Red Hat) }
649755577204SSteven Rostedt (Red Hat) 
6498e49dc19cSSteven Rostedt int ftrace_graph_entry_stub(struct ftrace_graph_ent *trace)
6499e49dc19cSSteven Rostedt {
6500e49dc19cSSteven Rostedt 	return 0;
6501e49dc19cSSteven Rostedt }
6502e49dc19cSSteven Rostedt 
6503287b6e68SFrederic Weisbecker /* The callbacks that hook a function */
6504287b6e68SFrederic Weisbecker trace_func_graph_ret_t ftrace_graph_return =
6505287b6e68SFrederic Weisbecker 			(trace_func_graph_ret_t)ftrace_stub;
6506e49dc19cSSteven Rostedt trace_func_graph_ent_t ftrace_graph_entry = ftrace_graph_entry_stub;
650723a8e844SSteven Rostedt (Red Hat) static trace_func_graph_ent_t __ftrace_graph_entry = ftrace_graph_entry_stub;
6508f201ae23SFrederic Weisbecker 
6509f201ae23SFrederic Weisbecker /* Try to assign a return stack array on FTRACE_RETSTACK_ALLOC_SIZE tasks. */
6510f201ae23SFrederic Weisbecker static int alloc_retstack_tasklist(struct ftrace_ret_stack **ret_stack_list)
6511f201ae23SFrederic Weisbecker {
6512f201ae23SFrederic Weisbecker 	int i;
6513f201ae23SFrederic Weisbecker 	int ret = 0;
6514f201ae23SFrederic Weisbecker 	int start = 0, end = FTRACE_RETSTACK_ALLOC_SIZE;
6515f201ae23SFrederic Weisbecker 	struct task_struct *g, *t;
6516f201ae23SFrederic Weisbecker 
6517f201ae23SFrederic Weisbecker 	for (i = 0; i < FTRACE_RETSTACK_ALLOC_SIZE; i++) {
6518f201ae23SFrederic Weisbecker 		ret_stack_list[i] = kmalloc(FTRACE_RETFUNC_DEPTH
6519f201ae23SFrederic Weisbecker 					* sizeof(struct ftrace_ret_stack),
6520f201ae23SFrederic Weisbecker 					GFP_KERNEL);
6521f201ae23SFrederic Weisbecker 		if (!ret_stack_list[i]) {
6522f201ae23SFrederic Weisbecker 			start = 0;
6523f201ae23SFrederic Weisbecker 			end = i;
6524f201ae23SFrederic Weisbecker 			ret = -ENOMEM;
6525f201ae23SFrederic Weisbecker 			goto free;
6526f201ae23SFrederic Weisbecker 		}
6527f201ae23SFrederic Weisbecker 	}
6528f201ae23SFrederic Weisbecker 
65296112a300SSoumya PN 	read_lock(&tasklist_lock);
6530f201ae23SFrederic Weisbecker 	do_each_thread(g, t) {
6531f201ae23SFrederic Weisbecker 		if (start == end) {
6532f201ae23SFrederic Weisbecker 			ret = -EAGAIN;
6533f201ae23SFrederic Weisbecker 			goto unlock;
6534f201ae23SFrederic Weisbecker 		}
6535f201ae23SFrederic Weisbecker 
6536f201ae23SFrederic Weisbecker 		if (t->ret_stack == NULL) {
6537380c4b14SFrederic Weisbecker 			atomic_set(&t->tracing_graph_pause, 0);
6538f201ae23SFrederic Weisbecker 			atomic_set(&t->trace_overrun, 0);
653926c01624SSteven Rostedt 			t->curr_ret_stack = -1;
654026c01624SSteven Rostedt 			/* Make sure the tasks see the -1 first: */
654126c01624SSteven Rostedt 			smp_wmb();
654226c01624SSteven Rostedt 			t->ret_stack = ret_stack_list[start++];
6543f201ae23SFrederic Weisbecker 		}
6544f201ae23SFrederic Weisbecker 	} while_each_thread(g, t);
6545f201ae23SFrederic Weisbecker 
6546f201ae23SFrederic Weisbecker unlock:
65476112a300SSoumya PN 	read_unlock(&tasklist_lock);
6548f201ae23SFrederic Weisbecker free:
6549f201ae23SFrederic Weisbecker 	for (i = start; i < end; i++)
6550f201ae23SFrederic Weisbecker 		kfree(ret_stack_list[i]);
6551f201ae23SFrederic Weisbecker 	return ret;
6552f201ae23SFrederic Weisbecker }
6553f201ae23SFrederic Weisbecker 
65548aef2d28SSteven Rostedt static void
6555c73464b1SPeter Zijlstra ftrace_graph_probe_sched_switch(void *ignore, bool preempt,
655638516ab5SSteven Rostedt 			struct task_struct *prev, struct task_struct *next)
65578aef2d28SSteven Rostedt {
65588aef2d28SSteven Rostedt 	unsigned long long timestamp;
65598aef2d28SSteven Rostedt 	int index;
65608aef2d28SSteven Rostedt 
6561be6f164aSSteven Rostedt 	/*
6562be6f164aSSteven Rostedt 	 * Does the user want to count the time a function was asleep.
6563be6f164aSSteven Rostedt 	 * If so, do not update the time stamps.
6564be6f164aSSteven Rostedt 	 */
656555577204SSteven Rostedt (Red Hat) 	if (fgraph_sleep_time)
6566be6f164aSSteven Rostedt 		return;
6567be6f164aSSteven Rostedt 
65688aef2d28SSteven Rostedt 	timestamp = trace_clock_local();
65698aef2d28SSteven Rostedt 
65708aef2d28SSteven Rostedt 	prev->ftrace_timestamp = timestamp;
65718aef2d28SSteven Rostedt 
65728aef2d28SSteven Rostedt 	/* only process tasks that we timestamped */
65738aef2d28SSteven Rostedt 	if (!next->ftrace_timestamp)
65748aef2d28SSteven Rostedt 		return;
65758aef2d28SSteven Rostedt 
65768aef2d28SSteven Rostedt 	/*
65778aef2d28SSteven Rostedt 	 * Update all the counters in next to make up for the
65788aef2d28SSteven Rostedt 	 * time next was sleeping.
65798aef2d28SSteven Rostedt 	 */
65808aef2d28SSteven Rostedt 	timestamp -= next->ftrace_timestamp;
65818aef2d28SSteven Rostedt 
65828aef2d28SSteven Rostedt 	for (index = next->curr_ret_stack; index >= 0; index--)
65838aef2d28SSteven Rostedt 		next->ret_stack[index].calltime += timestamp;
65848aef2d28SSteven Rostedt }
65858aef2d28SSteven Rostedt 
6586f201ae23SFrederic Weisbecker /* Allocate a return stack for each task */
6587fb52607aSFrederic Weisbecker static int start_graph_tracing(void)
6588f201ae23SFrederic Weisbecker {
6589f201ae23SFrederic Weisbecker 	struct ftrace_ret_stack **ret_stack_list;
65905b058bcdSFrederic Weisbecker 	int ret, cpu;
6591f201ae23SFrederic Weisbecker 
6592f201ae23SFrederic Weisbecker 	ret_stack_list = kmalloc(FTRACE_RETSTACK_ALLOC_SIZE *
6593f201ae23SFrederic Weisbecker 				sizeof(struct ftrace_ret_stack *),
6594f201ae23SFrederic Weisbecker 				GFP_KERNEL);
6595f201ae23SFrederic Weisbecker 
6596f201ae23SFrederic Weisbecker 	if (!ret_stack_list)
6597f201ae23SFrederic Weisbecker 		return -ENOMEM;
6598f201ae23SFrederic Weisbecker 
65995b058bcdSFrederic Weisbecker 	/* The cpu_boot init_task->ret_stack will never be freed */
6600179c498aSSteven Rostedt 	for_each_online_cpu(cpu) {
6601179c498aSSteven Rostedt 		if (!idle_task(cpu)->ret_stack)
6602868baf07SSteven Rostedt 			ftrace_graph_init_idle_task(idle_task(cpu), cpu);
6603179c498aSSteven Rostedt 	}
66045b058bcdSFrederic Weisbecker 
6605f201ae23SFrederic Weisbecker 	do {
6606f201ae23SFrederic Weisbecker 		ret = alloc_retstack_tasklist(ret_stack_list);
6607f201ae23SFrederic Weisbecker 	} while (ret == -EAGAIN);
6608f201ae23SFrederic Weisbecker 
66098aef2d28SSteven Rostedt 	if (!ret) {
661038516ab5SSteven Rostedt 		ret = register_trace_sched_switch(ftrace_graph_probe_sched_switch, NULL);
66118aef2d28SSteven Rostedt 		if (ret)
66128aef2d28SSteven Rostedt 			pr_info("ftrace_graph: Couldn't activate tracepoint"
66138aef2d28SSteven Rostedt 				" probe to kernel_sched_switch\n");
66148aef2d28SSteven Rostedt 	}
66158aef2d28SSteven Rostedt 
6616f201ae23SFrederic Weisbecker 	kfree(ret_stack_list);
6617f201ae23SFrederic Weisbecker 	return ret;
6618f201ae23SFrederic Weisbecker }
6619f201ae23SFrederic Weisbecker 
66204a2b8ddaSFrederic Weisbecker /*
66214a2b8ddaSFrederic Weisbecker  * Hibernation protection.
66224a2b8ddaSFrederic Weisbecker  * The state of the current task is too much unstable during
66234a2b8ddaSFrederic Weisbecker  * suspend/restore to disk. We want to protect against that.
66244a2b8ddaSFrederic Weisbecker  */
66254a2b8ddaSFrederic Weisbecker static int
66264a2b8ddaSFrederic Weisbecker ftrace_suspend_notifier_call(struct notifier_block *bl, unsigned long state,
66274a2b8ddaSFrederic Weisbecker 							void *unused)
66284a2b8ddaSFrederic Weisbecker {
66294a2b8ddaSFrederic Weisbecker 	switch (state) {
66304a2b8ddaSFrederic Weisbecker 	case PM_HIBERNATION_PREPARE:
66314a2b8ddaSFrederic Weisbecker 		pause_graph_tracing();
66324a2b8ddaSFrederic Weisbecker 		break;
66334a2b8ddaSFrederic Weisbecker 
66344a2b8ddaSFrederic Weisbecker 	case PM_POST_HIBERNATION:
66354a2b8ddaSFrederic Weisbecker 		unpause_graph_tracing();
66364a2b8ddaSFrederic Weisbecker 		break;
66374a2b8ddaSFrederic Weisbecker 	}
66384a2b8ddaSFrederic Weisbecker 	return NOTIFY_DONE;
66394a2b8ddaSFrederic Weisbecker }
66404a2b8ddaSFrederic Weisbecker 
664123a8e844SSteven Rostedt (Red Hat) static int ftrace_graph_entry_test(struct ftrace_graph_ent *trace)
664223a8e844SSteven Rostedt (Red Hat) {
664323a8e844SSteven Rostedt (Red Hat) 	if (!ftrace_ops_test(&global_ops, trace->func, NULL))
664423a8e844SSteven Rostedt (Red Hat) 		return 0;
664523a8e844SSteven Rostedt (Red Hat) 	return __ftrace_graph_entry(trace);
664623a8e844SSteven Rostedt (Red Hat) }
664723a8e844SSteven Rostedt (Red Hat) 
664823a8e844SSteven Rostedt (Red Hat) /*
664923a8e844SSteven Rostedt (Red Hat)  * The function graph tracer should only trace the functions defined
665023a8e844SSteven Rostedt (Red Hat)  * by set_ftrace_filter and set_ftrace_notrace. If another function
665123a8e844SSteven Rostedt (Red Hat)  * tracer ops is registered, the graph tracer requires testing the
665223a8e844SSteven Rostedt (Red Hat)  * function against the global ops, and not just trace any function
665323a8e844SSteven Rostedt (Red Hat)  * that any ftrace_ops registered.
665423a8e844SSteven Rostedt (Red Hat)  */
665523a8e844SSteven Rostedt (Red Hat) static void update_function_graph_func(void)
665623a8e844SSteven Rostedt (Red Hat) {
66575f151b24SSteven Rostedt (Red Hat) 	struct ftrace_ops *op;
66585f151b24SSteven Rostedt (Red Hat) 	bool do_test = false;
66595f151b24SSteven Rostedt (Red Hat) 
66605f151b24SSteven Rostedt (Red Hat) 	/*
66615f151b24SSteven Rostedt (Red Hat) 	 * The graph and global ops share the same set of functions
66625f151b24SSteven Rostedt (Red Hat) 	 * to test. If any other ops is on the list, then
66635f151b24SSteven Rostedt (Red Hat) 	 * the graph tracing needs to test if its the function
66645f151b24SSteven Rostedt (Red Hat) 	 * it should call.
66655f151b24SSteven Rostedt (Red Hat) 	 */
66665f151b24SSteven Rostedt (Red Hat) 	do_for_each_ftrace_op(op, ftrace_ops_list) {
66675f151b24SSteven Rostedt (Red Hat) 		if (op != &global_ops && op != &graph_ops &&
66685f151b24SSteven Rostedt (Red Hat) 		    op != &ftrace_list_end) {
66695f151b24SSteven Rostedt (Red Hat) 			do_test = true;
66705f151b24SSteven Rostedt (Red Hat) 			/* in double loop, break out with goto */
66715f151b24SSteven Rostedt (Red Hat) 			goto out;
66725f151b24SSteven Rostedt (Red Hat) 		}
66735f151b24SSteven Rostedt (Red Hat) 	} while_for_each_ftrace_op(op);
66745f151b24SSteven Rostedt (Red Hat)  out:
66755f151b24SSteven Rostedt (Red Hat) 	if (do_test)
667623a8e844SSteven Rostedt (Red Hat) 		ftrace_graph_entry = ftrace_graph_entry_test;
66775f151b24SSteven Rostedt (Red Hat) 	else
66785f151b24SSteven Rostedt (Red Hat) 		ftrace_graph_entry = __ftrace_graph_entry;
667923a8e844SSteven Rostedt (Red Hat) }
668023a8e844SSteven Rostedt (Red Hat) 
66818275f69fSMathias Krause static struct notifier_block ftrace_suspend_notifier = {
66828275f69fSMathias Krause 	.notifier_call = ftrace_suspend_notifier_call,
66838275f69fSMathias Krause };
66848275f69fSMathias Krause 
6685287b6e68SFrederic Weisbecker int register_ftrace_graph(trace_func_graph_ret_t retfunc,
6686287b6e68SFrederic Weisbecker 			trace_func_graph_ent_t entryfunc)
668715e6cb36SFrederic Weisbecker {
6688e7d3737eSFrederic Weisbecker 	int ret = 0;
6689e7d3737eSFrederic Weisbecker 
6690e6ea44e9SSteven Rostedt 	mutex_lock(&ftrace_lock);
6691e7d3737eSFrederic Weisbecker 
669205ce5818SSteven Rostedt 	/* we currently allow only one tracer registered at a time */
6693597af815SSteven Rostedt 	if (ftrace_graph_active) {
669405ce5818SSteven Rostedt 		ret = -EBUSY;
669505ce5818SSteven Rostedt 		goto out;
669605ce5818SSteven Rostedt 	}
669705ce5818SSteven Rostedt 
66984a2b8ddaSFrederic Weisbecker 	register_pm_notifier(&ftrace_suspend_notifier);
66994a2b8ddaSFrederic Weisbecker 
6700597af815SSteven Rostedt 	ftrace_graph_active++;
6701fb52607aSFrederic Weisbecker 	ret = start_graph_tracing();
6702f201ae23SFrederic Weisbecker 	if (ret) {
6703597af815SSteven Rostedt 		ftrace_graph_active--;
6704f201ae23SFrederic Weisbecker 		goto out;
6705f201ae23SFrederic Weisbecker 	}
6706e53a6319SSteven Rostedt 
6707287b6e68SFrederic Weisbecker 	ftrace_graph_return = retfunc;
670823a8e844SSteven Rostedt (Red Hat) 
670923a8e844SSteven Rostedt (Red Hat) 	/*
671023a8e844SSteven Rostedt (Red Hat) 	 * Update the indirect function to the entryfunc, and the
671123a8e844SSteven Rostedt (Red Hat) 	 * function that gets called to the entry_test first. Then
671223a8e844SSteven Rostedt (Red Hat) 	 * call the update fgraph entry function to determine if
671323a8e844SSteven Rostedt (Red Hat) 	 * the entryfunc should be called directly or not.
671423a8e844SSteven Rostedt (Red Hat) 	 */
671523a8e844SSteven Rostedt (Red Hat) 	__ftrace_graph_entry = entryfunc;
671623a8e844SSteven Rostedt (Red Hat) 	ftrace_graph_entry = ftrace_graph_entry_test;
671723a8e844SSteven Rostedt (Red Hat) 	update_function_graph_func();
6718e53a6319SSteven Rostedt 
67195f151b24SSteven Rostedt (Red Hat) 	ret = ftrace_startup(&graph_ops, FTRACE_START_FUNC_RET);
6720e7d3737eSFrederic Weisbecker out:
6721e6ea44e9SSteven Rostedt 	mutex_unlock(&ftrace_lock);
6722e7d3737eSFrederic Weisbecker 	return ret;
672315e6cb36SFrederic Weisbecker }
672415e6cb36SFrederic Weisbecker 
6725fb52607aSFrederic Weisbecker void unregister_ftrace_graph(void)
672615e6cb36SFrederic Weisbecker {
6727e6ea44e9SSteven Rostedt 	mutex_lock(&ftrace_lock);
6728e7d3737eSFrederic Weisbecker 
6729597af815SSteven Rostedt 	if (unlikely(!ftrace_graph_active))
67302aad1b76SSteven Rostedt 		goto out;
67312aad1b76SSteven Rostedt 
6732597af815SSteven Rostedt 	ftrace_graph_active--;
6733287b6e68SFrederic Weisbecker 	ftrace_graph_return = (trace_func_graph_ret_t)ftrace_stub;
6734e49dc19cSSteven Rostedt 	ftrace_graph_entry = ftrace_graph_entry_stub;
673523a8e844SSteven Rostedt (Red Hat) 	__ftrace_graph_entry = ftrace_graph_entry_stub;
67365f151b24SSteven Rostedt (Red Hat) 	ftrace_shutdown(&graph_ops, FTRACE_STOP_FUNC_RET);
67374a2b8ddaSFrederic Weisbecker 	unregister_pm_notifier(&ftrace_suspend_notifier);
673838516ab5SSteven Rostedt 	unregister_trace_sched_switch(ftrace_graph_probe_sched_switch, NULL);
6739e7d3737eSFrederic Weisbecker 
6740f3bea491SSteven Rostedt (Red Hat) #ifdef CONFIG_DYNAMIC_FTRACE
6741f3bea491SSteven Rostedt (Red Hat) 	/*
6742f3bea491SSteven Rostedt (Red Hat) 	 * Function graph does not allocate the trampoline, but
6743f3bea491SSteven Rostedt (Red Hat) 	 * other global_ops do. We need to reset the ALLOC_TRAMP flag
6744f3bea491SSteven Rostedt (Red Hat) 	 * if one was used.
6745f3bea491SSteven Rostedt (Red Hat) 	 */
6746f3bea491SSteven Rostedt (Red Hat) 	global_ops.trampoline = save_global_trampoline;
6747f3bea491SSteven Rostedt (Red Hat) 	if (save_global_flags & FTRACE_OPS_FL_ALLOC_TRAMP)
6748f3bea491SSteven Rostedt (Red Hat) 		global_ops.flags |= FTRACE_OPS_FL_ALLOC_TRAMP;
6749f3bea491SSteven Rostedt (Red Hat) #endif
6750f3bea491SSteven Rostedt (Red Hat) 
67512aad1b76SSteven Rostedt  out:
6752e6ea44e9SSteven Rostedt 	mutex_unlock(&ftrace_lock);
675315e6cb36SFrederic Weisbecker }
6754f201ae23SFrederic Weisbecker 
6755868baf07SSteven Rostedt static DEFINE_PER_CPU(struct ftrace_ret_stack *, idle_ret_stack);
6756868baf07SSteven Rostedt 
6757868baf07SSteven Rostedt static void
6758868baf07SSteven Rostedt graph_init_task(struct task_struct *t, struct ftrace_ret_stack *ret_stack)
6759868baf07SSteven Rostedt {
6760868baf07SSteven Rostedt 	atomic_set(&t->tracing_graph_pause, 0);
6761868baf07SSteven Rostedt 	atomic_set(&t->trace_overrun, 0);
6762868baf07SSteven Rostedt 	t->ftrace_timestamp = 0;
676325985edcSLucas De Marchi 	/* make curr_ret_stack visible before we add the ret_stack */
6764868baf07SSteven Rostedt 	smp_wmb();
6765868baf07SSteven Rostedt 	t->ret_stack = ret_stack;
6766868baf07SSteven Rostedt }
6767868baf07SSteven Rostedt 
6768868baf07SSteven Rostedt /*
6769868baf07SSteven Rostedt  * Allocate a return stack for the idle task. May be the first
6770868baf07SSteven Rostedt  * time through, or it may be done by CPU hotplug online.
6771868baf07SSteven Rostedt  */
6772868baf07SSteven Rostedt void ftrace_graph_init_idle_task(struct task_struct *t, int cpu)
6773868baf07SSteven Rostedt {
6774868baf07SSteven Rostedt 	t->curr_ret_stack = -1;
6775868baf07SSteven Rostedt 	/*
6776868baf07SSteven Rostedt 	 * The idle task has no parent, it either has its own
6777868baf07SSteven Rostedt 	 * stack or no stack at all.
6778868baf07SSteven Rostedt 	 */
6779868baf07SSteven Rostedt 	if (t->ret_stack)
6780868baf07SSteven Rostedt 		WARN_ON(t->ret_stack != per_cpu(idle_ret_stack, cpu));
6781868baf07SSteven Rostedt 
6782868baf07SSteven Rostedt 	if (ftrace_graph_active) {
6783868baf07SSteven Rostedt 		struct ftrace_ret_stack *ret_stack;
6784868baf07SSteven Rostedt 
6785868baf07SSteven Rostedt 		ret_stack = per_cpu(idle_ret_stack, cpu);
6786868baf07SSteven Rostedt 		if (!ret_stack) {
6787868baf07SSteven Rostedt 			ret_stack = kmalloc(FTRACE_RETFUNC_DEPTH
6788868baf07SSteven Rostedt 					    * sizeof(struct ftrace_ret_stack),
6789868baf07SSteven Rostedt 					    GFP_KERNEL);
6790868baf07SSteven Rostedt 			if (!ret_stack)
6791868baf07SSteven Rostedt 				return;
6792868baf07SSteven Rostedt 			per_cpu(idle_ret_stack, cpu) = ret_stack;
6793868baf07SSteven Rostedt 		}
6794868baf07SSteven Rostedt 		graph_init_task(t, ret_stack);
6795868baf07SSteven Rostedt 	}
6796868baf07SSteven Rostedt }
6797868baf07SSteven Rostedt 
6798f201ae23SFrederic Weisbecker /* Allocate a return stack for newly created task */
6799fb52607aSFrederic Weisbecker void ftrace_graph_init_task(struct task_struct *t)
6800f201ae23SFrederic Weisbecker {
680184047e36SSteven Rostedt 	/* Make sure we do not use the parent ret_stack */
680284047e36SSteven Rostedt 	t->ret_stack = NULL;
6803ea14eb71SSteven Rostedt 	t->curr_ret_stack = -1;
680484047e36SSteven Rostedt 
6805597af815SSteven Rostedt 	if (ftrace_graph_active) {
680682310a32SSteven Rostedt 		struct ftrace_ret_stack *ret_stack;
680782310a32SSteven Rostedt 
680882310a32SSteven Rostedt 		ret_stack = kmalloc(FTRACE_RETFUNC_DEPTH
6809f201ae23SFrederic Weisbecker 				* sizeof(struct ftrace_ret_stack),
6810f201ae23SFrederic Weisbecker 				GFP_KERNEL);
681182310a32SSteven Rostedt 		if (!ret_stack)
6812f201ae23SFrederic Weisbecker 			return;
6813868baf07SSteven Rostedt 		graph_init_task(t, ret_stack);
681484047e36SSteven Rostedt 	}
6815f201ae23SFrederic Weisbecker }
6816f201ae23SFrederic Weisbecker 
6817fb52607aSFrederic Weisbecker void ftrace_graph_exit_task(struct task_struct *t)
6818f201ae23SFrederic Weisbecker {
6819eae849caSFrederic Weisbecker 	struct ftrace_ret_stack	*ret_stack = t->ret_stack;
6820eae849caSFrederic Weisbecker 
6821f201ae23SFrederic Weisbecker 	t->ret_stack = NULL;
6822eae849caSFrederic Weisbecker 	/* NULL must become visible to IRQs before we free it: */
6823eae849caSFrederic Weisbecker 	barrier();
6824eae849caSFrederic Weisbecker 
6825eae849caSFrederic Weisbecker 	kfree(ret_stack);
6826f201ae23SFrederic Weisbecker }
682715e6cb36SFrederic Weisbecker #endif
6828