xref: /linux-6.15/kernel/trace/ftrace.c (revision 0ce0638e)
1bcea3f96SSteven Rostedt (VMware) // SPDX-License-Identifier: GPL-2.0
216444a8aSArnaldo Carvalho de Melo /*
316444a8aSArnaldo Carvalho de Melo  * Infrastructure for profiling code inserted by 'gcc -pg'.
416444a8aSArnaldo Carvalho de Melo  *
516444a8aSArnaldo Carvalho de Melo  * Copyright (C) 2007-2008 Steven Rostedt <[email protected]>
616444a8aSArnaldo Carvalho de Melo  * Copyright (C) 2004-2008 Ingo Molnar <[email protected]>
716444a8aSArnaldo Carvalho de Melo  *
816444a8aSArnaldo Carvalho de Melo  * Originally ported from the -rt patch by:
916444a8aSArnaldo Carvalho de Melo  *   Copyright (C) 2007 Arnaldo Carvalho de Melo <[email protected]>
1016444a8aSArnaldo Carvalho de Melo  *
1116444a8aSArnaldo Carvalho de Melo  * Based on code in the latency_tracer, that is:
1216444a8aSArnaldo Carvalho de Melo  *
1316444a8aSArnaldo Carvalho de Melo  *  Copyright (C) 2004-2006 Ingo Molnar
146d49e352SNadia Yvette Chambers  *  Copyright (C) 2004 Nadia Yvette Chambers
1516444a8aSArnaldo Carvalho de Melo  */
1616444a8aSArnaldo Carvalho de Melo 
173d083395SSteven Rostedt #include <linux/stop_machine.h>
183d083395SSteven Rostedt #include <linux/clocksource.h>
1929930025SIngo Molnar #include <linux/sched/task.h>
203d083395SSteven Rostedt #include <linux/kallsyms.h>
2117911ff3SSteven Rostedt (VMware) #include <linux/security.h>
225072c59fSSteven Rostedt #include <linux/seq_file.h>
238434dc93SSteven Rostedt (Red Hat) #include <linux/tracefs.h>
243d083395SSteven Rostedt #include <linux/hardirq.h>
252d8b820bSIngo Molnar #include <linux/kthread.h>
265072c59fSSteven Rostedt #include <linux/uaccess.h>
275855feadSSteven Rostedt #include <linux/bsearch.h>
2856d82e00SPaul Gortmaker #include <linux/module.h>
292d8b820bSIngo Molnar #include <linux/ftrace.h>
30b0fc494fSSteven Rostedt #include <linux/sysctl.h>
315a0e3ad6STejun Heo #include <linux/slab.h>
325072c59fSSteven Rostedt #include <linux/ctype.h>
3368950619SSteven Rostedt #include <linux/sort.h>
343d083395SSteven Rostedt #include <linux/list.h>
3559df055fSSteven Rostedt #include <linux/hash.h>
363f379b03SPaul E. McKenney #include <linux/rcupdate.h>
37fabe38abSMasami Hiramatsu #include <linux/kprobes.h>
3816444a8aSArnaldo Carvalho de Melo 
39ad8d75ffSSteven Rostedt #include <trace/events/sched.h>
408aef2d28SSteven Rostedt 
41b80f0f6cSSteven Rostedt (VMware) #include <asm/sections.h>
422af15d6aSSteven Rostedt #include <asm/setup.h>
43395a59d0SAbhishek Sagar 
443306fc4aSSteven Rostedt (VMware) #include "ftrace_internal.h"
450706f1c4SSteven Rostedt #include "trace_output.h"
46bac429f0SSteven Rostedt #include "trace_stat.h"
473d083395SSteven Rostedt 
48b39181f7SSteven Rostedt (Google) #define FTRACE_INVALID_FUNCTION		"__ftrace_invalid_address__"
49b39181f7SSteven Rostedt (Google) 
506912896eSSteven Rostedt #define FTRACE_WARN_ON(cond)			\
510778d9adSSteven Rostedt 	({					\
520778d9adSSteven Rostedt 		int ___r = cond;		\
530778d9adSSteven Rostedt 		if (WARN_ON(___r))		\
546912896eSSteven Rostedt 			ftrace_kill();		\
550778d9adSSteven Rostedt 		___r;				\
560778d9adSSteven Rostedt 	})
576912896eSSteven Rostedt 
586912896eSSteven Rostedt #define FTRACE_WARN_ON_ONCE(cond)		\
590778d9adSSteven Rostedt 	({					\
600778d9adSSteven Rostedt 		int ___r = cond;		\
610778d9adSSteven Rostedt 		if (WARN_ON_ONCE(___r))		\
626912896eSSteven Rostedt 			ftrace_kill();		\
630778d9adSSteven Rostedt 		___r;				\
640778d9adSSteven Rostedt 	})
656912896eSSteven Rostedt 
668fc0c701SSteven Rostedt /* hash bits for specific function selection */
6733dc9b12SSteven Rostedt #define FTRACE_HASH_DEFAULT_BITS 10
6833dc9b12SSteven Rostedt #define FTRACE_HASH_MAX_BITS 12
698fc0c701SSteven Rostedt 
70f04f24fbSMasami Hiramatsu #ifdef CONFIG_DYNAMIC_FTRACE
7133b7f99cSSteven Rostedt (Red Hat) #define INIT_OPS_HASH(opsname)	\
7233b7f99cSSteven Rostedt (Red Hat) 	.func_hash		= &opsname.local_hash,			\
7333b7f99cSSteven 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)
76f04f24fbSMasami Hiramatsu #endif
77f04f24fbSMasami Hiramatsu 
78a0572f68SSteven Rostedt (VMware) enum {
79a0572f68SSteven Rostedt (VMware) 	FTRACE_MODIFY_ENABLE_FL		= (1 << 0),
80a0572f68SSteven Rostedt (VMware) 	FTRACE_MODIFY_MAY_SLEEP_FL	= (1 << 1),
81a0572f68SSteven Rostedt (VMware) };
82a0572f68SSteven Rostedt (VMware) 
833306fc4aSSteven Rostedt (VMware) struct ftrace_ops ftrace_list_end __read_mostly = {
842f5f6ad9SSteven Rostedt 	.func		= ftrace_stub,
85a25d036dSSteven Rostedt (VMware) 	.flags		= FTRACE_OPS_FL_STUB,
8633b7f99cSSteven Rostedt (Red Hat) 	INIT_OPS_HASH(ftrace_list_end)
872f5f6ad9SSteven Rostedt };
882f5f6ad9SSteven Rostedt 
894eebcc81SSteven Rostedt /* ftrace_enabled is a method to turn ftrace on or off */
904eebcc81SSteven Rostedt int ftrace_enabled __read_mostly;
915d79fa0dSYueHaibing static int __maybe_unused last_ftrace_enabled;
92b0fc494fSSteven Rostedt 
932f5f6ad9SSteven Rostedt /* Current function tracing op */
942f5f6ad9SSteven Rostedt struct ftrace_ops *function_trace_op __read_mostly = &ftrace_list_end;
95405e1d83SSteven Rostedt (Red Hat) /* What to set function_trace_op to */
96405e1d83SSteven Rostedt (Red Hat) static struct ftrace_ops *set_function_trace_op;
9760a7ecf4SSteven Rostedt 
98345ddcc8SSteven Rostedt (Red Hat) static bool ftrace_pids_enabled(struct ftrace_ops *ops)
99e3eea140SSteven Rostedt (Red Hat) {
100345ddcc8SSteven Rostedt (Red Hat) 	struct trace_array *tr;
101345ddcc8SSteven Rostedt (Red Hat) 
102345ddcc8SSteven Rostedt (Red Hat) 	if (!(ops->flags & FTRACE_OPS_FL_PID) || !ops->private)
103345ddcc8SSteven Rostedt (Red Hat) 		return false;
104345ddcc8SSteven Rostedt (Red Hat) 
105345ddcc8SSteven Rostedt (Red Hat) 	tr = ops->private;
106345ddcc8SSteven Rostedt (Red Hat) 
107b3b1e6edSSteven Rostedt (VMware) 	return tr->function_pids != NULL || tr->function_no_pids != NULL;
108e3eea140SSteven Rostedt (Red Hat) }
109e3eea140SSteven Rostedt (Red Hat) 
110e3eea140SSteven Rostedt (Red Hat) static void ftrace_update_trampoline(struct ftrace_ops *ops);
111e3eea140SSteven Rostedt (Red Hat) 
1124eebcc81SSteven Rostedt /*
1134eebcc81SSteven Rostedt  * ftrace_disabled is set when an anomaly is discovered.
1144eebcc81SSteven Rostedt  * ftrace_disabled is much stronger than ftrace_enabled.
1154eebcc81SSteven Rostedt  */
1164eebcc81SSteven Rostedt static int ftrace_disabled __read_mostly;
1174eebcc81SSteven Rostedt 
1183306fc4aSSteven Rostedt (VMware) DEFINE_MUTEX(ftrace_lock);
119b0fc494fSSteven Rostedt 
1203306fc4aSSteven Rostedt (VMware) struct ftrace_ops __rcu *ftrace_ops_list __read_mostly = &ftrace_list_end;
12116444a8aSArnaldo Carvalho de Melo ftrace_func_t ftrace_trace_function __read_mostly = ftrace_stub;
1223306fc4aSSteven Rostedt (VMware) struct ftrace_ops global_ops;
12316444a8aSArnaldo Carvalho de Melo 
12450c69781SJulia Lawall /* Defined by vmlinux.lds.h see the comment above arch_ftrace_ops_list_func for details */
12534cdd18bSSteven Rostedt (VMware) void ftrace_ops_list_func(unsigned long ip, unsigned long parent_ip,
126d19ad077SSteven Rostedt (VMware) 			  struct ftrace_ops *op, struct ftrace_regs *fregs);
127b848914cSSteven Rostedt 
128f04f24fbSMasami Hiramatsu static inline void ftrace_ops_init(struct ftrace_ops *ops)
129f04f24fbSMasami Hiramatsu {
130f04f24fbSMasami Hiramatsu #ifdef CONFIG_DYNAMIC_FTRACE
131f04f24fbSMasami Hiramatsu 	if (!(ops->flags & FTRACE_OPS_FL_INITIALIZED)) {
13233b7f99cSSteven Rostedt (Red Hat) 		mutex_init(&ops->local_hash.regex_lock);
13333b7f99cSSteven Rostedt (Red Hat) 		ops->func_hash = &ops->local_hash;
134f04f24fbSMasami Hiramatsu 		ops->flags |= FTRACE_OPS_FL_INITIALIZED;
135f04f24fbSMasami Hiramatsu 	}
136f04f24fbSMasami Hiramatsu #endif
137f04f24fbSMasami Hiramatsu }
138f04f24fbSMasami Hiramatsu 
1392f5f6ad9SSteven Rostedt static void ftrace_pid_func(unsigned long ip, unsigned long parent_ip,
140d19ad077SSteven Rostedt (VMware) 			    struct ftrace_ops *op, struct ftrace_regs *fregs)
141df4fc315SSteven Rostedt {
142345ddcc8SSteven Rostedt (Red Hat) 	struct trace_array *tr = op->private;
143717e3f5eSSteven Rostedt (VMware) 	int pid;
144345ddcc8SSteven Rostedt (Red Hat) 
145717e3f5eSSteven Rostedt (VMware) 	if (tr) {
146717e3f5eSSteven Rostedt (VMware) 		pid = this_cpu_read(tr->array_buffer.data->ftrace_ignore_pid);
147717e3f5eSSteven Rostedt (VMware) 		if (pid == FTRACE_PID_IGNORE)
148df4fc315SSteven Rostedt 			return;
149717e3f5eSSteven Rostedt (VMware) 		if (pid != FTRACE_PID_TRACE &&
150717e3f5eSSteven Rostedt (VMware) 		    pid != current->pid)
151717e3f5eSSteven Rostedt (VMware) 			return;
152717e3f5eSSteven Rostedt (VMware) 	}
153df4fc315SSteven Rostedt 
154d19ad077SSteven Rostedt (VMware) 	op->saved_func(ip, parent_ip, op, fregs);
155df4fc315SSteven Rostedt }
156df4fc315SSteven Rostedt 
157405e1d83SSteven Rostedt (Red Hat) static void ftrace_sync_ipi(void *data)
158405e1d83SSteven Rostedt (Red Hat) {
159405e1d83SSteven Rostedt (Red Hat) 	/* Probably not needed, but do it anyway */
160405e1d83SSteven Rostedt (Red Hat) 	smp_rmb();
161405e1d83SSteven Rostedt (Red Hat) }
162405e1d83SSteven Rostedt (Red Hat) 
16300ccbf2fSSteven Rostedt (Red Hat) static ftrace_func_t ftrace_ops_get_list_func(struct ftrace_ops *ops)
16400ccbf2fSSteven Rostedt (Red Hat) {
16500ccbf2fSSteven Rostedt (Red Hat) 	/*
166ba27f2bcSSteven Rostedt (Red Hat) 	 * If this is a dynamic, RCU, or per CPU ops, or we force list func,
16700ccbf2fSSteven Rostedt (Red Hat) 	 * then it needs to call the list anyway.
16800ccbf2fSSteven Rostedt (Red Hat) 	 */
169b3a88803SPeter Zijlstra 	if (ops->flags & (FTRACE_OPS_FL_DYNAMIC | FTRACE_OPS_FL_RCU) ||
170b3a88803SPeter Zijlstra 	    FTRACE_FORCE_LIST_FUNC)
17100ccbf2fSSteven Rostedt (Red Hat) 		return ftrace_ops_list_func;
17200ccbf2fSSteven Rostedt (Red Hat) 
17300ccbf2fSSteven Rostedt (Red Hat) 	return ftrace_ops_get_func(ops);
17400ccbf2fSSteven Rostedt (Red Hat) }
17500ccbf2fSSteven Rostedt (Red Hat) 
1762b499381SSteven Rostedt static void update_ftrace_function(void)
1772b499381SSteven Rostedt {
1782b499381SSteven Rostedt 	ftrace_func_t func;
1792b499381SSteven Rostedt 
180cdbe61bfSSteven Rostedt 	/*
181f7aad4e1SSteven Rostedt (Red Hat) 	 * Prepare the ftrace_ops that the arch callback will use.
182f7aad4e1SSteven Rostedt (Red Hat) 	 * If there's only one ftrace_ops registered, the ftrace_ops_list
183f7aad4e1SSteven Rostedt (Red Hat) 	 * will point to the ops we want.
184f7aad4e1SSteven Rostedt (Red Hat) 	 */
185f86f4180SChunyan Zhang 	set_function_trace_op = rcu_dereference_protected(ftrace_ops_list,
186f86f4180SChunyan Zhang 						lockdep_is_held(&ftrace_lock));
187f7aad4e1SSteven Rostedt (Red Hat) 
188f7aad4e1SSteven Rostedt (Red Hat) 	/* If there's no ftrace_ops registered, just call the stub function */
189f86f4180SChunyan Zhang 	if (set_function_trace_op == &ftrace_list_end) {
190f7aad4e1SSteven Rostedt (Red Hat) 		func = ftrace_stub;
191f7aad4e1SSteven Rostedt (Red Hat) 
192f7aad4e1SSteven Rostedt (Red Hat) 	/*
193cdbe61bfSSteven Rostedt 	 * If we are at the end of the list and this ops is
1944740974aSSteven Rostedt 	 * recursion safe and not dynamic and the arch supports passing ops,
1954740974aSSteven Rostedt 	 * then have the mcount trampoline call the function directly.
196cdbe61bfSSteven Rostedt 	 */
197f86f4180SChunyan Zhang 	} else if (rcu_dereference_protected(ftrace_ops_list->next,
198f86f4180SChunyan Zhang 			lockdep_is_held(&ftrace_lock)) == &ftrace_list_end) {
19900ccbf2fSSteven Rostedt (Red Hat) 		func = ftrace_ops_get_list_func(ftrace_ops_list);
200f7aad4e1SSteven Rostedt (Red Hat) 
2012f5f6ad9SSteven Rostedt 	} else {
2022f5f6ad9SSteven Rostedt 		/* Just use the default ftrace_ops */
203405e1d83SSteven Rostedt (Red Hat) 		set_function_trace_op = &ftrace_list_end;
204b848914cSSteven Rostedt 		func = ftrace_ops_list_func;
2052f5f6ad9SSteven Rostedt 	}
2062b499381SSteven Rostedt 
2075f8bf2d2SSteven Rostedt (Red Hat) 	update_function_graph_func();
2085f8bf2d2SSteven Rostedt (Red Hat) 
209405e1d83SSteven Rostedt (Red Hat) 	/* If there's no change, then do nothing more here */
210405e1d83SSteven Rostedt (Red Hat) 	if (ftrace_trace_function == func)
211405e1d83SSteven Rostedt (Red Hat) 		return;
212405e1d83SSteven Rostedt (Red Hat) 
213405e1d83SSteven Rostedt (Red Hat) 	/*
214405e1d83SSteven Rostedt (Red Hat) 	 * If we are using the list function, it doesn't care
215405e1d83SSteven Rostedt (Red Hat) 	 * about the function_trace_ops.
216405e1d83SSteven Rostedt (Red Hat) 	 */
217405e1d83SSteven Rostedt (Red Hat) 	if (func == ftrace_ops_list_func) {
218405e1d83SSteven Rostedt (Red Hat) 		ftrace_trace_function = func;
219405e1d83SSteven Rostedt (Red Hat) 		/*
220405e1d83SSteven Rostedt (Red Hat) 		 * Don't even bother setting function_trace_ops,
221405e1d83SSteven Rostedt (Red Hat) 		 * it would be racy to do so anyway.
222405e1d83SSteven Rostedt (Red Hat) 		 */
223405e1d83SSteven Rostedt (Red Hat) 		return;
224405e1d83SSteven Rostedt (Red Hat) 	}
225405e1d83SSteven Rostedt (Red Hat) 
226405e1d83SSteven Rostedt (Red Hat) #ifndef CONFIG_DYNAMIC_FTRACE
227405e1d83SSteven Rostedt (Red Hat) 	/*
228405e1d83SSteven Rostedt (Red Hat) 	 * For static tracing, we need to be a bit more careful.
229405e1d83SSteven Rostedt (Red Hat) 	 * The function change takes affect immediately. Thus,
230fdda88d3SQiujun Huang 	 * we need to coordinate the setting of the function_trace_ops
231405e1d83SSteven Rostedt (Red Hat) 	 * with the setting of the ftrace_trace_function.
232405e1d83SSteven Rostedt (Red Hat) 	 *
233405e1d83SSteven Rostedt (Red Hat) 	 * Set the function to the list ops, which will call the
234405e1d83SSteven Rostedt (Red Hat) 	 * function we want, albeit indirectly, but it handles the
235405e1d83SSteven Rostedt (Red Hat) 	 * ftrace_ops and doesn't depend on function_trace_op.
236405e1d83SSteven Rostedt (Red Hat) 	 */
237405e1d83SSteven Rostedt (Red Hat) 	ftrace_trace_function = ftrace_ops_list_func;
238405e1d83SSteven Rostedt (Red Hat) 	/*
239405e1d83SSteven Rostedt (Red Hat) 	 * Make sure all CPUs see this. Yes this is slow, but static
240405e1d83SSteven Rostedt (Red Hat) 	 * tracing is slow and nasty to have enabled.
241405e1d83SSteven Rostedt (Red Hat) 	 */
242e5a971d7SPaul E. McKenney 	synchronize_rcu_tasks_rude();
243405e1d83SSteven Rostedt (Red Hat) 	/* Now all cpus are using the list ops. */
244405e1d83SSteven Rostedt (Red Hat) 	function_trace_op = set_function_trace_op;
245405e1d83SSteven Rostedt (Red Hat) 	/* Make sure the function_trace_op is visible on all CPUs */
246405e1d83SSteven Rostedt (Red Hat) 	smp_wmb();
247405e1d83SSteven Rostedt (Red Hat) 	/* Nasty way to force a rmb on all cpus */
248405e1d83SSteven Rostedt (Red Hat) 	smp_call_function(ftrace_sync_ipi, NULL, 1);
249405e1d83SSteven Rostedt (Red Hat) 	/* OK, we are all set to update the ftrace_trace_function now! */
250405e1d83SSteven Rostedt (Red Hat) #endif /* !CONFIG_DYNAMIC_FTRACE */
251405e1d83SSteven Rostedt (Red Hat) 
252491d0dcfSSteven Rostedt 	ftrace_trace_function = func;
253491d0dcfSSteven Rostedt }
254491d0dcfSSteven Rostedt 
255f86f4180SChunyan Zhang static void add_ftrace_ops(struct ftrace_ops __rcu **list,
256f86f4180SChunyan Zhang 			   struct ftrace_ops *ops)
2573d083395SSteven Rostedt {
258f86f4180SChunyan Zhang 	rcu_assign_pointer(ops->next, *list);
259f86f4180SChunyan Zhang 
26016444a8aSArnaldo Carvalho de Melo 	/*
261b848914cSSteven Rostedt 	 * We are entering ops into the list but another
26216444a8aSArnaldo Carvalho de Melo 	 * CPU might be walking that list. We need to make sure
26316444a8aSArnaldo Carvalho de Melo 	 * the ops->next pointer is valid before another CPU sees
264b848914cSSteven Rostedt 	 * the ops pointer included into the list.
26516444a8aSArnaldo Carvalho de Melo 	 */
2662b499381SSteven Rostedt 	rcu_assign_pointer(*list, ops);
2672b499381SSteven Rostedt }
2683d083395SSteven Rostedt 
269f86f4180SChunyan Zhang static int remove_ftrace_ops(struct ftrace_ops __rcu **list,
270f86f4180SChunyan Zhang 			     struct ftrace_ops *ops)
2712b499381SSteven Rostedt {
2722b499381SSteven Rostedt 	struct ftrace_ops **p;
2732b499381SSteven Rostedt 
2742b499381SSteven Rostedt 	/*
2752b499381SSteven Rostedt 	 * If we are removing the last function, then simply point
2762b499381SSteven Rostedt 	 * to the ftrace_stub.
2772b499381SSteven Rostedt 	 */
278f86f4180SChunyan Zhang 	if (rcu_dereference_protected(*list,
279f86f4180SChunyan Zhang 			lockdep_is_held(&ftrace_lock)) == ops &&
280f86f4180SChunyan Zhang 	    rcu_dereference_protected(ops->next,
281f86f4180SChunyan Zhang 			lockdep_is_held(&ftrace_lock)) == &ftrace_list_end) {
2822b499381SSteven Rostedt 		*list = &ftrace_list_end;
2832b499381SSteven Rostedt 		return 0;
2842b499381SSteven Rostedt 	}
2852b499381SSteven Rostedt 
2862b499381SSteven Rostedt 	for (p = list; *p != &ftrace_list_end; p = &(*p)->next)
2872b499381SSteven Rostedt 		if (*p == ops)
2882b499381SSteven Rostedt 			break;
2892b499381SSteven Rostedt 
2902b499381SSteven Rostedt 	if (*p != ops)
2912b499381SSteven Rostedt 		return -1;
2922b499381SSteven Rostedt 
2932b499381SSteven Rostedt 	*p = (*p)->next;
2942b499381SSteven Rostedt 	return 0;
2952b499381SSteven Rostedt }
2962b499381SSteven Rostedt 
297f3bea491SSteven Rostedt (Red Hat) static void ftrace_update_trampoline(struct ftrace_ops *ops);
298f3bea491SSteven Rostedt (Red Hat) 
2993306fc4aSSteven Rostedt (VMware) int __register_ftrace_function(struct ftrace_ops *ops)
3002b499381SSteven Rostedt {
301591dffdaSSteven Rostedt (Red Hat) 	if (ops->flags & FTRACE_OPS_FL_DELETED)
302591dffdaSSteven Rostedt (Red Hat) 		return -EINVAL;
303591dffdaSSteven Rostedt (Red Hat) 
304b848914cSSteven Rostedt 	if (WARN_ON(ops->flags & FTRACE_OPS_FL_ENABLED))
305b848914cSSteven Rostedt 		return -EBUSY;
306b848914cSSteven Rostedt 
30706aeaaeaSMasami Hiramatsu #ifndef CONFIG_DYNAMIC_FTRACE_WITH_REGS
30808f6fba5SSteven Rostedt 	/*
30908f6fba5SSteven Rostedt 	 * If the ftrace_ops specifies SAVE_REGS, then it only can be used
31008f6fba5SSteven Rostedt 	 * if the arch supports it, or SAVE_REGS_IF_SUPPORTED is also set.
31108f6fba5SSteven Rostedt 	 * Setting SAVE_REGS_IF_SUPPORTED makes SAVE_REGS irrelevant.
31208f6fba5SSteven Rostedt 	 */
31308f6fba5SSteven Rostedt 	if (ops->flags & FTRACE_OPS_FL_SAVE_REGS &&
31408f6fba5SSteven Rostedt 	    !(ops->flags & FTRACE_OPS_FL_SAVE_REGS_IF_SUPPORTED))
31508f6fba5SSteven Rostedt 		return -EINVAL;
31608f6fba5SSteven Rostedt 
31708f6fba5SSteven Rostedt 	if (ops->flags & FTRACE_OPS_FL_SAVE_REGS_IF_SUPPORTED)
31808f6fba5SSteven Rostedt 		ops->flags |= FTRACE_OPS_FL_SAVE_REGS;
31908f6fba5SSteven Rostedt #endif
3207162431dSMiroslav Benes 	if (!ftrace_enabled && (ops->flags & FTRACE_OPS_FL_PERMANENT))
3217162431dSMiroslav Benes 		return -EBUSY;
32208f6fba5SSteven Rostedt 
323a20deb3aSKefeng Wang 	if (!is_kernel_core_data((unsigned long)ops))
324cdbe61bfSSteven Rostedt 		ops->flags |= FTRACE_OPS_FL_DYNAMIC;
325cdbe61bfSSteven Rostedt 
326b848914cSSteven Rostedt 	add_ftrace_ops(&ftrace_ops_list, ops);
327b848914cSSteven Rostedt 
328e3eea140SSteven Rostedt (Red Hat) 	/* Always save the function, and reset at unregistering */
329e3eea140SSteven Rostedt (Red Hat) 	ops->saved_func = ops->func;
330e3eea140SSteven Rostedt (Red Hat) 
331345ddcc8SSteven Rostedt (Red Hat) 	if (ftrace_pids_enabled(ops))
332e3eea140SSteven Rostedt (Red Hat) 		ops->func = ftrace_pid_func;
333e3eea140SSteven Rostedt (Red Hat) 
334f3bea491SSteven Rostedt (Red Hat) 	ftrace_update_trampoline(ops);
335f3bea491SSteven Rostedt (Red Hat) 
336491d0dcfSSteven Rostedt 	if (ftrace_enabled)
337491d0dcfSSteven Rostedt 		update_ftrace_function();
3383d083395SSteven Rostedt 
33916444a8aSArnaldo Carvalho de Melo 	return 0;
34016444a8aSArnaldo Carvalho de Melo }
34116444a8aSArnaldo Carvalho de Melo 
3423306fc4aSSteven Rostedt (VMware) int __unregister_ftrace_function(struct ftrace_ops *ops)
34316444a8aSArnaldo Carvalho de Melo {
3442b499381SSteven Rostedt 	int ret;
34516444a8aSArnaldo Carvalho de Melo 
346b848914cSSteven Rostedt 	if (WARN_ON(!(ops->flags & FTRACE_OPS_FL_ENABLED)))
347b848914cSSteven Rostedt 		return -EBUSY;
348b848914cSSteven Rostedt 
349b848914cSSteven Rostedt 	ret = remove_ftrace_ops(&ftrace_ops_list, ops);
350b848914cSSteven Rostedt 
3512b499381SSteven Rostedt 	if (ret < 0)
3522b499381SSteven Rostedt 		return ret;
353b848914cSSteven Rostedt 
354491d0dcfSSteven Rostedt 	if (ftrace_enabled)
355491d0dcfSSteven Rostedt 		update_ftrace_function();
35616444a8aSArnaldo Carvalho de Melo 
357e3eea140SSteven Rostedt (Red Hat) 	ops->func = ops->saved_func;
358e3eea140SSteven Rostedt (Red Hat) 
359e6ea44e9SSteven Rostedt 	return 0;
3603d083395SSteven Rostedt }
3613d083395SSteven Rostedt 
362df4fc315SSteven Rostedt static void ftrace_update_pid_func(void)
363df4fc315SSteven Rostedt {
364e3eea140SSteven Rostedt (Red Hat) 	struct ftrace_ops *op;
365e3eea140SSteven Rostedt (Red Hat) 
366491d0dcfSSteven Rostedt 	/* Only do something if we are tracing something */
367df4fc315SSteven Rostedt 	if (ftrace_trace_function == ftrace_stub)
36810dd3ebeSKOSAKI Motohiro 		return;
369df4fc315SSteven Rostedt 
370e3eea140SSteven Rostedt (Red Hat) 	do_for_each_ftrace_op(op, ftrace_ops_list) {
371e3eea140SSteven Rostedt (Red Hat) 		if (op->flags & FTRACE_OPS_FL_PID) {
372345ddcc8SSteven Rostedt (Red Hat) 			op->func = ftrace_pids_enabled(op) ?
373345ddcc8SSteven Rostedt (Red Hat) 				ftrace_pid_func : op->saved_func;
374e3eea140SSteven Rostedt (Red Hat) 			ftrace_update_trampoline(op);
375e3eea140SSteven Rostedt (Red Hat) 		}
376e3eea140SSteven Rostedt (Red Hat) 	} while_for_each_ftrace_op(op);
377e3eea140SSteven Rostedt (Red Hat) 
378491d0dcfSSteven Rostedt 	update_ftrace_function();
379df4fc315SSteven Rostedt }
380df4fc315SSteven Rostedt 
381493762fcSSteven Rostedt #ifdef CONFIG_FUNCTION_PROFILER
382493762fcSSteven Rostedt struct ftrace_profile {
383493762fcSSteven Rostedt 	struct hlist_node		node;
384493762fcSSteven Rostedt 	unsigned long			ip;
385493762fcSSteven Rostedt 	unsigned long			counter;
3860706f1c4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
3870706f1c4SSteven Rostedt 	unsigned long long		time;
388e330b3bcSChase Douglas 	unsigned long long		time_squared;
3890706f1c4SSteven Rostedt #endif
390493762fcSSteven Rostedt };
391493762fcSSteven Rostedt 
392493762fcSSteven Rostedt struct ftrace_profile_page {
393493762fcSSteven Rostedt 	struct ftrace_profile_page	*next;
394493762fcSSteven Rostedt 	unsigned long			index;
395493762fcSSteven Rostedt 	struct ftrace_profile		records[];
396493762fcSSteven Rostedt };
397493762fcSSteven Rostedt 
398cafb168aSSteven Rostedt struct ftrace_profile_stat {
399cafb168aSSteven Rostedt 	atomic_t			disabled;
400cafb168aSSteven Rostedt 	struct hlist_head		*hash;
401cafb168aSSteven Rostedt 	struct ftrace_profile_page	*pages;
402cafb168aSSteven Rostedt 	struct ftrace_profile_page	*start;
403cafb168aSSteven Rostedt 	struct tracer_stat		stat;
404cafb168aSSteven Rostedt };
405cafb168aSSteven Rostedt 
406493762fcSSteven Rostedt #define PROFILE_RECORDS_SIZE						\
407493762fcSSteven Rostedt 	(PAGE_SIZE - offsetof(struct ftrace_profile_page, records))
408493762fcSSteven Rostedt 
409493762fcSSteven Rostedt #define PROFILES_PER_PAGE					\
410493762fcSSteven Rostedt 	(PROFILE_RECORDS_SIZE / sizeof(struct ftrace_profile))
411493762fcSSteven Rostedt 
412fb9fb015SSteven Rostedt static int ftrace_profile_enabled __read_mostly;
413fb9fb015SSteven Rostedt 
414fb9fb015SSteven Rostedt /* ftrace_profile_lock - synchronize the enable and disable of the profiler */
415493762fcSSteven Rostedt static DEFINE_MUTEX(ftrace_profile_lock);
416493762fcSSteven Rostedt 
417cafb168aSSteven Rostedt static DEFINE_PER_CPU(struct ftrace_profile_stat, ftrace_profile_stats);
418493762fcSSteven Rostedt 
41920079ebeSNamhyung Kim #define FTRACE_PROFILE_HASH_BITS 10
42020079ebeSNamhyung Kim #define FTRACE_PROFILE_HASH_SIZE (1 << FTRACE_PROFILE_HASH_BITS)
421493762fcSSteven Rostedt 
422493762fcSSteven Rostedt static void *
423493762fcSSteven Rostedt function_stat_next(void *v, int idx)
424493762fcSSteven Rostedt {
425493762fcSSteven Rostedt 	struct ftrace_profile *rec = v;
426493762fcSSteven Rostedt 	struct ftrace_profile_page *pg;
427493762fcSSteven Rostedt 
428493762fcSSteven Rostedt 	pg = (struct ftrace_profile_page *)((unsigned long)rec & PAGE_MASK);
429493762fcSSteven Rostedt 
430493762fcSSteven Rostedt  again:
4310296e425SLi Zefan 	if (idx != 0)
432493762fcSSteven Rostedt 		rec++;
4330296e425SLi Zefan 
434493762fcSSteven Rostedt 	if ((void *)rec >= (void *)&pg->records[pg->index]) {
435493762fcSSteven Rostedt 		pg = pg->next;
436493762fcSSteven Rostedt 		if (!pg)
437493762fcSSteven Rostedt 			return NULL;
438493762fcSSteven Rostedt 		rec = &pg->records[0];
439493762fcSSteven Rostedt 		if (!rec->counter)
440493762fcSSteven Rostedt 			goto again;
441493762fcSSteven Rostedt 	}
442493762fcSSteven Rostedt 
443493762fcSSteven Rostedt 	return rec;
444493762fcSSteven Rostedt }
445493762fcSSteven Rostedt 
446493762fcSSteven Rostedt static void *function_stat_start(struct tracer_stat *trace)
447493762fcSSteven Rostedt {
448cafb168aSSteven Rostedt 	struct ftrace_profile_stat *stat =
449cafb168aSSteven Rostedt 		container_of(trace, struct ftrace_profile_stat, stat);
450cafb168aSSteven Rostedt 
451cafb168aSSteven Rostedt 	if (!stat || !stat->start)
452cafb168aSSteven Rostedt 		return NULL;
453cafb168aSSteven Rostedt 
454cafb168aSSteven Rostedt 	return function_stat_next(&stat->start->records[0], 0);
455493762fcSSteven Rostedt }
456493762fcSSteven Rostedt 
4570706f1c4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
4580706f1c4SSteven Rostedt /* function graph compares on total time */
45980042c8fSAndy Shevchenko static int function_stat_cmp(const void *p1, const void *p2)
4600706f1c4SSteven Rostedt {
46180042c8fSAndy Shevchenko 	const struct ftrace_profile *a = p1;
46280042c8fSAndy Shevchenko 	const struct ftrace_profile *b = p2;
4630706f1c4SSteven Rostedt 
4640706f1c4SSteven Rostedt 	if (a->time < b->time)
4650706f1c4SSteven Rostedt 		return -1;
4660706f1c4SSteven Rostedt 	if (a->time > b->time)
4670706f1c4SSteven Rostedt 		return 1;
4680706f1c4SSteven Rostedt 	else
4690706f1c4SSteven Rostedt 		return 0;
4700706f1c4SSteven Rostedt }
4710706f1c4SSteven Rostedt #else
4720706f1c4SSteven Rostedt /* not function graph compares against hits */
47380042c8fSAndy Shevchenko static int function_stat_cmp(const void *p1, const void *p2)
474493762fcSSteven Rostedt {
47580042c8fSAndy Shevchenko 	const struct ftrace_profile *a = p1;
47680042c8fSAndy Shevchenko 	const struct ftrace_profile *b = p2;
477493762fcSSteven Rostedt 
478493762fcSSteven Rostedt 	if (a->counter < b->counter)
479493762fcSSteven Rostedt 		return -1;
480493762fcSSteven Rostedt 	if (a->counter > b->counter)
481493762fcSSteven Rostedt 		return 1;
482493762fcSSteven Rostedt 	else
483493762fcSSteven Rostedt 		return 0;
484493762fcSSteven Rostedt }
4850706f1c4SSteven Rostedt #endif
486493762fcSSteven Rostedt 
487493762fcSSteven Rostedt static int function_stat_headers(struct seq_file *m)
488493762fcSSteven Rostedt {
4890706f1c4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
490fa6f0cc7SRasmus Villemoes 	seq_puts(m, "  Function                               "
491e330b3bcSChase Douglas 		 "Hit    Time            Avg             s^2\n"
49234886c8bSSteven Rostedt 		    "  --------                               "
493e330b3bcSChase Douglas 		 "---    ----            ---             ---\n");
4940706f1c4SSteven Rostedt #else
495fa6f0cc7SRasmus Villemoes 	seq_puts(m, "  Function                               Hit\n"
496493762fcSSteven Rostedt 		    "  --------                               ---\n");
4970706f1c4SSteven Rostedt #endif
498493762fcSSteven Rostedt 	return 0;
499493762fcSSteven Rostedt }
500493762fcSSteven Rostedt 
501493762fcSSteven Rostedt static int function_stat_show(struct seq_file *m, void *v)
502493762fcSSteven Rostedt {
503493762fcSSteven Rostedt 	struct ftrace_profile *rec = v;
504493762fcSSteven Rostedt 	char str[KSYM_SYMBOL_LEN];
5053aaba20fSLi Zefan 	int ret = 0;
5060706f1c4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
50734886c8bSSteven Rostedt 	static struct trace_seq s;
50834886c8bSSteven Rostedt 	unsigned long long avg;
509e330b3bcSChase Douglas 	unsigned long long stddev;
5100706f1c4SSteven Rostedt #endif
5113aaba20fSLi Zefan 	mutex_lock(&ftrace_profile_lock);
5123aaba20fSLi Zefan 
5133aaba20fSLi Zefan 	/* we raced with function_profile_reset() */
5143aaba20fSLi Zefan 	if (unlikely(rec->counter == 0)) {
5153aaba20fSLi Zefan 		ret = -EBUSY;
5163aaba20fSLi Zefan 		goto out;
5173aaba20fSLi Zefan 	}
518493762fcSSteven Rostedt 
5198e436ca0SUmesh Tiwari #ifdef CONFIG_FUNCTION_GRAPH_TRACER
520e31f7939SWen Yang 	avg = div64_ul(rec->time, rec->counter);
5218e436ca0SUmesh Tiwari 	if (tracing_thresh && (avg < tracing_thresh))
5228e436ca0SUmesh Tiwari 		goto out;
5238e436ca0SUmesh Tiwari #endif
5248e436ca0SUmesh Tiwari 
525493762fcSSteven Rostedt 	kallsyms_lookup(rec->ip, NULL, NULL, NULL, str);
5260706f1c4SSteven Rostedt 	seq_printf(m, "  %-30.30s  %10lu", str, rec->counter);
527493762fcSSteven Rostedt 
5280706f1c4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
529fa6f0cc7SRasmus Villemoes 	seq_puts(m, "    ");
53034886c8bSSteven Rostedt 
531e330b3bcSChase Douglas 	/* Sample standard deviation (s^2) */
532e330b3bcSChase Douglas 	if (rec->counter <= 1)
533e330b3bcSChase Douglas 		stddev = 0;
534e330b3bcSChase Douglas 	else {
53552d85d76SJuri Lelli 		/*
53652d85d76SJuri Lelli 		 * Apply Welford's method:
53752d85d76SJuri Lelli 		 * s^2 = 1 / (n * (n-1)) * (n * \Sum (x_i)^2 - (\Sum x_i)^2)
53852d85d76SJuri Lelli 		 */
53952d85d76SJuri Lelli 		stddev = rec->counter * rec->time_squared -
54052d85d76SJuri Lelli 			 rec->time * rec->time;
54152d85d76SJuri Lelli 
542e330b3bcSChase Douglas 		/*
543e330b3bcSChase Douglas 		 * Divide only 1000 for ns^2 -> us^2 conversion.
544e330b3bcSChase Douglas 		 * trace_print_graph_duration will divide 1000 again.
545e330b3bcSChase Douglas 		 */
546e31f7939SWen Yang 		stddev = div64_ul(stddev,
547e31f7939SWen Yang 				  rec->counter * (rec->counter - 1) * 1000);
548e330b3bcSChase Douglas 	}
549e330b3bcSChase Douglas 
55034886c8bSSteven Rostedt 	trace_seq_init(&s);
55134886c8bSSteven Rostedt 	trace_print_graph_duration(rec->time, &s);
55234886c8bSSteven Rostedt 	trace_seq_puts(&s, "    ");
55334886c8bSSteven Rostedt 	trace_print_graph_duration(avg, &s);
554e330b3bcSChase Douglas 	trace_seq_puts(&s, "    ");
555e330b3bcSChase Douglas 	trace_print_graph_duration(stddev, &s);
5560706f1c4SSteven Rostedt 	trace_print_seq(m, &s);
5570706f1c4SSteven Rostedt #endif
5580706f1c4SSteven Rostedt 	seq_putc(m, '\n');
5593aaba20fSLi Zefan out:
5603aaba20fSLi Zefan 	mutex_unlock(&ftrace_profile_lock);
5610706f1c4SSteven Rostedt 
5623aaba20fSLi Zefan 	return ret;
563493762fcSSteven Rostedt }
564493762fcSSteven Rostedt 
565cafb168aSSteven Rostedt static void ftrace_profile_reset(struct ftrace_profile_stat *stat)
566493762fcSSteven Rostedt {
567493762fcSSteven Rostedt 	struct ftrace_profile_page *pg;
568493762fcSSteven Rostedt 
569cafb168aSSteven Rostedt 	pg = stat->pages = stat->start;
570493762fcSSteven Rostedt 
571493762fcSSteven Rostedt 	while (pg) {
572493762fcSSteven Rostedt 		memset(pg->records, 0, PROFILE_RECORDS_SIZE);
573493762fcSSteven Rostedt 		pg->index = 0;
574493762fcSSteven Rostedt 		pg = pg->next;
575493762fcSSteven Rostedt 	}
576493762fcSSteven Rostedt 
577cafb168aSSteven Rostedt 	memset(stat->hash, 0,
578493762fcSSteven Rostedt 	       FTRACE_PROFILE_HASH_SIZE * sizeof(struct hlist_head));
579493762fcSSteven Rostedt }
580493762fcSSteven Rostedt 
581172f7ba9Schongjiapeng static int ftrace_profile_pages_init(struct ftrace_profile_stat *stat)
582493762fcSSteven Rostedt {
583493762fcSSteven Rostedt 	struct ftrace_profile_page *pg;
584318e0a73SSteven Rostedt 	int functions;
585318e0a73SSteven Rostedt 	int pages;
586493762fcSSteven Rostedt 	int i;
587493762fcSSteven Rostedt 
588493762fcSSteven Rostedt 	/* If we already allocated, do nothing */
589cafb168aSSteven Rostedt 	if (stat->pages)
590493762fcSSteven Rostedt 		return 0;
591493762fcSSteven Rostedt 
592cafb168aSSteven Rostedt 	stat->pages = (void *)get_zeroed_page(GFP_KERNEL);
593cafb168aSSteven Rostedt 	if (!stat->pages)
594493762fcSSteven Rostedt 		return -ENOMEM;
595493762fcSSteven Rostedt 
596318e0a73SSteven Rostedt #ifdef CONFIG_DYNAMIC_FTRACE
597318e0a73SSteven Rostedt 	functions = ftrace_update_tot_cnt;
598318e0a73SSteven Rostedt #else
599318e0a73SSteven Rostedt 	/*
600318e0a73SSteven Rostedt 	 * We do not know the number of functions that exist because
601318e0a73SSteven Rostedt 	 * dynamic tracing is what counts them. With past experience
602318e0a73SSteven Rostedt 	 * we have around 20K functions. That should be more than enough.
603318e0a73SSteven Rostedt 	 * It is highly unlikely we will execute every function in
604318e0a73SSteven Rostedt 	 * the kernel.
605318e0a73SSteven Rostedt 	 */
606318e0a73SSteven Rostedt 	functions = 20000;
607318e0a73SSteven Rostedt #endif
608318e0a73SSteven Rostedt 
609cafb168aSSteven Rostedt 	pg = stat->start = stat->pages;
610493762fcSSteven Rostedt 
611318e0a73SSteven Rostedt 	pages = DIV_ROUND_UP(functions, PROFILES_PER_PAGE);
612318e0a73SSteven Rostedt 
61339e30cd1SNamhyung Kim 	for (i = 1; i < pages; i++) {
614493762fcSSteven Rostedt 		pg->next = (void *)get_zeroed_page(GFP_KERNEL);
615493762fcSSteven Rostedt 		if (!pg->next)
616318e0a73SSteven Rostedt 			goto out_free;
617493762fcSSteven Rostedt 		pg = pg->next;
618493762fcSSteven Rostedt 	}
619493762fcSSteven Rostedt 
620493762fcSSteven Rostedt 	return 0;
621318e0a73SSteven Rostedt 
622318e0a73SSteven Rostedt  out_free:
623318e0a73SSteven Rostedt 	pg = stat->start;
624318e0a73SSteven Rostedt 	while (pg) {
625318e0a73SSteven Rostedt 		unsigned long tmp = (unsigned long)pg;
626318e0a73SSteven Rostedt 
627318e0a73SSteven Rostedt 		pg = pg->next;
628318e0a73SSteven Rostedt 		free_page(tmp);
629318e0a73SSteven Rostedt 	}
630318e0a73SSteven Rostedt 
631318e0a73SSteven Rostedt 	stat->pages = NULL;
632318e0a73SSteven Rostedt 	stat->start = NULL;
633318e0a73SSteven Rostedt 
634318e0a73SSteven Rostedt 	return -ENOMEM;
635493762fcSSteven Rostedt }
636493762fcSSteven Rostedt 
637cafb168aSSteven Rostedt static int ftrace_profile_init_cpu(int cpu)
638493762fcSSteven Rostedt {
639cafb168aSSteven Rostedt 	struct ftrace_profile_stat *stat;
640493762fcSSteven Rostedt 	int size;
641493762fcSSteven Rostedt 
642cafb168aSSteven Rostedt 	stat = &per_cpu(ftrace_profile_stats, cpu);
643cafb168aSSteven Rostedt 
644cafb168aSSteven Rostedt 	if (stat->hash) {
645493762fcSSteven Rostedt 		/* If the profile is already created, simply reset it */
646cafb168aSSteven Rostedt 		ftrace_profile_reset(stat);
647493762fcSSteven Rostedt 		return 0;
648493762fcSSteven Rostedt 	}
649493762fcSSteven Rostedt 
650493762fcSSteven Rostedt 	/*
651493762fcSSteven Rostedt 	 * We are profiling all functions, but usually only a few thousand
652493762fcSSteven Rostedt 	 * functions are hit. We'll make a hash of 1024 items.
653493762fcSSteven Rostedt 	 */
654493762fcSSteven Rostedt 	size = FTRACE_PROFILE_HASH_SIZE;
655493762fcSSteven Rostedt 
6566396bb22SKees Cook 	stat->hash = kcalloc(size, sizeof(struct hlist_head), GFP_KERNEL);
657493762fcSSteven Rostedt 
658cafb168aSSteven Rostedt 	if (!stat->hash)
659493762fcSSteven Rostedt 		return -ENOMEM;
660493762fcSSteven Rostedt 
661318e0a73SSteven Rostedt 	/* Preallocate the function profiling pages */
662cafb168aSSteven Rostedt 	if (ftrace_profile_pages_init(stat) < 0) {
663cafb168aSSteven Rostedt 		kfree(stat->hash);
664cafb168aSSteven Rostedt 		stat->hash = NULL;
665493762fcSSteven Rostedt 		return -ENOMEM;
666493762fcSSteven Rostedt 	}
667493762fcSSteven Rostedt 
668493762fcSSteven Rostedt 	return 0;
669493762fcSSteven Rostedt }
670493762fcSSteven Rostedt 
671cafb168aSSteven Rostedt static int ftrace_profile_init(void)
672cafb168aSSteven Rostedt {
673cafb168aSSteven Rostedt 	int cpu;
674cafb168aSSteven Rostedt 	int ret = 0;
675cafb168aSSteven Rostedt 
676c4602c1cSMiao Xie 	for_each_possible_cpu(cpu) {
677cafb168aSSteven Rostedt 		ret = ftrace_profile_init_cpu(cpu);
678cafb168aSSteven Rostedt 		if (ret)
679cafb168aSSteven Rostedt 			break;
680cafb168aSSteven Rostedt 	}
681cafb168aSSteven Rostedt 
682cafb168aSSteven Rostedt 	return ret;
683cafb168aSSteven Rostedt }
684cafb168aSSteven Rostedt 
685493762fcSSteven Rostedt /* interrupts must be disabled */
686cafb168aSSteven Rostedt static struct ftrace_profile *
687cafb168aSSteven Rostedt ftrace_find_profiled_func(struct ftrace_profile_stat *stat, unsigned long ip)
688493762fcSSteven Rostedt {
689493762fcSSteven Rostedt 	struct ftrace_profile *rec;
690493762fcSSteven Rostedt 	struct hlist_head *hhd;
691493762fcSSteven Rostedt 	unsigned long key;
692493762fcSSteven Rostedt 
69320079ebeSNamhyung Kim 	key = hash_long(ip, FTRACE_PROFILE_HASH_BITS);
694cafb168aSSteven Rostedt 	hhd = &stat->hash[key];
695493762fcSSteven Rostedt 
696493762fcSSteven Rostedt 	if (hlist_empty(hhd))
697493762fcSSteven Rostedt 		return NULL;
698493762fcSSteven Rostedt 
6991bb539caSSteven Rostedt 	hlist_for_each_entry_rcu_notrace(rec, hhd, node) {
700493762fcSSteven Rostedt 		if (rec->ip == ip)
701493762fcSSteven Rostedt 			return rec;
702493762fcSSteven Rostedt 	}
703493762fcSSteven Rostedt 
704493762fcSSteven Rostedt 	return NULL;
705493762fcSSteven Rostedt }
706493762fcSSteven Rostedt 
707cafb168aSSteven Rostedt static void ftrace_add_profile(struct ftrace_profile_stat *stat,
708cafb168aSSteven Rostedt 			       struct ftrace_profile *rec)
709493762fcSSteven Rostedt {
710493762fcSSteven Rostedt 	unsigned long key;
711493762fcSSteven Rostedt 
71220079ebeSNamhyung Kim 	key = hash_long(rec->ip, FTRACE_PROFILE_HASH_BITS);
713cafb168aSSteven Rostedt 	hlist_add_head_rcu(&rec->node, &stat->hash[key]);
714493762fcSSteven Rostedt }
715493762fcSSteven Rostedt 
716318e0a73SSteven Rostedt /*
717318e0a73SSteven Rostedt  * The memory is already allocated, this simply finds a new record to use.
718318e0a73SSteven Rostedt  */
719493762fcSSteven Rostedt static struct ftrace_profile *
720318e0a73SSteven Rostedt ftrace_profile_alloc(struct ftrace_profile_stat *stat, unsigned long ip)
721493762fcSSteven Rostedt {
722493762fcSSteven Rostedt 	struct ftrace_profile *rec = NULL;
723493762fcSSteven Rostedt 
724318e0a73SSteven Rostedt 	/* prevent recursion (from NMIs) */
725cafb168aSSteven Rostedt 	if (atomic_inc_return(&stat->disabled) != 1)
726493762fcSSteven Rostedt 		goto out;
727493762fcSSteven Rostedt 
728493762fcSSteven Rostedt 	/*
729318e0a73SSteven Rostedt 	 * Try to find the function again since an NMI
730318e0a73SSteven Rostedt 	 * could have added it
731493762fcSSteven Rostedt 	 */
732cafb168aSSteven Rostedt 	rec = ftrace_find_profiled_func(stat, ip);
733493762fcSSteven Rostedt 	if (rec)
734cafb168aSSteven Rostedt 		goto out;
735493762fcSSteven Rostedt 
736cafb168aSSteven Rostedt 	if (stat->pages->index == PROFILES_PER_PAGE) {
737cafb168aSSteven Rostedt 		if (!stat->pages->next)
738cafb168aSSteven Rostedt 			goto out;
739cafb168aSSteven Rostedt 		stat->pages = stat->pages->next;
740493762fcSSteven Rostedt 	}
741493762fcSSteven Rostedt 
742cafb168aSSteven Rostedt 	rec = &stat->pages->records[stat->pages->index++];
743493762fcSSteven Rostedt 	rec->ip = ip;
744cafb168aSSteven Rostedt 	ftrace_add_profile(stat, rec);
745493762fcSSteven Rostedt 
746493762fcSSteven Rostedt  out:
747cafb168aSSteven Rostedt 	atomic_dec(&stat->disabled);
748493762fcSSteven Rostedt 
749493762fcSSteven Rostedt 	return rec;
750493762fcSSteven Rostedt }
751493762fcSSteven Rostedt 
752493762fcSSteven Rostedt static void
7532f5f6ad9SSteven Rostedt function_profile_call(unsigned long ip, unsigned long parent_ip,
754d19ad077SSteven Rostedt (VMware) 		      struct ftrace_ops *ops, struct ftrace_regs *fregs)
755493762fcSSteven Rostedt {
756cafb168aSSteven Rostedt 	struct ftrace_profile_stat *stat;
757493762fcSSteven Rostedt 	struct ftrace_profile *rec;
758493762fcSSteven Rostedt 	unsigned long flags;
759493762fcSSteven Rostedt 
760493762fcSSteven Rostedt 	if (!ftrace_profile_enabled)
761493762fcSSteven Rostedt 		return;
762493762fcSSteven Rostedt 
763493762fcSSteven Rostedt 	local_irq_save(flags);
764cafb168aSSteven Rostedt 
765bdffd893SChristoph Lameter 	stat = this_cpu_ptr(&ftrace_profile_stats);
7660f6ce3deSSteven Rostedt 	if (!stat->hash || !ftrace_profile_enabled)
767cafb168aSSteven Rostedt 		goto out;
768cafb168aSSteven Rostedt 
769cafb168aSSteven Rostedt 	rec = ftrace_find_profiled_func(stat, ip);
770493762fcSSteven Rostedt 	if (!rec) {
771318e0a73SSteven Rostedt 		rec = ftrace_profile_alloc(stat, ip);
772493762fcSSteven Rostedt 		if (!rec)
773493762fcSSteven Rostedt 			goto out;
774493762fcSSteven Rostedt 	}
775493762fcSSteven Rostedt 
776493762fcSSteven Rostedt 	rec->counter++;
777493762fcSSteven Rostedt  out:
778493762fcSSteven Rostedt 	local_irq_restore(flags);
779493762fcSSteven Rostedt }
780493762fcSSteven Rostedt 
7810706f1c4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
782e73e679fSSteven Rostedt (VMware) static bool fgraph_graph_time = true;
783e73e679fSSteven Rostedt (VMware) 
784e73e679fSSteven Rostedt (VMware) void ftrace_graph_graph_time_control(bool enable)
785e73e679fSSteven Rostedt (VMware) {
786e73e679fSSteven Rostedt (VMware) 	fgraph_graph_time = enable;
787e73e679fSSteven Rostedt (VMware) }
788e73e679fSSteven Rostedt (VMware) 
7890706f1c4SSteven Rostedt static int profile_graph_entry(struct ftrace_graph_ent *trace)
7900706f1c4SSteven Rostedt {
791b0e21a61SSteven Rostedt (VMware) 	struct ftrace_ret_stack *ret_stack;
7928861dd30SNamhyung Kim 
793a1e2e31dSSteven Rostedt 	function_profile_call(trace->func, 0, NULL, NULL);
7948861dd30SNamhyung Kim 
795a8f0f9e4SSteven Rostedt (VMware) 	/* If function graph is shutting down, ret_stack can be NULL */
796a8f0f9e4SSteven Rostedt (VMware) 	if (!current->ret_stack)
797a8f0f9e4SSteven Rostedt (VMware) 		return 0;
798a8f0f9e4SSteven Rostedt (VMware) 
799b0e21a61SSteven Rostedt (VMware) 	ret_stack = ftrace_graph_get_ret_stack(current, 0);
800b0e21a61SSteven Rostedt (VMware) 	if (ret_stack)
801b0e21a61SSteven Rostedt (VMware) 		ret_stack->subtime = 0;
8028861dd30SNamhyung Kim 
8030706f1c4SSteven Rostedt 	return 1;
8040706f1c4SSteven Rostedt }
8050706f1c4SSteven Rostedt 
8060706f1c4SSteven Rostedt static void profile_graph_return(struct ftrace_graph_ret *trace)
8070706f1c4SSteven Rostedt {
808b0e21a61SSteven Rostedt (VMware) 	struct ftrace_ret_stack *ret_stack;
809cafb168aSSteven Rostedt 	struct ftrace_profile_stat *stat;
810a2a16d6aSSteven Rostedt 	unsigned long long calltime;
8110706f1c4SSteven Rostedt 	struct ftrace_profile *rec;
812cafb168aSSteven Rostedt 	unsigned long flags;
8130706f1c4SSteven Rostedt 
8140706f1c4SSteven Rostedt 	local_irq_save(flags);
815bdffd893SChristoph Lameter 	stat = this_cpu_ptr(&ftrace_profile_stats);
8160f6ce3deSSteven Rostedt 	if (!stat->hash || !ftrace_profile_enabled)
817cafb168aSSteven Rostedt 		goto out;
818cafb168aSSteven Rostedt 
81937e44bc5SSteven Rostedt 	/* If the calltime was zero'd ignore it */
82037e44bc5SSteven Rostedt 	if (!trace->calltime)
82137e44bc5SSteven Rostedt 		goto out;
82237e44bc5SSteven Rostedt 
823a2a16d6aSSteven Rostedt 	calltime = trace->rettime - trace->calltime;
824a2a16d6aSSteven Rostedt 
82555577204SSteven Rostedt (Red Hat) 	if (!fgraph_graph_time) {
826a2a16d6aSSteven Rostedt 
827a2a16d6aSSteven Rostedt 		/* Append this call time to the parent time to subtract */
828b0e21a61SSteven Rostedt (VMware) 		ret_stack = ftrace_graph_get_ret_stack(current, 1);
829b0e21a61SSteven Rostedt (VMware) 		if (ret_stack)
830b0e21a61SSteven Rostedt (VMware) 			ret_stack->subtime += calltime;
831a2a16d6aSSteven Rostedt 
832b0e21a61SSteven Rostedt (VMware) 		ret_stack = ftrace_graph_get_ret_stack(current, 0);
833b0e21a61SSteven Rostedt (VMware) 		if (ret_stack && ret_stack->subtime < calltime)
834b0e21a61SSteven Rostedt (VMware) 			calltime -= ret_stack->subtime;
835a2a16d6aSSteven Rostedt 		else
836a2a16d6aSSteven Rostedt 			calltime = 0;
837a2a16d6aSSteven Rostedt 	}
838a2a16d6aSSteven Rostedt 
839cafb168aSSteven Rostedt 	rec = ftrace_find_profiled_func(stat, trace->func);
840e330b3bcSChase Douglas 	if (rec) {
841a2a16d6aSSteven Rostedt 		rec->time += calltime;
842e330b3bcSChase Douglas 		rec->time_squared += calltime * calltime;
843e330b3bcSChase Douglas 	}
844a2a16d6aSSteven Rostedt 
845cafb168aSSteven Rostedt  out:
8460706f1c4SSteven Rostedt 	local_irq_restore(flags);
8470706f1c4SSteven Rostedt }
8480706f1c4SSteven Rostedt 
849688f7089SSteven Rostedt (VMware) static struct fgraph_ops fprofiler_ops = {
850688f7089SSteven Rostedt (VMware) 	.entryfunc = &profile_graph_entry,
851688f7089SSteven Rostedt (VMware) 	.retfunc = &profile_graph_return,
852688f7089SSteven Rostedt (VMware) };
853688f7089SSteven Rostedt (VMware) 
8540706f1c4SSteven Rostedt static int register_ftrace_profiler(void)
8550706f1c4SSteven Rostedt {
856688f7089SSteven Rostedt (VMware) 	return register_ftrace_graph(&fprofiler_ops);
8570706f1c4SSteven Rostedt }
8580706f1c4SSteven Rostedt 
8590706f1c4SSteven Rostedt static void unregister_ftrace_profiler(void)
8600706f1c4SSteven Rostedt {
861688f7089SSteven Rostedt (VMware) 	unregister_ftrace_graph(&fprofiler_ops);
8620706f1c4SSteven Rostedt }
8630706f1c4SSteven Rostedt #else
864bd38c0e6SPaul McQuade static struct ftrace_ops ftrace_profile_ops __read_mostly = {
865493762fcSSteven Rostedt 	.func		= function_profile_call,
866a25d036dSSteven Rostedt (VMware) 	.flags		= FTRACE_OPS_FL_INITIALIZED,
86733b7f99cSSteven Rostedt (Red Hat) 	INIT_OPS_HASH(ftrace_profile_ops)
868493762fcSSteven Rostedt };
869493762fcSSteven Rostedt 
8700706f1c4SSteven Rostedt static int register_ftrace_profiler(void)
8710706f1c4SSteven Rostedt {
8720706f1c4SSteven Rostedt 	return register_ftrace_function(&ftrace_profile_ops);
8730706f1c4SSteven Rostedt }
8740706f1c4SSteven Rostedt 
8750706f1c4SSteven Rostedt static void unregister_ftrace_profiler(void)
8760706f1c4SSteven Rostedt {
8770706f1c4SSteven Rostedt 	unregister_ftrace_function(&ftrace_profile_ops);
8780706f1c4SSteven Rostedt }
8790706f1c4SSteven Rostedt #endif /* CONFIG_FUNCTION_GRAPH_TRACER */
8800706f1c4SSteven Rostedt 
881493762fcSSteven Rostedt static ssize_t
882493762fcSSteven Rostedt ftrace_profile_write(struct file *filp, const char __user *ubuf,
883493762fcSSteven Rostedt 		     size_t cnt, loff_t *ppos)
884493762fcSSteven Rostedt {
885493762fcSSteven Rostedt 	unsigned long val;
886493762fcSSteven Rostedt 	int ret;
887493762fcSSteven Rostedt 
88822fe9b54SPeter Huewe 	ret = kstrtoul_from_user(ubuf, cnt, 10, &val);
88922fe9b54SPeter Huewe 	if (ret)
890493762fcSSteven Rostedt 		return ret;
891493762fcSSteven Rostedt 
892493762fcSSteven Rostedt 	val = !!val;
893493762fcSSteven Rostedt 
894493762fcSSteven Rostedt 	mutex_lock(&ftrace_profile_lock);
895493762fcSSteven Rostedt 	if (ftrace_profile_enabled ^ val) {
896493762fcSSteven Rostedt 		if (val) {
897493762fcSSteven Rostedt 			ret = ftrace_profile_init();
898493762fcSSteven Rostedt 			if (ret < 0) {
899493762fcSSteven Rostedt 				cnt = ret;
900493762fcSSteven Rostedt 				goto out;
901493762fcSSteven Rostedt 			}
902493762fcSSteven Rostedt 
9030706f1c4SSteven Rostedt 			ret = register_ftrace_profiler();
9040706f1c4SSteven Rostedt 			if (ret < 0) {
9050706f1c4SSteven Rostedt 				cnt = ret;
9060706f1c4SSteven Rostedt 				goto out;
9070706f1c4SSteven Rostedt 			}
908493762fcSSteven Rostedt 			ftrace_profile_enabled = 1;
909493762fcSSteven Rostedt 		} else {
910493762fcSSteven Rostedt 			ftrace_profile_enabled = 0;
9110f6ce3deSSteven Rostedt 			/*
9120f6ce3deSSteven Rostedt 			 * unregister_ftrace_profiler calls stop_machine
91374401729SPaul E. McKenney 			 * so this acts like an synchronize_rcu.
9140f6ce3deSSteven Rostedt 			 */
9150706f1c4SSteven Rostedt 			unregister_ftrace_profiler();
916493762fcSSteven Rostedt 		}
917493762fcSSteven Rostedt 	}
918493762fcSSteven Rostedt  out:
919493762fcSSteven Rostedt 	mutex_unlock(&ftrace_profile_lock);
920493762fcSSteven Rostedt 
921cf8517cfSJiri Olsa 	*ppos += cnt;
922493762fcSSteven Rostedt 
923493762fcSSteven Rostedt 	return cnt;
924493762fcSSteven Rostedt }
925493762fcSSteven Rostedt 
926493762fcSSteven Rostedt static ssize_t
927493762fcSSteven Rostedt ftrace_profile_read(struct file *filp, char __user *ubuf,
928493762fcSSteven Rostedt 		     size_t cnt, loff_t *ppos)
929493762fcSSteven Rostedt {
930fb9fb015SSteven Rostedt 	char buf[64];		/* big enough to hold a number */
931493762fcSSteven Rostedt 	int r;
932493762fcSSteven Rostedt 
933493762fcSSteven Rostedt 	r = sprintf(buf, "%u\n", ftrace_profile_enabled);
934493762fcSSteven Rostedt 	return simple_read_from_buffer(ubuf, cnt, ppos, buf, r);
935493762fcSSteven Rostedt }
936493762fcSSteven Rostedt 
937493762fcSSteven Rostedt static const struct file_operations ftrace_profile_fops = {
938493762fcSSteven Rostedt 	.open		= tracing_open_generic,
939493762fcSSteven Rostedt 	.read		= ftrace_profile_read,
940493762fcSSteven Rostedt 	.write		= ftrace_profile_write,
9416038f373SArnd Bergmann 	.llseek		= default_llseek,
942493762fcSSteven Rostedt };
943493762fcSSteven Rostedt 
944cafb168aSSteven Rostedt /* used to initialize the real stat files */
945cafb168aSSteven Rostedt static struct tracer_stat function_stats __initdata = {
946cafb168aSSteven Rostedt 	.name		= "functions",
947cafb168aSSteven Rostedt 	.stat_start	= function_stat_start,
948cafb168aSSteven Rostedt 	.stat_next	= function_stat_next,
949cafb168aSSteven Rostedt 	.stat_cmp	= function_stat_cmp,
950cafb168aSSteven Rostedt 	.stat_headers	= function_stat_headers,
951cafb168aSSteven Rostedt 	.stat_show	= function_stat_show
952cafb168aSSteven Rostedt };
953cafb168aSSteven Rostedt 
9548434dc93SSteven Rostedt (Red Hat) static __init void ftrace_profile_tracefs(struct dentry *d_tracer)
955493762fcSSteven Rostedt {
956cafb168aSSteven Rostedt 	struct ftrace_profile_stat *stat;
957cafb168aSSteven Rostedt 	char *name;
958493762fcSSteven Rostedt 	int ret;
959cafb168aSSteven Rostedt 	int cpu;
960493762fcSSteven Rostedt 
961cafb168aSSteven Rostedt 	for_each_possible_cpu(cpu) {
962cafb168aSSteven Rostedt 		stat = &per_cpu(ftrace_profile_stats, cpu);
963cafb168aSSteven Rostedt 
9646363c6b5SGeliang Tang 		name = kasprintf(GFP_KERNEL, "function%d", cpu);
965cafb168aSSteven Rostedt 		if (!name) {
966cafb168aSSteven Rostedt 			/*
967cafb168aSSteven Rostedt 			 * The files created are permanent, if something happens
968cafb168aSSteven Rostedt 			 * we still do not free memory.
969cafb168aSSteven Rostedt 			 */
970cafb168aSSteven Rostedt 			WARN(1,
971cafb168aSSteven Rostedt 			     "Could not allocate stat file for cpu %d\n",
972cafb168aSSteven Rostedt 			     cpu);
973493762fcSSteven Rostedt 			return;
974493762fcSSteven Rostedt 		}
975cafb168aSSteven Rostedt 		stat->stat = function_stats;
976cafb168aSSteven Rostedt 		stat->stat.name = name;
977cafb168aSSteven Rostedt 		ret = register_stat_tracer(&stat->stat);
978cafb168aSSteven Rostedt 		if (ret) {
979cafb168aSSteven Rostedt 			WARN(1,
980cafb168aSSteven Rostedt 			     "Could not register function stat for cpu %d\n",
981cafb168aSSteven Rostedt 			     cpu);
982cafb168aSSteven Rostedt 			kfree(name);
983cafb168aSSteven Rostedt 			return;
984cafb168aSSteven Rostedt 		}
985cafb168aSSteven Rostedt 	}
986493762fcSSteven Rostedt 
987e4931b82SYuntao Wang 	trace_create_file("function_profile_enabled",
98821ccc9cdSSteven Rostedt (VMware) 			  TRACE_MODE_WRITE, d_tracer, NULL,
98921ccc9cdSSteven Rostedt (VMware) 			  &ftrace_profile_fops);
990493762fcSSteven Rostedt }
991493762fcSSteven Rostedt 
992493762fcSSteven Rostedt #else /* CONFIG_FUNCTION_PROFILER */
9938434dc93SSteven Rostedt (Red Hat) static __init void ftrace_profile_tracefs(struct dentry *d_tracer)
994493762fcSSteven Rostedt {
995493762fcSSteven Rostedt }
996493762fcSSteven Rostedt #endif /* CONFIG_FUNCTION_PROFILER */
997493762fcSSteven Rostedt 
9983d083395SSteven Rostedt #ifdef CONFIG_DYNAMIC_FTRACE
99973d3fd96SIngo Molnar 
100079922b80SSteven Rostedt (Red Hat) static struct ftrace_ops *removed_ops;
100179922b80SSteven Rostedt (Red Hat) 
1002e1effa01SSteven Rostedt (Red Hat) /*
1003e1effa01SSteven Rostedt (Red Hat)  * Set when doing a global update, like enabling all recs or disabling them.
1004e1effa01SSteven Rostedt (Red Hat)  * It is not set when just updating a single ftrace_ops.
1005e1effa01SSteven Rostedt (Red Hat)  */
1006e1effa01SSteven Rostedt (Red Hat) static bool update_all_ops;
1007e1effa01SSteven Rostedt (Red Hat) 
100899ecdc43SSteven Rostedt #ifndef CONFIG_FTRACE_MCOUNT_RECORD
1009cb7be3b2SSteven Rostedt # error Dynamic ftrace depends on MCOUNT_RECORD
101099ecdc43SSteven Rostedt #endif
101199ecdc43SSteven Rostedt 
10127b60f3d8SSteven Rostedt (VMware) struct ftrace_func_probe {
10137b60f3d8SSteven Rostedt (VMware) 	struct ftrace_probe_ops	*probe_ops;
10147b60f3d8SSteven Rostedt (VMware) 	struct ftrace_ops	ops;
10157b60f3d8SSteven Rostedt (VMware) 	struct trace_array	*tr;
10167b60f3d8SSteven Rostedt (VMware) 	struct list_head	list;
10176e444319SSteven Rostedt (VMware) 	void			*data;
10187b60f3d8SSteven Rostedt (VMware) 	int			ref;
10197b60f3d8SSteven Rostedt (VMware) };
10207b60f3d8SSteven Rostedt (VMware) 
102133dc9b12SSteven Rostedt /*
102233dc9b12SSteven Rostedt  * We make these constant because no one should touch them,
102333dc9b12SSteven Rostedt  * but they are used as the default "empty hash", to avoid allocating
102433dc9b12SSteven Rostedt  * it all the time. These are in a read only section such that if
102533dc9b12SSteven Rostedt  * anyone does try to modify it, it will cause an exception.
102633dc9b12SSteven Rostedt  */
102733dc9b12SSteven Rostedt static const struct hlist_head empty_buckets[1];
102833dc9b12SSteven Rostedt static const struct ftrace_hash empty_hash = {
102933dc9b12SSteven Rostedt 	.buckets = (struct hlist_head *)empty_buckets,
1030b448c4e3SSteven Rostedt };
103133dc9b12SSteven Rostedt #define EMPTY_HASH	((struct ftrace_hash *)&empty_hash)
10325072c59fSSteven Rostedt 
10333306fc4aSSteven Rostedt (VMware) struct ftrace_ops global_ops = {
1034f45948e8SSteven Rostedt 	.func				= ftrace_stub,
103533b7f99cSSteven Rostedt (Red Hat) 	.local_hash.notrace_hash	= EMPTY_HASH,
103633b7f99cSSteven Rostedt (Red Hat) 	.local_hash.filter_hash		= EMPTY_HASH,
103733b7f99cSSteven Rostedt (Red Hat) 	INIT_OPS_HASH(global_ops)
1038a25d036dSSteven Rostedt (VMware) 	.flags				= FTRACE_OPS_FL_INITIALIZED |
1039e3eea140SSteven Rostedt (Red Hat) 					  FTRACE_OPS_FL_PID,
1040f45948e8SSteven Rostedt };
1041f45948e8SSteven Rostedt 
1042aec0be2dSSteven Rostedt (Red Hat) /*
1043f2cc020dSIngo Molnar  * Used by the stack unwinder to know about dynamic ftrace trampolines.
1044aec0be2dSSteven Rostedt (Red Hat)  */
10456be7fa3cSSteven Rostedt (VMware) struct ftrace_ops *ftrace_ops_trampoline(unsigned long addr)
1046aec0be2dSSteven Rostedt (Red Hat) {
10476be7fa3cSSteven Rostedt (VMware) 	struct ftrace_ops *op = NULL;
1048aec0be2dSSteven Rostedt (Red Hat) 
1049aec0be2dSSteven Rostedt (Red Hat) 	/*
1050aec0be2dSSteven Rostedt (Red Hat) 	 * Some of the ops may be dynamically allocated,
105174401729SPaul E. McKenney 	 * they are freed after a synchronize_rcu().
1052aec0be2dSSteven Rostedt (Red Hat) 	 */
1053aec0be2dSSteven Rostedt (Red Hat) 	preempt_disable_notrace();
1054aec0be2dSSteven Rostedt (Red Hat) 
1055aec0be2dSSteven Rostedt (Red Hat) 	do_for_each_ftrace_op(op, ftrace_ops_list) {
1056aec0be2dSSteven Rostedt (Red Hat) 		/*
1057aec0be2dSSteven Rostedt (Red Hat) 		 * This is to check for dynamically allocated trampolines.
1058aec0be2dSSteven Rostedt (Red Hat) 		 * Trampolines that are in kernel text will have
1059aec0be2dSSteven Rostedt (Red Hat) 		 * core_kernel_text() return true.
1060aec0be2dSSteven Rostedt (Red Hat) 		 */
1061aec0be2dSSteven Rostedt (Red Hat) 		if (op->trampoline && op->trampoline_size)
1062aec0be2dSSteven Rostedt (Red Hat) 			if (addr >= op->trampoline &&
1063aec0be2dSSteven Rostedt (Red Hat) 			    addr < op->trampoline + op->trampoline_size) {
10646be7fa3cSSteven Rostedt (VMware) 				preempt_enable_notrace();
10656be7fa3cSSteven Rostedt (VMware) 				return op;
1066aec0be2dSSteven Rostedt (Red Hat) 			}
1067aec0be2dSSteven Rostedt (Red Hat) 	} while_for_each_ftrace_op(op);
1068aec0be2dSSteven Rostedt (Red Hat) 	preempt_enable_notrace();
1069aec0be2dSSteven Rostedt (Red Hat) 
10706be7fa3cSSteven Rostedt (VMware) 	return NULL;
10716be7fa3cSSteven Rostedt (VMware) }
10726be7fa3cSSteven Rostedt (VMware) 
10736be7fa3cSSteven Rostedt (VMware) /*
10746be7fa3cSSteven Rostedt (VMware)  * This is used by __kernel_text_address() to return true if the
10756be7fa3cSSteven Rostedt (VMware)  * address is on a dynamically allocated trampoline that would
10766be7fa3cSSteven Rostedt (VMware)  * not return true for either core_kernel_text() or
10776be7fa3cSSteven Rostedt (VMware)  * is_module_text_address().
10786be7fa3cSSteven Rostedt (VMware)  */
10796be7fa3cSSteven Rostedt (VMware) bool is_ftrace_trampoline(unsigned long addr)
10806be7fa3cSSteven Rostedt (VMware) {
10816be7fa3cSSteven Rostedt (VMware) 	return ftrace_ops_trampoline(addr) != NULL;
1082aec0be2dSSteven Rostedt (Red Hat) }
1083aec0be2dSSteven Rostedt (Red Hat) 
10843c1720f0SSteven Rostedt struct ftrace_page {
10853c1720f0SSteven Rostedt 	struct ftrace_page	*next;
1086a7900875SSteven Rostedt 	struct dyn_ftrace	*records;
1087431aa3fbSSteven Rostedt 	int			index;
1088db42523bSLinus Torvalds 	int			order;
1089aa5e5ceaSDavid Miller };
10903c1720f0SSteven Rostedt 
1091a7900875SSteven Rostedt #define ENTRY_SIZE sizeof(struct dyn_ftrace)
1092a7900875SSteven Rostedt #define ENTRIES_PER_PAGE (PAGE_SIZE / ENTRY_SIZE)
10933c1720f0SSteven Rostedt 
10943c1720f0SSteven Rostedt static struct ftrace_page	*ftrace_pages_start;
10953c1720f0SSteven Rostedt static struct ftrace_page	*ftrace_pages;
10963c1720f0SSteven Rostedt 
10972b0cce0eSSteven Rostedt (VMware) static __always_inline unsigned long
10982b0cce0eSSteven Rostedt (VMware) ftrace_hash_key(struct ftrace_hash *hash, unsigned long ip)
10992b0cce0eSSteven Rostedt (VMware) {
11002b0cce0eSSteven Rostedt (VMware) 	if (hash->size_bits > 0)
11012b0cce0eSSteven Rostedt (VMware) 		return hash_long(ip, hash->size_bits);
11022b0cce0eSSteven Rostedt (VMware) 
11032b0cce0eSSteven Rostedt (VMware) 	return 0;
11042b0cce0eSSteven Rostedt (VMware) }
11052b0cce0eSSteven Rostedt (VMware) 
11062b2c279cSSteven Rostedt (VMware) /* Only use this function if ftrace_hash_empty() has already been tested */
11072b2c279cSSteven Rostedt (VMware) static __always_inline struct ftrace_func_entry *
11082b2c279cSSteven Rostedt (VMware) __ftrace_lookup_ip(struct ftrace_hash *hash, unsigned long ip)
1109b448c4e3SSteven Rostedt {
1110b448c4e3SSteven Rostedt 	unsigned long key;
1111b448c4e3SSteven Rostedt 	struct ftrace_func_entry *entry;
1112b448c4e3SSteven Rostedt 	struct hlist_head *hhd;
1113b448c4e3SSteven Rostedt 
11142b0cce0eSSteven Rostedt (VMware) 	key = ftrace_hash_key(hash, ip);
1115b448c4e3SSteven Rostedt 	hhd = &hash->buckets[key];
1116b448c4e3SSteven Rostedt 
11171bb539caSSteven Rostedt 	hlist_for_each_entry_rcu_notrace(entry, hhd, hlist) {
1118b448c4e3SSteven Rostedt 		if (entry->ip == ip)
1119b448c4e3SSteven Rostedt 			return entry;
1120b448c4e3SSteven Rostedt 	}
1121b448c4e3SSteven Rostedt 	return NULL;
1122b448c4e3SSteven Rostedt }
1123b448c4e3SSteven Rostedt 
11242b2c279cSSteven Rostedt (VMware) /**
11252b2c279cSSteven Rostedt (VMware)  * ftrace_lookup_ip - Test to see if an ip exists in an ftrace_hash
11262b2c279cSSteven Rostedt (VMware)  * @hash: The hash to look at
11272b2c279cSSteven Rostedt (VMware)  * @ip: The instruction pointer to test
11282b2c279cSSteven Rostedt (VMware)  *
11292b2c279cSSteven Rostedt (VMware)  * Search a given @hash to see if a given instruction pointer (@ip)
11302b2c279cSSteven Rostedt (VMware)  * exists in it.
11312b2c279cSSteven Rostedt (VMware)  *
11322b2c279cSSteven Rostedt (VMware)  * Returns the entry that holds the @ip if found. NULL otherwise.
11332b2c279cSSteven Rostedt (VMware)  */
11342b2c279cSSteven Rostedt (VMware) struct ftrace_func_entry *
11352b2c279cSSteven Rostedt (VMware) ftrace_lookup_ip(struct ftrace_hash *hash, unsigned long ip)
11362b2c279cSSteven Rostedt (VMware) {
11372b2c279cSSteven Rostedt (VMware) 	if (ftrace_hash_empty(hash))
11382b2c279cSSteven Rostedt (VMware) 		return NULL;
11392b2c279cSSteven Rostedt (VMware) 
11402b2c279cSSteven Rostedt (VMware) 	return __ftrace_lookup_ip(hash, ip);
11412b2c279cSSteven Rostedt (VMware) }
11422b2c279cSSteven Rostedt (VMware) 
114333dc9b12SSteven Rostedt static void __add_hash_entry(struct ftrace_hash *hash,
114433dc9b12SSteven Rostedt 			     struct ftrace_func_entry *entry)
114533dc9b12SSteven Rostedt {
114633dc9b12SSteven Rostedt 	struct hlist_head *hhd;
114733dc9b12SSteven Rostedt 	unsigned long key;
114833dc9b12SSteven Rostedt 
11492b0cce0eSSteven Rostedt (VMware) 	key = ftrace_hash_key(hash, entry->ip);
115033dc9b12SSteven Rostedt 	hhd = &hash->buckets[key];
115133dc9b12SSteven Rostedt 	hlist_add_head(&entry->hlist, hhd);
115233dc9b12SSteven Rostedt 	hash->count++;
115333dc9b12SSteven Rostedt }
115433dc9b12SSteven Rostedt 
1155b448c4e3SSteven Rostedt static int add_hash_entry(struct ftrace_hash *hash, unsigned long ip)
1156b448c4e3SSteven Rostedt {
1157b448c4e3SSteven Rostedt 	struct ftrace_func_entry *entry;
1158b448c4e3SSteven Rostedt 
1159b448c4e3SSteven Rostedt 	entry = kmalloc(sizeof(*entry), GFP_KERNEL);
1160b448c4e3SSteven Rostedt 	if (!entry)
1161b448c4e3SSteven Rostedt 		return -ENOMEM;
1162b448c4e3SSteven Rostedt 
1163b448c4e3SSteven Rostedt 	entry->ip = ip;
116433dc9b12SSteven Rostedt 	__add_hash_entry(hash, entry);
1165b448c4e3SSteven Rostedt 
1166b448c4e3SSteven Rostedt 	return 0;
1167b448c4e3SSteven Rostedt }
1168b448c4e3SSteven Rostedt 
1169b448c4e3SSteven Rostedt static void
117033dc9b12SSteven Rostedt free_hash_entry(struct ftrace_hash *hash,
117133dc9b12SSteven Rostedt 		  struct ftrace_func_entry *entry)
117233dc9b12SSteven Rostedt {
117333dc9b12SSteven Rostedt 	hlist_del(&entry->hlist);
117433dc9b12SSteven Rostedt 	kfree(entry);
117533dc9b12SSteven Rostedt 	hash->count--;
117633dc9b12SSteven Rostedt }
117733dc9b12SSteven Rostedt 
117833dc9b12SSteven Rostedt static void
1179b448c4e3SSteven Rostedt remove_hash_entry(struct ftrace_hash *hash,
1180b448c4e3SSteven Rostedt 		  struct ftrace_func_entry *entry)
1181b448c4e3SSteven Rostedt {
1182eee8ded1SSteven Rostedt (VMware) 	hlist_del_rcu(&entry->hlist);
1183b448c4e3SSteven Rostedt 	hash->count--;
1184b448c4e3SSteven Rostedt }
1185b448c4e3SSteven Rostedt 
1186b448c4e3SSteven Rostedt static void ftrace_hash_clear(struct ftrace_hash *hash)
1187b448c4e3SSteven Rostedt {
1188b448c4e3SSteven Rostedt 	struct hlist_head *hhd;
1189b67bfe0dSSasha Levin 	struct hlist_node *tn;
1190b448c4e3SSteven Rostedt 	struct ftrace_func_entry *entry;
1191b448c4e3SSteven Rostedt 	int size = 1 << hash->size_bits;
1192b448c4e3SSteven Rostedt 	int i;
1193b448c4e3SSteven Rostedt 
119433dc9b12SSteven Rostedt 	if (!hash->count)
119533dc9b12SSteven Rostedt 		return;
119633dc9b12SSteven Rostedt 
1197b448c4e3SSteven Rostedt 	for (i = 0; i < size; i++) {
1198b448c4e3SSteven Rostedt 		hhd = &hash->buckets[i];
1199b67bfe0dSSasha Levin 		hlist_for_each_entry_safe(entry, tn, hhd, hlist)
120033dc9b12SSteven Rostedt 			free_hash_entry(hash, entry);
1201b448c4e3SSteven Rostedt 	}
1202b448c4e3SSteven Rostedt 	FTRACE_WARN_ON(hash->count);
1203b448c4e3SSteven Rostedt }
1204b448c4e3SSteven Rostedt 
1205673feb9dSSteven Rostedt (VMware) static void free_ftrace_mod(struct ftrace_mod_load *ftrace_mod)
1206673feb9dSSteven Rostedt (VMware) {
1207673feb9dSSteven Rostedt (VMware) 	list_del(&ftrace_mod->list);
1208673feb9dSSteven Rostedt (VMware) 	kfree(ftrace_mod->module);
1209673feb9dSSteven Rostedt (VMware) 	kfree(ftrace_mod->func);
1210673feb9dSSteven Rostedt (VMware) 	kfree(ftrace_mod);
1211673feb9dSSteven Rostedt (VMware) }
1212673feb9dSSteven Rostedt (VMware) 
1213673feb9dSSteven Rostedt (VMware) static void clear_ftrace_mod_list(struct list_head *head)
1214673feb9dSSteven Rostedt (VMware) {
1215673feb9dSSteven Rostedt (VMware) 	struct ftrace_mod_load *p, *n;
1216673feb9dSSteven Rostedt (VMware) 
1217673feb9dSSteven Rostedt (VMware) 	/* stack tracer isn't supported yet */
1218673feb9dSSteven Rostedt (VMware) 	if (!head)
1219673feb9dSSteven Rostedt (VMware) 		return;
1220673feb9dSSteven Rostedt (VMware) 
1221673feb9dSSteven Rostedt (VMware) 	mutex_lock(&ftrace_lock);
1222673feb9dSSteven Rostedt (VMware) 	list_for_each_entry_safe(p, n, head, list)
1223673feb9dSSteven Rostedt (VMware) 		free_ftrace_mod(p);
1224673feb9dSSteven Rostedt (VMware) 	mutex_unlock(&ftrace_lock);
1225673feb9dSSteven Rostedt (VMware) }
1226673feb9dSSteven Rostedt (VMware) 
122733dc9b12SSteven Rostedt static void free_ftrace_hash(struct ftrace_hash *hash)
122833dc9b12SSteven Rostedt {
122933dc9b12SSteven Rostedt 	if (!hash || hash == EMPTY_HASH)
123033dc9b12SSteven Rostedt 		return;
123133dc9b12SSteven Rostedt 	ftrace_hash_clear(hash);
123233dc9b12SSteven Rostedt 	kfree(hash->buckets);
123333dc9b12SSteven Rostedt 	kfree(hash);
123433dc9b12SSteven Rostedt }
123533dc9b12SSteven Rostedt 
123607fd5515SSteven Rostedt static void __free_ftrace_hash_rcu(struct rcu_head *rcu)
123707fd5515SSteven Rostedt {
123807fd5515SSteven Rostedt 	struct ftrace_hash *hash;
123907fd5515SSteven Rostedt 
124007fd5515SSteven Rostedt 	hash = container_of(rcu, struct ftrace_hash, rcu);
124107fd5515SSteven Rostedt 	free_ftrace_hash(hash);
124207fd5515SSteven Rostedt }
124307fd5515SSteven Rostedt 
124407fd5515SSteven Rostedt static void free_ftrace_hash_rcu(struct ftrace_hash *hash)
124507fd5515SSteven Rostedt {
124607fd5515SSteven Rostedt 	if (!hash || hash == EMPTY_HASH)
124707fd5515SSteven Rostedt 		return;
124874401729SPaul E. McKenney 	call_rcu(&hash->rcu, __free_ftrace_hash_rcu);
124907fd5515SSteven Rostedt }
125007fd5515SSteven Rostedt 
12515500fa51SJiri Olsa void ftrace_free_filter(struct ftrace_ops *ops)
12525500fa51SJiri Olsa {
1253f04f24fbSMasami Hiramatsu 	ftrace_ops_init(ops);
125433b7f99cSSteven Rostedt (Red Hat) 	free_ftrace_hash(ops->func_hash->filter_hash);
125533b7f99cSSteven Rostedt (Red Hat) 	free_ftrace_hash(ops->func_hash->notrace_hash);
12565500fa51SJiri Olsa }
12575500fa51SJiri Olsa 
125833dc9b12SSteven Rostedt static struct ftrace_hash *alloc_ftrace_hash(int size_bits)
125933dc9b12SSteven Rostedt {
126033dc9b12SSteven Rostedt 	struct ftrace_hash *hash;
126133dc9b12SSteven Rostedt 	int size;
126233dc9b12SSteven Rostedt 
126333dc9b12SSteven Rostedt 	hash = kzalloc(sizeof(*hash), GFP_KERNEL);
126433dc9b12SSteven Rostedt 	if (!hash)
126533dc9b12SSteven Rostedt 		return NULL;
126633dc9b12SSteven Rostedt 
126733dc9b12SSteven Rostedt 	size = 1 << size_bits;
126847b0edcbSThomas Meyer 	hash->buckets = kcalloc(size, sizeof(*hash->buckets), GFP_KERNEL);
126933dc9b12SSteven Rostedt 
127033dc9b12SSteven Rostedt 	if (!hash->buckets) {
127133dc9b12SSteven Rostedt 		kfree(hash);
127233dc9b12SSteven Rostedt 		return NULL;
127333dc9b12SSteven Rostedt 	}
127433dc9b12SSteven Rostedt 
127533dc9b12SSteven Rostedt 	hash->size_bits = size_bits;
127633dc9b12SSteven Rostedt 
127733dc9b12SSteven Rostedt 	return hash;
127833dc9b12SSteven Rostedt }
127933dc9b12SSteven Rostedt 
1280673feb9dSSteven Rostedt (VMware) 
1281673feb9dSSteven Rostedt (VMware) static int ftrace_add_mod(struct trace_array *tr,
1282673feb9dSSteven Rostedt (VMware) 			  const char *func, const char *module,
1283673feb9dSSteven Rostedt (VMware) 			  int enable)
1284673feb9dSSteven Rostedt (VMware) {
1285673feb9dSSteven Rostedt (VMware) 	struct ftrace_mod_load *ftrace_mod;
1286673feb9dSSteven Rostedt (VMware) 	struct list_head *mod_head = enable ? &tr->mod_trace : &tr->mod_notrace;
1287673feb9dSSteven Rostedt (VMware) 
1288673feb9dSSteven Rostedt (VMware) 	ftrace_mod = kzalloc(sizeof(*ftrace_mod), GFP_KERNEL);
1289673feb9dSSteven Rostedt (VMware) 	if (!ftrace_mod)
1290673feb9dSSteven Rostedt (VMware) 		return -ENOMEM;
1291673feb9dSSteven Rostedt (VMware) 
1292673feb9dSSteven Rostedt (VMware) 	ftrace_mod->func = kstrdup(func, GFP_KERNEL);
1293673feb9dSSteven Rostedt (VMware) 	ftrace_mod->module = kstrdup(module, GFP_KERNEL);
1294673feb9dSSteven Rostedt (VMware) 	ftrace_mod->enable = enable;
1295673feb9dSSteven Rostedt (VMware) 
1296673feb9dSSteven Rostedt (VMware) 	if (!ftrace_mod->func || !ftrace_mod->module)
1297673feb9dSSteven Rostedt (VMware) 		goto out_free;
1298673feb9dSSteven Rostedt (VMware) 
1299673feb9dSSteven Rostedt (VMware) 	list_add(&ftrace_mod->list, mod_head);
1300673feb9dSSteven Rostedt (VMware) 
1301673feb9dSSteven Rostedt (VMware) 	return 0;
1302673feb9dSSteven Rostedt (VMware) 
1303673feb9dSSteven Rostedt (VMware)  out_free:
1304673feb9dSSteven Rostedt (VMware) 	free_ftrace_mod(ftrace_mod);
1305673feb9dSSteven Rostedt (VMware) 
1306673feb9dSSteven Rostedt (VMware) 	return -ENOMEM;
1307673feb9dSSteven Rostedt (VMware) }
1308673feb9dSSteven Rostedt (VMware) 
130933dc9b12SSteven Rostedt static struct ftrace_hash *
131033dc9b12SSteven Rostedt alloc_and_copy_ftrace_hash(int size_bits, struct ftrace_hash *hash)
131133dc9b12SSteven Rostedt {
131233dc9b12SSteven Rostedt 	struct ftrace_func_entry *entry;
131333dc9b12SSteven Rostedt 	struct ftrace_hash *new_hash;
131433dc9b12SSteven Rostedt 	int size;
131533dc9b12SSteven Rostedt 	int ret;
131633dc9b12SSteven Rostedt 	int i;
131733dc9b12SSteven Rostedt 
131833dc9b12SSteven Rostedt 	new_hash = alloc_ftrace_hash(size_bits);
131933dc9b12SSteven Rostedt 	if (!new_hash)
132033dc9b12SSteven Rostedt 		return NULL;
132133dc9b12SSteven Rostedt 
13228c08f0d5SSteven Rostedt (VMware) 	if (hash)
13238c08f0d5SSteven Rostedt (VMware) 		new_hash->flags = hash->flags;
13248c08f0d5SSteven Rostedt (VMware) 
132533dc9b12SSteven Rostedt 	/* Empty hash? */
132606a51d93SSteven Rostedt 	if (ftrace_hash_empty(hash))
132733dc9b12SSteven Rostedt 		return new_hash;
132833dc9b12SSteven Rostedt 
132933dc9b12SSteven Rostedt 	size = 1 << hash->size_bits;
133033dc9b12SSteven Rostedt 	for (i = 0; i < size; i++) {
1331b67bfe0dSSasha Levin 		hlist_for_each_entry(entry, &hash->buckets[i], hlist) {
133233dc9b12SSteven Rostedt 			ret = add_hash_entry(new_hash, entry->ip);
133333dc9b12SSteven Rostedt 			if (ret < 0)
133433dc9b12SSteven Rostedt 				goto free_hash;
133533dc9b12SSteven Rostedt 		}
133633dc9b12SSteven Rostedt 	}
133733dc9b12SSteven Rostedt 
133833dc9b12SSteven Rostedt 	FTRACE_WARN_ON(new_hash->count != hash->count);
133933dc9b12SSteven Rostedt 
134033dc9b12SSteven Rostedt 	return new_hash;
134133dc9b12SSteven Rostedt 
134233dc9b12SSteven Rostedt  free_hash:
134333dc9b12SSteven Rostedt 	free_ftrace_hash(new_hash);
134433dc9b12SSteven Rostedt 	return NULL;
134533dc9b12SSteven Rostedt }
134633dc9b12SSteven Rostedt 
134741fb61c2SSteven Rostedt static void
134884261912SSteven Rostedt (Red Hat) ftrace_hash_rec_disable_modify(struct ftrace_ops *ops, int filter_hash);
134941fb61c2SSteven Rostedt static void
135084261912SSteven Rostedt (Red Hat) ftrace_hash_rec_enable_modify(struct ftrace_ops *ops, int filter_hash);
135141fb61c2SSteven Rostedt 
1352f8b8be8aSMasami Hiramatsu static int ftrace_hash_ipmodify_update(struct ftrace_ops *ops,
1353f8b8be8aSMasami Hiramatsu 				       struct ftrace_hash *new_hash);
1354f8b8be8aSMasami Hiramatsu 
1355714641c3SSteven Rostedt (VMware) static struct ftrace_hash *dup_hash(struct ftrace_hash *src, int size)
135633dc9b12SSteven Rostedt {
135733dc9b12SSteven Rostedt 	struct ftrace_func_entry *entry;
135807fd5515SSteven Rostedt 	struct ftrace_hash *new_hash;
1359714641c3SSteven Rostedt (VMware) 	struct hlist_head *hhd;
1360714641c3SSteven Rostedt (VMware) 	struct hlist_node *tn;
136133dc9b12SSteven Rostedt 	int bits = 0;
136233dc9b12SSteven Rostedt 	int i;
136333dc9b12SSteven Rostedt 
136433dc9b12SSteven Rostedt 	/*
1365be493132SSteven Rostedt (VMware) 	 * Use around half the size (max bit of it), but
1366be493132SSteven Rostedt (VMware) 	 * a minimum of 2 is fine (as size of 0 or 1 both give 1 for bits).
136733dc9b12SSteven Rostedt 	 */
1368be493132SSteven Rostedt (VMware) 	bits = fls(size / 2);
136933dc9b12SSteven Rostedt 
137033dc9b12SSteven Rostedt 	/* Don't allocate too much */
137133dc9b12SSteven Rostedt 	if (bits > FTRACE_HASH_MAX_BITS)
137233dc9b12SSteven Rostedt 		bits = FTRACE_HASH_MAX_BITS;
137333dc9b12SSteven Rostedt 
137407fd5515SSteven Rostedt 	new_hash = alloc_ftrace_hash(bits);
137507fd5515SSteven Rostedt 	if (!new_hash)
13763e278c0dSNamhyung Kim 		return NULL;
137733dc9b12SSteven Rostedt 
13788c08f0d5SSteven Rostedt (VMware) 	new_hash->flags = src->flags;
13798c08f0d5SSteven Rostedt (VMware) 
138033dc9b12SSteven Rostedt 	size = 1 << src->size_bits;
138133dc9b12SSteven Rostedt 	for (i = 0; i < size; i++) {
138233dc9b12SSteven Rostedt 		hhd = &src->buckets[i];
1383b67bfe0dSSasha Levin 		hlist_for_each_entry_safe(entry, tn, hhd, hlist) {
138433dc9b12SSteven Rostedt 			remove_hash_entry(src, entry);
138507fd5515SSteven Rostedt 			__add_hash_entry(new_hash, entry);
138633dc9b12SSteven Rostedt 		}
138733dc9b12SSteven Rostedt 	}
13883e278c0dSNamhyung Kim 	return new_hash;
13893e278c0dSNamhyung Kim }
13903e278c0dSNamhyung Kim 
1391714641c3SSteven Rostedt (VMware) static struct ftrace_hash *
1392714641c3SSteven Rostedt (VMware) __ftrace_hash_move(struct ftrace_hash *src)
1393714641c3SSteven Rostedt (VMware) {
1394714641c3SSteven Rostedt (VMware) 	int size = src->count;
1395714641c3SSteven Rostedt (VMware) 
1396714641c3SSteven Rostedt (VMware) 	/*
1397714641c3SSteven Rostedt (VMware) 	 * If the new source is empty, just return the empty_hash.
1398714641c3SSteven Rostedt (VMware) 	 */
1399714641c3SSteven Rostedt (VMware) 	if (ftrace_hash_empty(src))
1400714641c3SSteven Rostedt (VMware) 		return EMPTY_HASH;
1401714641c3SSteven Rostedt (VMware) 
1402714641c3SSteven Rostedt (VMware) 	return dup_hash(src, size);
1403714641c3SSteven Rostedt (VMware) }
1404714641c3SSteven Rostedt (VMware) 
14053e278c0dSNamhyung Kim static int
14063e278c0dSNamhyung Kim ftrace_hash_move(struct ftrace_ops *ops, int enable,
14073e278c0dSNamhyung Kim 		 struct ftrace_hash **dst, struct ftrace_hash *src)
14083e278c0dSNamhyung Kim {
14093e278c0dSNamhyung Kim 	struct ftrace_hash *new_hash;
14103e278c0dSNamhyung Kim 	int ret;
14113e278c0dSNamhyung Kim 
14123e278c0dSNamhyung Kim 	/* Reject setting notrace hash on IPMODIFY ftrace_ops */
14133e278c0dSNamhyung Kim 	if (ops->flags & FTRACE_OPS_FL_IPMODIFY && !enable)
14143e278c0dSNamhyung Kim 		return -EINVAL;
14153e278c0dSNamhyung Kim 
14163e278c0dSNamhyung Kim 	new_hash = __ftrace_hash_move(src);
14173e278c0dSNamhyung Kim 	if (!new_hash)
14183e278c0dSNamhyung Kim 		return -ENOMEM;
14193e278c0dSNamhyung Kim 
1420f8b8be8aSMasami Hiramatsu 	/* Make sure this can be applied if it is IPMODIFY ftrace_ops */
1421f8b8be8aSMasami Hiramatsu 	if (enable) {
1422f8b8be8aSMasami Hiramatsu 		/* IPMODIFY should be updated only when filter_hash updating */
1423f8b8be8aSMasami Hiramatsu 		ret = ftrace_hash_ipmodify_update(ops, new_hash);
1424f8b8be8aSMasami Hiramatsu 		if (ret < 0) {
1425f8b8be8aSMasami Hiramatsu 			free_ftrace_hash(new_hash);
1426f8b8be8aSMasami Hiramatsu 			return ret;
1427f8b8be8aSMasami Hiramatsu 		}
1428f8b8be8aSMasami Hiramatsu 	}
1429f8b8be8aSMasami Hiramatsu 
14305c27c775SMasami Hiramatsu 	/*
14315c27c775SMasami Hiramatsu 	 * Remove the current set, update the hash and add
14325c27c775SMasami Hiramatsu 	 * them back.
14335c27c775SMasami Hiramatsu 	 */
143484261912SSteven Rostedt (Red Hat) 	ftrace_hash_rec_disable_modify(ops, enable);
14355c27c775SMasami Hiramatsu 
143607fd5515SSteven Rostedt 	rcu_assign_pointer(*dst, new_hash);
143707fd5515SSteven Rostedt 
143884261912SSteven Rostedt (Red Hat) 	ftrace_hash_rec_enable_modify(ops, enable);
143941fb61c2SSteven Rostedt 
14405c27c775SMasami Hiramatsu 	return 0;
144133dc9b12SSteven Rostedt }
144233dc9b12SSteven Rostedt 
1443fef5aeeeSSteven Rostedt (Red Hat) static bool hash_contains_ip(unsigned long ip,
1444fef5aeeeSSteven Rostedt (Red Hat) 			     struct ftrace_ops_hash *hash)
1445fef5aeeeSSteven Rostedt (Red Hat) {
1446fef5aeeeSSteven Rostedt (Red Hat) 	/*
1447fef5aeeeSSteven Rostedt (Red Hat) 	 * The function record is a match if it exists in the filter
1448fdda88d3SQiujun Huang 	 * hash and not in the notrace hash. Note, an empty hash is
1449fef5aeeeSSteven Rostedt (Red Hat) 	 * considered a match for the filter hash, but an empty
1450fef5aeeeSSteven Rostedt (Red Hat) 	 * notrace hash is considered not in the notrace hash.
1451fef5aeeeSSteven Rostedt (Red Hat) 	 */
1452fef5aeeeSSteven Rostedt (Red Hat) 	return (ftrace_hash_empty(hash->filter_hash) ||
14532b2c279cSSteven Rostedt (VMware) 		__ftrace_lookup_ip(hash->filter_hash, ip)) &&
1454fef5aeeeSSteven Rostedt (Red Hat) 		(ftrace_hash_empty(hash->notrace_hash) ||
14552b2c279cSSteven Rostedt (VMware) 		 !__ftrace_lookup_ip(hash->notrace_hash, ip));
1456fef5aeeeSSteven Rostedt (Red Hat) }
1457fef5aeeeSSteven Rostedt (Red Hat) 
1458265c831cSSteven Rostedt /*
1459b848914cSSteven Rostedt  * Test the hashes for this ops to see if we want to call
1460b848914cSSteven Rostedt  * the ops->func or not.
1461b848914cSSteven Rostedt  *
1462b848914cSSteven Rostedt  * It's a match if the ip is in the ops->filter_hash or
1463b848914cSSteven Rostedt  * the filter_hash does not exist or is empty,
1464b848914cSSteven Rostedt  *  AND
1465b848914cSSteven Rostedt  * the ip is not in the ops->notrace_hash.
1466cdbe61bfSSteven Rostedt  *
1467cdbe61bfSSteven Rostedt  * This needs to be called with preemption disabled as
146874401729SPaul E. McKenney  * the hashes are freed with call_rcu().
1469b848914cSSteven Rostedt  */
14703306fc4aSSteven Rostedt (VMware) int
1471195a8afcSSteven Rostedt (Red Hat) ftrace_ops_test(struct ftrace_ops *ops, unsigned long ip, void *regs)
1472b848914cSSteven Rostedt {
1473fef5aeeeSSteven Rostedt (Red Hat) 	struct ftrace_ops_hash hash;
1474b848914cSSteven Rostedt 	int ret;
1475b848914cSSteven Rostedt 
1476195a8afcSSteven Rostedt (Red Hat) #ifdef CONFIG_DYNAMIC_FTRACE_WITH_REGS
1477195a8afcSSteven Rostedt (Red Hat) 	/*
1478195a8afcSSteven Rostedt (Red Hat) 	 * There's a small race when adding ops that the ftrace handler
1479195a8afcSSteven Rostedt (Red Hat) 	 * that wants regs, may be called without them. We can not
1480195a8afcSSteven Rostedt (Red Hat) 	 * allow that handler to be called if regs is NULL.
1481195a8afcSSteven Rostedt (Red Hat) 	 */
1482195a8afcSSteven Rostedt (Red Hat) 	if (regs == NULL && (ops->flags & FTRACE_OPS_FL_SAVE_REGS))
1483195a8afcSSteven Rostedt (Red Hat) 		return 0;
1484195a8afcSSteven Rostedt (Red Hat) #endif
1485195a8afcSSteven Rostedt (Red Hat) 
1486f86f4180SChunyan Zhang 	rcu_assign_pointer(hash.filter_hash, ops->func_hash->filter_hash);
1487f86f4180SChunyan Zhang 	rcu_assign_pointer(hash.notrace_hash, ops->func_hash->notrace_hash);
1488b848914cSSteven Rostedt 
1489fef5aeeeSSteven Rostedt (Red Hat) 	if (hash_contains_ip(ip, &hash))
1490b848914cSSteven Rostedt 		ret = 1;
1491b848914cSSteven Rostedt 	else
1492b848914cSSteven Rostedt 		ret = 0;
1493b848914cSSteven Rostedt 
1494b848914cSSteven Rostedt 	return ret;
1495b848914cSSteven Rostedt }
1496b848914cSSteven Rostedt 
1497b848914cSSteven Rostedt /*
1498265c831cSSteven Rostedt  * This is a double for. Do not use 'break' to break out of the loop,
1499265c831cSSteven Rostedt  * you must use a goto.
1500265c831cSSteven Rostedt  */
1501265c831cSSteven Rostedt #define do_for_each_ftrace_rec(pg, rec)					\
1502265c831cSSteven Rostedt 	for (pg = ftrace_pages_start; pg; pg = pg->next) {		\
1503265c831cSSteven Rostedt 		int _____i;						\
1504265c831cSSteven Rostedt 		for (_____i = 0; _____i < pg->index; _____i++) {	\
1505265c831cSSteven Rostedt 			rec = &pg->records[_____i];
1506265c831cSSteven Rostedt 
1507265c831cSSteven Rostedt #define while_for_each_ftrace_rec()		\
1508265c831cSSteven Rostedt 		}				\
1509265c831cSSteven Rostedt 	}
1510ecea656dSAbhishek Sagar 
15115855feadSSteven Rostedt 
15125855feadSSteven Rostedt static int ftrace_cmp_recs(const void *a, const void *b)
15135855feadSSteven Rostedt {
1514a650e02aSSteven Rostedt 	const struct dyn_ftrace *key = a;
1515a650e02aSSteven Rostedt 	const struct dyn_ftrace *rec = b;
15165855feadSSteven Rostedt 
1517a650e02aSSteven Rostedt 	if (key->flags < rec->ip)
15185855feadSSteven Rostedt 		return -1;
1519a650e02aSSteven Rostedt 	if (key->ip >= rec->ip + MCOUNT_INSN_SIZE)
1520a650e02aSSteven Rostedt 		return 1;
1521a650e02aSSteven Rostedt 	return 0;
1522a650e02aSSteven Rostedt }
1523a650e02aSSteven Rostedt 
15247e16f581SSteven Rostedt (VMware) static struct dyn_ftrace *lookup_rec(unsigned long start, unsigned long end)
15257e16f581SSteven Rostedt (VMware) {
15267e16f581SSteven Rostedt (VMware) 	struct ftrace_page *pg;
15277e16f581SSteven Rostedt (VMware) 	struct dyn_ftrace *rec = NULL;
15287e16f581SSteven Rostedt (VMware) 	struct dyn_ftrace key;
15297e16f581SSteven Rostedt (VMware) 
15307e16f581SSteven Rostedt (VMware) 	key.ip = start;
15317e16f581SSteven Rostedt (VMware) 	key.flags = end;	/* overload flags, as it is unsigned long */
15327e16f581SSteven Rostedt (VMware) 
15337e16f581SSteven Rostedt (VMware) 	for (pg = ftrace_pages_start; pg; pg = pg->next) {
15347e16f581SSteven Rostedt (VMware) 		if (end < pg->records[0].ip ||
15357e16f581SSteven Rostedt (VMware) 		    start >= (pg->records[pg->index - 1].ip + MCOUNT_INSN_SIZE))
15367e16f581SSteven Rostedt (VMware) 			continue;
15377e16f581SSteven Rostedt (VMware) 		rec = bsearch(&key, pg->records, pg->index,
15387e16f581SSteven Rostedt (VMware) 			      sizeof(struct dyn_ftrace),
15397e16f581SSteven Rostedt (VMware) 			      ftrace_cmp_recs);
1540d9815bffSArtem Savkov 		if (rec)
1541d9815bffSArtem Savkov 			break;
15427e16f581SSteven Rostedt (VMware) 	}
15437e16f581SSteven Rostedt (VMware) 	return rec;
15447e16f581SSteven Rostedt (VMware) }
15457e16f581SSteven Rostedt (VMware) 
154604cf31a7SMichael Ellerman /**
154704cf31a7SMichael Ellerman  * ftrace_location_range - return the first address of a traced location
154804cf31a7SMichael Ellerman  *	if it touches the given ip range
154904cf31a7SMichael Ellerman  * @start: start of range to search.
155004cf31a7SMichael Ellerman  * @end: end of range to search (inclusive). @end points to the last byte
155104cf31a7SMichael Ellerman  *	to check.
155204cf31a7SMichael Ellerman  *
155304cf31a7SMichael Ellerman  * Returns rec->ip if the related ftrace location is a least partly within
155404cf31a7SMichael Ellerman  * the given address range. That is, the first address of the instruction
155504cf31a7SMichael Ellerman  * that is either a NOP or call to the function tracer. It checks the ftrace
155604cf31a7SMichael Ellerman  * internal tables to determine if the address belongs or not.
155704cf31a7SMichael Ellerman  */
155804cf31a7SMichael Ellerman unsigned long ftrace_location_range(unsigned long start, unsigned long end)
1559a650e02aSSteven Rostedt {
1560a650e02aSSteven Rostedt 	struct dyn_ftrace *rec;
1561a650e02aSSteven Rostedt 
15627e16f581SSteven Rostedt (VMware) 	rec = lookup_rec(start, end);
1563a650e02aSSteven Rostedt 	if (rec)
1564f0cf973aSSteven Rostedt 		return rec->ip;
1565a650e02aSSteven Rostedt 
15665855feadSSteven Rostedt 	return 0;
15675855feadSSteven Rostedt }
15685855feadSSteven Rostedt 
1569c88fd863SSteven Rostedt /**
1570aebfd125SPeter Zijlstra  * ftrace_location - return the ftrace location
1571c88fd863SSteven Rostedt  * @ip: the instruction pointer to check
1572c88fd863SSteven Rostedt  *
1573aebfd125SPeter Zijlstra  * If @ip matches the ftrace location, return @ip.
1574aebfd125SPeter Zijlstra  * If @ip matches sym+0, return sym's ftrace location.
1575aebfd125SPeter Zijlstra  * Otherwise, return 0.
1576c88fd863SSteven Rostedt  */
1577f0cf973aSSteven Rostedt unsigned long ftrace_location(unsigned long ip)
1578c88fd863SSteven Rostedt {
1579aebfd125SPeter Zijlstra 	struct dyn_ftrace *rec;
1580aebfd125SPeter Zijlstra 	unsigned long offset;
1581aebfd125SPeter Zijlstra 	unsigned long size;
1582aebfd125SPeter Zijlstra 
1583aebfd125SPeter Zijlstra 	rec = lookup_rec(ip, ip);
1584aebfd125SPeter Zijlstra 	if (!rec) {
1585aebfd125SPeter Zijlstra 		if (!kallsyms_lookup_size_offset(ip, &size, &offset))
1586aebfd125SPeter Zijlstra 			goto out;
1587aebfd125SPeter Zijlstra 
1588aebfd125SPeter Zijlstra 		/* map sym+0 to __fentry__ */
1589aebfd125SPeter Zijlstra 		if (!offset)
1590aebfd125SPeter Zijlstra 			rec = lookup_rec(ip, ip + size - 1);
1591aebfd125SPeter Zijlstra 	}
1592aebfd125SPeter Zijlstra 
1593aebfd125SPeter Zijlstra 	if (rec)
1594aebfd125SPeter Zijlstra 		return rec->ip;
1595aebfd125SPeter Zijlstra 
1596aebfd125SPeter Zijlstra out:
1597aebfd125SPeter Zijlstra 	return 0;
15985855feadSSteven Rostedt }
1599c88fd863SSteven Rostedt 
1600a650e02aSSteven Rostedt /**
1601a650e02aSSteven Rostedt  * ftrace_text_reserved - return true if range contains an ftrace location
1602a650e02aSSteven Rostedt  * @start: start of range to search
1603a650e02aSSteven Rostedt  * @end: end of range to search (inclusive). @end points to the last byte to check.
1604a650e02aSSteven Rostedt  *
1605a650e02aSSteven Rostedt  * Returns 1 if @start and @end contains a ftrace location.
1606a650e02aSSteven Rostedt  * That is, the instruction that is either a NOP or call to
1607a650e02aSSteven Rostedt  * the function tracer. It checks the ftrace internal tables to
1608a650e02aSSteven Rostedt  * determine if the address belongs or not.
1609a650e02aSSteven Rostedt  */
1610d88471cbSSasha Levin int ftrace_text_reserved(const void *start, const void *end)
1611a650e02aSSteven Rostedt {
1612f0cf973aSSteven Rostedt 	unsigned long ret;
1613f0cf973aSSteven Rostedt 
1614f0cf973aSSteven Rostedt 	ret = ftrace_location_range((unsigned long)start,
1615a650e02aSSteven Rostedt 				    (unsigned long)end);
1616f0cf973aSSteven Rostedt 
1617f0cf973aSSteven Rostedt 	return (int)!!ret;
1618c88fd863SSteven Rostedt }
1619c88fd863SSteven Rostedt 
16204fbb48cbSSteven Rostedt (Red Hat) /* Test if ops registered to this rec needs regs */
16214fbb48cbSSteven Rostedt (Red Hat) static bool test_rec_ops_needs_regs(struct dyn_ftrace *rec)
16224fbb48cbSSteven Rostedt (Red Hat) {
16234fbb48cbSSteven Rostedt (Red Hat) 	struct ftrace_ops *ops;
16244fbb48cbSSteven Rostedt (Red Hat) 	bool keep_regs = false;
16254fbb48cbSSteven Rostedt (Red Hat) 
16264fbb48cbSSteven Rostedt (Red Hat) 	for (ops = ftrace_ops_list;
16274fbb48cbSSteven Rostedt (Red Hat) 	     ops != &ftrace_list_end; ops = ops->next) {
16284fbb48cbSSteven Rostedt (Red Hat) 		/* pass rec in as regs to have non-NULL val */
16294fbb48cbSSteven Rostedt (Red Hat) 		if (ftrace_ops_test(ops, rec->ip, rec)) {
16304fbb48cbSSteven Rostedt (Red Hat) 			if (ops->flags & FTRACE_OPS_FL_SAVE_REGS) {
16314fbb48cbSSteven Rostedt (Red Hat) 				keep_regs = true;
16324fbb48cbSSteven Rostedt (Red Hat) 				break;
16334fbb48cbSSteven Rostedt (Red Hat) 			}
16344fbb48cbSSteven Rostedt (Red Hat) 		}
16354fbb48cbSSteven Rostedt (Red Hat) 	}
16364fbb48cbSSteven Rostedt (Red Hat) 
16374fbb48cbSSteven Rostedt (Red Hat) 	return  keep_regs;
16384fbb48cbSSteven Rostedt (Red Hat) }
16394fbb48cbSSteven Rostedt (Red Hat) 
1640a124692bSCheng Jian static struct ftrace_ops *
1641a124692bSCheng Jian ftrace_find_tramp_ops_any(struct dyn_ftrace *rec);
1642a124692bSCheng Jian static struct ftrace_ops *
16434c75b0ffSNaveen N. Rao ftrace_find_tramp_ops_any_other(struct dyn_ftrace *rec, struct ftrace_ops *op_exclude);
16444c75b0ffSNaveen N. Rao static struct ftrace_ops *
1645a124692bSCheng Jian ftrace_find_tramp_ops_next(struct dyn_ftrace *rec, struct ftrace_ops *ops);
1646a124692bSCheng Jian 
164784b6d3e6SJiri Olsa static bool __ftrace_hash_rec_update(struct ftrace_ops *ops,
1648ed926f9bSSteven Rostedt 				     int filter_hash,
1649ed926f9bSSteven Rostedt 				     bool inc)
1650ed926f9bSSteven Rostedt {
1651ed926f9bSSteven Rostedt 	struct ftrace_hash *hash;
1652ed926f9bSSteven Rostedt 	struct ftrace_hash *other_hash;
1653ed926f9bSSteven Rostedt 	struct ftrace_page *pg;
1654ed926f9bSSteven Rostedt 	struct dyn_ftrace *rec;
165584b6d3e6SJiri Olsa 	bool update = false;
1656ed926f9bSSteven Rostedt 	int count = 0;
16578c08f0d5SSteven Rostedt (VMware) 	int all = false;
1658ed926f9bSSteven Rostedt 
1659ed926f9bSSteven Rostedt 	/* Only update if the ops has been registered */
1660ed926f9bSSteven Rostedt 	if (!(ops->flags & FTRACE_OPS_FL_ENABLED))
166184b6d3e6SJiri Olsa 		return false;
1662ed926f9bSSteven Rostedt 
1663ed926f9bSSteven Rostedt 	/*
1664ed926f9bSSteven Rostedt 	 * In the filter_hash case:
1665ed926f9bSSteven Rostedt 	 *   If the count is zero, we update all records.
1666ed926f9bSSteven Rostedt 	 *   Otherwise we just update the items in the hash.
1667ed926f9bSSteven Rostedt 	 *
1668ed926f9bSSteven Rostedt 	 * In the notrace_hash case:
1669ed926f9bSSteven Rostedt 	 *   We enable the update in the hash.
1670ed926f9bSSteven Rostedt 	 *   As disabling notrace means enabling the tracing,
1671ed926f9bSSteven Rostedt 	 *   and enabling notrace means disabling, the inc variable
1672ed926f9bSSteven Rostedt 	 *   gets inversed.
1673ed926f9bSSteven Rostedt 	 */
1674ed926f9bSSteven Rostedt 	if (filter_hash) {
167533b7f99cSSteven Rostedt (Red Hat) 		hash = ops->func_hash->filter_hash;
167633b7f99cSSteven Rostedt (Red Hat) 		other_hash = ops->func_hash->notrace_hash;
167706a51d93SSteven Rostedt 		if (ftrace_hash_empty(hash))
16788c08f0d5SSteven Rostedt (VMware) 			all = true;
1679ed926f9bSSteven Rostedt 	} else {
1680ed926f9bSSteven Rostedt 		inc = !inc;
168133b7f99cSSteven Rostedt (Red Hat) 		hash = ops->func_hash->notrace_hash;
168233b7f99cSSteven Rostedt (Red Hat) 		other_hash = ops->func_hash->filter_hash;
1683ed926f9bSSteven Rostedt 		/*
1684ed926f9bSSteven Rostedt 		 * If the notrace hash has no items,
1685ed926f9bSSteven Rostedt 		 * then there's nothing to do.
1686ed926f9bSSteven Rostedt 		 */
168706a51d93SSteven Rostedt 		if (ftrace_hash_empty(hash))
168884b6d3e6SJiri Olsa 			return false;
1689ed926f9bSSteven Rostedt 	}
1690ed926f9bSSteven Rostedt 
1691ed926f9bSSteven Rostedt 	do_for_each_ftrace_rec(pg, rec) {
1692ed926f9bSSteven Rostedt 		int in_other_hash = 0;
1693ed926f9bSSteven Rostedt 		int in_hash = 0;
1694ed926f9bSSteven Rostedt 		int match = 0;
1695ed926f9bSSteven Rostedt 
1696b7ffffbbSSteven Rostedt (Red Hat) 		if (rec->flags & FTRACE_FL_DISABLED)
1697b7ffffbbSSteven Rostedt (Red Hat) 			continue;
1698b7ffffbbSSteven Rostedt (Red Hat) 
1699ed926f9bSSteven Rostedt 		if (all) {
1700ed926f9bSSteven Rostedt 			/*
1701ed926f9bSSteven Rostedt 			 * Only the filter_hash affects all records.
1702ed926f9bSSteven Rostedt 			 * Update if the record is not in the notrace hash.
1703ed926f9bSSteven Rostedt 			 */
1704b848914cSSteven Rostedt 			if (!other_hash || !ftrace_lookup_ip(other_hash, rec->ip))
1705ed926f9bSSteven Rostedt 				match = 1;
1706ed926f9bSSteven Rostedt 		} else {
170706a51d93SSteven Rostedt 			in_hash = !!ftrace_lookup_ip(hash, rec->ip);
170806a51d93SSteven Rostedt 			in_other_hash = !!ftrace_lookup_ip(other_hash, rec->ip);
1709ed926f9bSSteven Rostedt 
1710ed926f9bSSteven Rostedt 			/*
171119eab4a4SSteven Rostedt (Red Hat) 			 * If filter_hash is set, we want to match all functions
171219eab4a4SSteven Rostedt (Red Hat) 			 * that are in the hash but not in the other hash.
1713ed926f9bSSteven Rostedt 			 *
171419eab4a4SSteven Rostedt (Red Hat) 			 * If filter_hash is not set, then we are decrementing.
171519eab4a4SSteven Rostedt (Red Hat) 			 * That means we match anything that is in the hash
171619eab4a4SSteven Rostedt (Red Hat) 			 * and also in the other_hash. That is, we need to turn
171719eab4a4SSteven Rostedt (Red Hat) 			 * off functions in the other hash because they are disabled
171819eab4a4SSteven Rostedt (Red Hat) 			 * by this hash.
1719ed926f9bSSteven Rostedt 			 */
1720ed926f9bSSteven Rostedt 			if (filter_hash && in_hash && !in_other_hash)
1721ed926f9bSSteven Rostedt 				match = 1;
1722ed926f9bSSteven Rostedt 			else if (!filter_hash && in_hash &&
172306a51d93SSteven Rostedt 				 (in_other_hash || ftrace_hash_empty(other_hash)))
1724ed926f9bSSteven Rostedt 				match = 1;
1725ed926f9bSSteven Rostedt 		}
1726ed926f9bSSteven Rostedt 		if (!match)
1727ed926f9bSSteven Rostedt 			continue;
1728ed926f9bSSteven Rostedt 
1729ed926f9bSSteven Rostedt 		if (inc) {
1730ed926f9bSSteven Rostedt 			rec->flags++;
17310376bde1SSteven Rostedt (Red Hat) 			if (FTRACE_WARN_ON(ftrace_rec_count(rec) == FTRACE_REF_MAX))
173284b6d3e6SJiri Olsa 				return false;
173379922b80SSteven Rostedt (Red Hat) 
1734763e34e7SSteven Rostedt (VMware) 			if (ops->flags & FTRACE_OPS_FL_DIRECT)
1735763e34e7SSteven Rostedt (VMware) 				rec->flags |= FTRACE_FL_DIRECT;
1736763e34e7SSteven Rostedt (VMware) 
173779922b80SSteven Rostedt (Red Hat) 			/*
173879922b80SSteven Rostedt (Red Hat) 			 * If there's only a single callback registered to a
173979922b80SSteven Rostedt (Red Hat) 			 * function, and the ops has a trampoline registered
174079922b80SSteven Rostedt (Red Hat) 			 * for it, then we can call it directly.
174179922b80SSteven Rostedt (Red Hat) 			 */
1742fef5aeeeSSteven Rostedt (Red Hat) 			if (ftrace_rec_count(rec) == 1 && ops->trampoline)
174379922b80SSteven Rostedt (Red Hat) 				rec->flags |= FTRACE_FL_TRAMP;
1744fef5aeeeSSteven Rostedt (Red Hat) 			else
174579922b80SSteven Rostedt (Red Hat) 				/*
174679922b80SSteven Rostedt (Red Hat) 				 * If we are adding another function callback
174779922b80SSteven Rostedt (Red Hat) 				 * to this function, and the previous had a
1748bce0b6c5SSteven Rostedt (Red Hat) 				 * custom trampoline in use, then we need to go
1749bce0b6c5SSteven Rostedt (Red Hat) 				 * back to the default trampoline.
175079922b80SSteven Rostedt (Red Hat) 				 */
1751fef5aeeeSSteven Rostedt (Red Hat) 				rec->flags &= ~FTRACE_FL_TRAMP;
175279922b80SSteven Rostedt (Red Hat) 
175308f6fba5SSteven Rostedt 			/*
175408f6fba5SSteven Rostedt 			 * If any ops wants regs saved for this function
175508f6fba5SSteven Rostedt 			 * then all ops will get saved regs.
175608f6fba5SSteven Rostedt 			 */
175708f6fba5SSteven Rostedt 			if (ops->flags & FTRACE_OPS_FL_SAVE_REGS)
175808f6fba5SSteven Rostedt 				rec->flags |= FTRACE_FL_REGS;
1759ed926f9bSSteven Rostedt 		} else {
17600376bde1SSteven Rostedt (Red Hat) 			if (FTRACE_WARN_ON(ftrace_rec_count(rec) == 0))
176184b6d3e6SJiri Olsa 				return false;
1762ed926f9bSSteven Rostedt 			rec->flags--;
176379922b80SSteven Rostedt (Red Hat) 
17644fbb48cbSSteven Rostedt (Red Hat) 			/*
1765763e34e7SSteven Rostedt (VMware) 			 * Only the internal direct_ops should have the
1766763e34e7SSteven Rostedt (VMware) 			 * DIRECT flag set. Thus, if it is removing a
1767763e34e7SSteven Rostedt (VMware) 			 * function, then that function should no longer
1768763e34e7SSteven Rostedt (VMware) 			 * be direct.
1769763e34e7SSteven Rostedt (VMware) 			 */
1770763e34e7SSteven Rostedt (VMware) 			if (ops->flags & FTRACE_OPS_FL_DIRECT)
1771763e34e7SSteven Rostedt (VMware) 				rec->flags &= ~FTRACE_FL_DIRECT;
1772763e34e7SSteven Rostedt (VMware) 
1773763e34e7SSteven Rostedt (VMware) 			/*
17744fbb48cbSSteven Rostedt (Red Hat) 			 * If the rec had REGS enabled and the ops that is
17754fbb48cbSSteven Rostedt (Red Hat) 			 * being removed had REGS set, then see if there is
17764fbb48cbSSteven Rostedt (Red Hat) 			 * still any ops for this record that wants regs.
17774fbb48cbSSteven Rostedt (Red Hat) 			 * If not, we can stop recording them.
17784fbb48cbSSteven Rostedt (Red Hat) 			 */
17790376bde1SSteven Rostedt (Red Hat) 			if (ftrace_rec_count(rec) > 0 &&
17804fbb48cbSSteven Rostedt (Red Hat) 			    rec->flags & FTRACE_FL_REGS &&
17814fbb48cbSSteven Rostedt (Red Hat) 			    ops->flags & FTRACE_OPS_FL_SAVE_REGS) {
17824fbb48cbSSteven Rostedt (Red Hat) 				if (!test_rec_ops_needs_regs(rec))
17834fbb48cbSSteven Rostedt (Red Hat) 					rec->flags &= ~FTRACE_FL_REGS;
17844fbb48cbSSteven Rostedt (Red Hat) 			}
178579922b80SSteven Rostedt (Red Hat) 
178679922b80SSteven Rostedt (Red Hat) 			/*
1787a124692bSCheng Jian 			 * The TRAMP needs to be set only if rec count
1788a124692bSCheng Jian 			 * is decremented to one, and the ops that is
1789a124692bSCheng Jian 			 * left has a trampoline. As TRAMP can only be
1790a124692bSCheng Jian 			 * enabled if there is only a single ops attached
1791a124692bSCheng Jian 			 * to it.
1792fef5aeeeSSteven Rostedt (Red Hat) 			 */
1793a124692bSCheng Jian 			if (ftrace_rec_count(rec) == 1 &&
17944c75b0ffSNaveen N. Rao 			    ftrace_find_tramp_ops_any_other(rec, ops))
1795a124692bSCheng Jian 				rec->flags |= FTRACE_FL_TRAMP;
1796a124692bSCheng Jian 			else
1797fef5aeeeSSteven Rostedt (Red Hat) 				rec->flags &= ~FTRACE_FL_TRAMP;
1798fef5aeeeSSteven Rostedt (Red Hat) 
1799fef5aeeeSSteven Rostedt (Red Hat) 			/*
180079922b80SSteven Rostedt (Red Hat) 			 * flags will be cleared in ftrace_check_record()
180179922b80SSteven Rostedt (Red Hat) 			 * if rec count is zero.
180279922b80SSteven Rostedt (Red Hat) 			 */
1803ed926f9bSSteven Rostedt 		}
1804ed926f9bSSteven Rostedt 		count++;
180584b6d3e6SJiri Olsa 
180684b6d3e6SJiri Olsa 		/* Must match FTRACE_UPDATE_CALLS in ftrace_modify_all_code() */
18077375dca1SSteven Rostedt (VMware) 		update |= ftrace_test_record(rec, true) != FTRACE_UPDATE_IGNORE;
180884b6d3e6SJiri Olsa 
1809ed926f9bSSteven Rostedt 		/* Shortcut, if we handled all records, we are done. */
1810ed926f9bSSteven Rostedt 		if (!all && count == hash->count)
181184b6d3e6SJiri Olsa 			return update;
1812ed926f9bSSteven Rostedt 	} while_for_each_ftrace_rec();
181384b6d3e6SJiri Olsa 
181484b6d3e6SJiri Olsa 	return update;
1815ed926f9bSSteven Rostedt }
1816ed926f9bSSteven Rostedt 
181784b6d3e6SJiri Olsa static bool ftrace_hash_rec_disable(struct ftrace_ops *ops,
1818ed926f9bSSteven Rostedt 				    int filter_hash)
1819ed926f9bSSteven Rostedt {
182084b6d3e6SJiri Olsa 	return __ftrace_hash_rec_update(ops, filter_hash, 0);
1821ed926f9bSSteven Rostedt }
1822ed926f9bSSteven Rostedt 
182384b6d3e6SJiri Olsa static bool ftrace_hash_rec_enable(struct ftrace_ops *ops,
1824ed926f9bSSteven Rostedt 				   int filter_hash)
1825ed926f9bSSteven Rostedt {
182684b6d3e6SJiri Olsa 	return __ftrace_hash_rec_update(ops, filter_hash, 1);
1827ed926f9bSSteven Rostedt }
1828ed926f9bSSteven Rostedt 
182984261912SSteven Rostedt (Red Hat) static void ftrace_hash_rec_update_modify(struct ftrace_ops *ops,
183084261912SSteven Rostedt (Red Hat) 					  int filter_hash, int inc)
183184261912SSteven Rostedt (Red Hat) {
183284261912SSteven Rostedt (Red Hat) 	struct ftrace_ops *op;
183384261912SSteven Rostedt (Red Hat) 
183484261912SSteven Rostedt (Red Hat) 	__ftrace_hash_rec_update(ops, filter_hash, inc);
183584261912SSteven Rostedt (Red Hat) 
183684261912SSteven Rostedt (Red Hat) 	if (ops->func_hash != &global_ops.local_hash)
183784261912SSteven Rostedt (Red Hat) 		return;
183884261912SSteven Rostedt (Red Hat) 
183984261912SSteven Rostedt (Red Hat) 	/*
184084261912SSteven Rostedt (Red Hat) 	 * If the ops shares the global_ops hash, then we need to update
184184261912SSteven Rostedt (Red Hat) 	 * all ops that are enabled and use this hash.
184284261912SSteven Rostedt (Red Hat) 	 */
184384261912SSteven Rostedt (Red Hat) 	do_for_each_ftrace_op(op, ftrace_ops_list) {
184484261912SSteven Rostedt (Red Hat) 		/* Already done */
184584261912SSteven Rostedt (Red Hat) 		if (op == ops)
184684261912SSteven Rostedt (Red Hat) 			continue;
184784261912SSteven Rostedt (Red Hat) 		if (op->func_hash == &global_ops.local_hash)
184884261912SSteven Rostedt (Red Hat) 			__ftrace_hash_rec_update(op, filter_hash, inc);
184984261912SSteven Rostedt (Red Hat) 	} while_for_each_ftrace_op(op);
185084261912SSteven Rostedt (Red Hat) }
185184261912SSteven Rostedt (Red Hat) 
185284261912SSteven Rostedt (Red Hat) static void ftrace_hash_rec_disable_modify(struct ftrace_ops *ops,
185384261912SSteven Rostedt (Red Hat) 					   int filter_hash)
185484261912SSteven Rostedt (Red Hat) {
185584261912SSteven Rostedt (Red Hat) 	ftrace_hash_rec_update_modify(ops, filter_hash, 0);
185684261912SSteven Rostedt (Red Hat) }
185784261912SSteven Rostedt (Red Hat) 
185884261912SSteven Rostedt (Red Hat) static void ftrace_hash_rec_enable_modify(struct ftrace_ops *ops,
185984261912SSteven Rostedt (Red Hat) 					  int filter_hash)
186084261912SSteven Rostedt (Red Hat) {
186184261912SSteven Rostedt (Red Hat) 	ftrace_hash_rec_update_modify(ops, filter_hash, 1);
186284261912SSteven Rostedt (Red Hat) }
186384261912SSteven Rostedt (Red Hat) 
1864f8b8be8aSMasami Hiramatsu /*
1865f8b8be8aSMasami Hiramatsu  * Try to update IPMODIFY flag on each ftrace_rec. Return 0 if it is OK
1866f8b8be8aSMasami Hiramatsu  * or no-needed to update, -EBUSY if it detects a conflict of the flag
1867f8b8be8aSMasami Hiramatsu  * on a ftrace_rec, and -EINVAL if the new_hash tries to trace all recs.
1868f8b8be8aSMasami Hiramatsu  * Note that old_hash and new_hash has below meanings
1869f8b8be8aSMasami Hiramatsu  *  - If the hash is NULL, it hits all recs (if IPMODIFY is set, this is rejected)
1870f8b8be8aSMasami Hiramatsu  *  - If the hash is EMPTY_HASH, it hits nothing
1871f8b8be8aSMasami Hiramatsu  *  - Anything else hits the recs which match the hash entries.
187253cd885bSSong Liu  *
187353cd885bSSong Liu  * DIRECT ops does not have IPMODIFY flag, but we still need to check it
187453cd885bSSong Liu  * against functions with FTRACE_FL_IPMODIFY. If there is any overlap, call
187553cd885bSSong Liu  * ops_func(SHARE_IPMODIFY_SELF) to make sure current ops can share with
187653cd885bSSong Liu  * IPMODIFY. If ops_func(SHARE_IPMODIFY_SELF) returns non-zero, propagate
187753cd885bSSong Liu  * the return value to the caller and eventually to the owner of the DIRECT
187853cd885bSSong Liu  * ops.
1879f8b8be8aSMasami Hiramatsu  */
1880f8b8be8aSMasami Hiramatsu static int __ftrace_hash_update_ipmodify(struct ftrace_ops *ops,
1881f8b8be8aSMasami Hiramatsu 					 struct ftrace_hash *old_hash,
1882f8b8be8aSMasami Hiramatsu 					 struct ftrace_hash *new_hash)
1883f8b8be8aSMasami Hiramatsu {
1884f8b8be8aSMasami Hiramatsu 	struct ftrace_page *pg;
1885f8b8be8aSMasami Hiramatsu 	struct dyn_ftrace *rec, *end = NULL;
1886f8b8be8aSMasami Hiramatsu 	int in_old, in_new;
188753cd885bSSong Liu 	bool is_ipmodify, is_direct;
1888f8b8be8aSMasami Hiramatsu 
1889f8b8be8aSMasami Hiramatsu 	/* Only update if the ops has been registered */
1890f8b8be8aSMasami Hiramatsu 	if (!(ops->flags & FTRACE_OPS_FL_ENABLED))
1891f8b8be8aSMasami Hiramatsu 		return 0;
1892f8b8be8aSMasami Hiramatsu 
189353cd885bSSong Liu 	is_ipmodify = ops->flags & FTRACE_OPS_FL_IPMODIFY;
189453cd885bSSong Liu 	is_direct = ops->flags & FTRACE_OPS_FL_DIRECT;
189553cd885bSSong Liu 
189653cd885bSSong Liu 	/* neither IPMODIFY nor DIRECT, skip */
189753cd885bSSong Liu 	if (!is_ipmodify && !is_direct)
189853cd885bSSong Liu 		return 0;
189953cd885bSSong Liu 
190053cd885bSSong Liu 	if (WARN_ON_ONCE(is_ipmodify && is_direct))
1901f8b8be8aSMasami Hiramatsu 		return 0;
1902f8b8be8aSMasami Hiramatsu 
1903f8b8be8aSMasami Hiramatsu 	/*
190453cd885bSSong Liu 	 * Since the IPMODIFY and DIRECT are very address sensitive
190553cd885bSSong Liu 	 * actions, we do not allow ftrace_ops to set all functions to new
190653cd885bSSong Liu 	 * hash.
1907f8b8be8aSMasami Hiramatsu 	 */
1908f8b8be8aSMasami Hiramatsu 	if (!new_hash || !old_hash)
1909f8b8be8aSMasami Hiramatsu 		return -EINVAL;
1910f8b8be8aSMasami Hiramatsu 
1911f8b8be8aSMasami Hiramatsu 	/* Update rec->flags */
1912f8b8be8aSMasami Hiramatsu 	do_for_each_ftrace_rec(pg, rec) {
1913546fece4SSteven Rostedt (Red Hat) 
1914546fece4SSteven Rostedt (Red Hat) 		if (rec->flags & FTRACE_FL_DISABLED)
1915546fece4SSteven Rostedt (Red Hat) 			continue;
1916546fece4SSteven Rostedt (Red Hat) 
1917f8b8be8aSMasami Hiramatsu 		/* We need to update only differences of filter_hash */
1918f8b8be8aSMasami Hiramatsu 		in_old = !!ftrace_lookup_ip(old_hash, rec->ip);
1919f8b8be8aSMasami Hiramatsu 		in_new = !!ftrace_lookup_ip(new_hash, rec->ip);
1920f8b8be8aSMasami Hiramatsu 		if (in_old == in_new)
1921f8b8be8aSMasami Hiramatsu 			continue;
1922f8b8be8aSMasami Hiramatsu 
1923f8b8be8aSMasami Hiramatsu 		if (in_new) {
192453cd885bSSong Liu 			if (rec->flags & FTRACE_FL_IPMODIFY) {
192553cd885bSSong Liu 				int ret;
192653cd885bSSong Liu 
192753cd885bSSong Liu 				/* Cannot have two ipmodify on same rec */
192853cd885bSSong Liu 				if (is_ipmodify)
1929f8b8be8aSMasami Hiramatsu 					goto rollback;
193053cd885bSSong Liu 
193153cd885bSSong Liu 				FTRACE_WARN_ON(rec->flags & FTRACE_FL_DIRECT);
193253cd885bSSong Liu 
193353cd885bSSong Liu 				/*
193453cd885bSSong Liu 				 * Another ops with IPMODIFY is already
193553cd885bSSong Liu 				 * attached. We are now attaching a direct
193653cd885bSSong Liu 				 * ops. Run SHARE_IPMODIFY_SELF, to check
193753cd885bSSong Liu 				 * whether sharing is supported.
193853cd885bSSong Liu 				 */
193953cd885bSSong Liu 				if (!ops->ops_func)
194053cd885bSSong Liu 					return -EBUSY;
194153cd885bSSong Liu 				ret = ops->ops_func(ops, FTRACE_OPS_CMD_ENABLE_SHARE_IPMODIFY_SELF);
194253cd885bSSong Liu 				if (ret)
194353cd885bSSong Liu 					return ret;
194453cd885bSSong Liu 			} else if (is_ipmodify) {
1945f8b8be8aSMasami Hiramatsu 				rec->flags |= FTRACE_FL_IPMODIFY;
194653cd885bSSong Liu 			}
194753cd885bSSong Liu 		} else if (is_ipmodify) {
1948f8b8be8aSMasami Hiramatsu 			rec->flags &= ~FTRACE_FL_IPMODIFY;
194953cd885bSSong Liu 		}
1950f8b8be8aSMasami Hiramatsu 	} while_for_each_ftrace_rec();
1951f8b8be8aSMasami Hiramatsu 
1952f8b8be8aSMasami Hiramatsu 	return 0;
1953f8b8be8aSMasami Hiramatsu 
1954f8b8be8aSMasami Hiramatsu rollback:
1955f8b8be8aSMasami Hiramatsu 	end = rec;
1956f8b8be8aSMasami Hiramatsu 
1957f8b8be8aSMasami Hiramatsu 	/* Roll back what we did above */
1958f8b8be8aSMasami Hiramatsu 	do_for_each_ftrace_rec(pg, rec) {
1959546fece4SSteven Rostedt (Red Hat) 
1960546fece4SSteven Rostedt (Red Hat) 		if (rec->flags & FTRACE_FL_DISABLED)
1961546fece4SSteven Rostedt (Red Hat) 			continue;
1962546fece4SSteven Rostedt (Red Hat) 
1963f8b8be8aSMasami Hiramatsu 		if (rec == end)
1964f8b8be8aSMasami Hiramatsu 			goto err_out;
1965f8b8be8aSMasami Hiramatsu 
1966f8b8be8aSMasami Hiramatsu 		in_old = !!ftrace_lookup_ip(old_hash, rec->ip);
1967f8b8be8aSMasami Hiramatsu 		in_new = !!ftrace_lookup_ip(new_hash, rec->ip);
1968f8b8be8aSMasami Hiramatsu 		if (in_old == in_new)
1969f8b8be8aSMasami Hiramatsu 			continue;
1970f8b8be8aSMasami Hiramatsu 
1971f8b8be8aSMasami Hiramatsu 		if (in_new)
1972f8b8be8aSMasami Hiramatsu 			rec->flags &= ~FTRACE_FL_IPMODIFY;
1973f8b8be8aSMasami Hiramatsu 		else
1974f8b8be8aSMasami Hiramatsu 			rec->flags |= FTRACE_FL_IPMODIFY;
1975f8b8be8aSMasami Hiramatsu 	} while_for_each_ftrace_rec();
1976f8b8be8aSMasami Hiramatsu 
1977f8b8be8aSMasami Hiramatsu err_out:
1978f8b8be8aSMasami Hiramatsu 	return -EBUSY;
1979f8b8be8aSMasami Hiramatsu }
1980f8b8be8aSMasami Hiramatsu 
1981f8b8be8aSMasami Hiramatsu static int ftrace_hash_ipmodify_enable(struct ftrace_ops *ops)
1982f8b8be8aSMasami Hiramatsu {
1983f8b8be8aSMasami Hiramatsu 	struct ftrace_hash *hash = ops->func_hash->filter_hash;
1984f8b8be8aSMasami Hiramatsu 
1985f8b8be8aSMasami Hiramatsu 	if (ftrace_hash_empty(hash))
1986f8b8be8aSMasami Hiramatsu 		hash = NULL;
1987f8b8be8aSMasami Hiramatsu 
1988f8b8be8aSMasami Hiramatsu 	return __ftrace_hash_update_ipmodify(ops, EMPTY_HASH, hash);
1989f8b8be8aSMasami Hiramatsu }
1990f8b8be8aSMasami Hiramatsu 
1991f8b8be8aSMasami Hiramatsu /* Disabling always succeeds */
1992f8b8be8aSMasami Hiramatsu static void ftrace_hash_ipmodify_disable(struct ftrace_ops *ops)
1993f8b8be8aSMasami Hiramatsu {
1994f8b8be8aSMasami Hiramatsu 	struct ftrace_hash *hash = ops->func_hash->filter_hash;
1995f8b8be8aSMasami Hiramatsu 
1996f8b8be8aSMasami Hiramatsu 	if (ftrace_hash_empty(hash))
1997f8b8be8aSMasami Hiramatsu 		hash = NULL;
1998f8b8be8aSMasami Hiramatsu 
1999f8b8be8aSMasami Hiramatsu 	__ftrace_hash_update_ipmodify(ops, hash, EMPTY_HASH);
2000f8b8be8aSMasami Hiramatsu }
2001f8b8be8aSMasami Hiramatsu 
2002f8b8be8aSMasami Hiramatsu static int ftrace_hash_ipmodify_update(struct ftrace_ops *ops,
2003f8b8be8aSMasami Hiramatsu 				       struct ftrace_hash *new_hash)
2004f8b8be8aSMasami Hiramatsu {
2005f8b8be8aSMasami Hiramatsu 	struct ftrace_hash *old_hash = ops->func_hash->filter_hash;
2006f8b8be8aSMasami Hiramatsu 
2007f8b8be8aSMasami Hiramatsu 	if (ftrace_hash_empty(old_hash))
2008f8b8be8aSMasami Hiramatsu 		old_hash = NULL;
2009f8b8be8aSMasami Hiramatsu 
2010f8b8be8aSMasami Hiramatsu 	if (ftrace_hash_empty(new_hash))
2011f8b8be8aSMasami Hiramatsu 		new_hash = NULL;
2012f8b8be8aSMasami Hiramatsu 
2013f8b8be8aSMasami Hiramatsu 	return __ftrace_hash_update_ipmodify(ops, old_hash, new_hash);
2014f8b8be8aSMasami Hiramatsu }
2015f8b8be8aSMasami Hiramatsu 
2016b05086c7SSteven Rostedt (Red Hat) static void print_ip_ins(const char *fmt, const unsigned char *p)
201705736a42SSteven Rostedt {
20186c14133dSSteven Rostedt (VMware) 	char ins[MCOUNT_INSN_SIZE];
201905736a42SSteven Rostedt 	int i;
202005736a42SSteven Rostedt 
20216c14133dSSteven Rostedt (VMware) 	if (copy_from_kernel_nofault(ins, p, MCOUNT_INSN_SIZE)) {
20226c14133dSSteven Rostedt (VMware) 		printk(KERN_CONT "%s[FAULT] %px\n", fmt, p);
20236c14133dSSteven Rostedt (VMware) 		return;
20246c14133dSSteven Rostedt (VMware) 	}
20256c14133dSSteven Rostedt (VMware) 
202605736a42SSteven Rostedt 	printk(KERN_CONT "%s", fmt);
202705736a42SSteven Rostedt 
202805736a42SSteven Rostedt 	for (i = 0; i < MCOUNT_INSN_SIZE; i++)
20296c14133dSSteven Rostedt (VMware) 		printk(KERN_CONT "%s%02x", i ? ":" : "", ins[i]);
203005736a42SSteven Rostedt }
203105736a42SSteven Rostedt 
203202a392a0SSteven Rostedt (Red Hat) enum ftrace_bug_type ftrace_bug_type;
2033b05086c7SSteven Rostedt (Red Hat) const void *ftrace_expected;
203402a392a0SSteven Rostedt (Red Hat) 
203502a392a0SSteven Rostedt (Red Hat) static void print_bug_type(void)
203602a392a0SSteven Rostedt (Red Hat) {
203702a392a0SSteven Rostedt (Red Hat) 	switch (ftrace_bug_type) {
203802a392a0SSteven Rostedt (Red Hat) 	case FTRACE_BUG_UNKNOWN:
203902a392a0SSteven Rostedt (Red Hat) 		break;
204002a392a0SSteven Rostedt (Red Hat) 	case FTRACE_BUG_INIT:
204102a392a0SSteven Rostedt (Red Hat) 		pr_info("Initializing ftrace call sites\n");
204202a392a0SSteven Rostedt (Red Hat) 		break;
204302a392a0SSteven Rostedt (Red Hat) 	case FTRACE_BUG_NOP:
204402a392a0SSteven Rostedt (Red Hat) 		pr_info("Setting ftrace call site to NOP\n");
204502a392a0SSteven Rostedt (Red Hat) 		break;
204602a392a0SSteven Rostedt (Red Hat) 	case FTRACE_BUG_CALL:
204702a392a0SSteven Rostedt (Red Hat) 		pr_info("Setting ftrace call site to call ftrace function\n");
204802a392a0SSteven Rostedt (Red Hat) 		break;
204902a392a0SSteven Rostedt (Red Hat) 	case FTRACE_BUG_UPDATE:
205002a392a0SSteven Rostedt (Red Hat) 		pr_info("Updating ftrace call site to call a different ftrace function\n");
205102a392a0SSteven Rostedt (Red Hat) 		break;
205202a392a0SSteven Rostedt (Red Hat) 	}
205302a392a0SSteven Rostedt (Red Hat) }
205402a392a0SSteven Rostedt (Red Hat) 
2055c88fd863SSteven Rostedt /**
2056c88fd863SSteven Rostedt  * ftrace_bug - report and shutdown function tracer
2057c88fd863SSteven Rostedt  * @failed: The failed type (EFAULT, EINVAL, EPERM)
20584fd3279bSSteven Rostedt (Red Hat)  * @rec: The record that failed
2059c88fd863SSteven Rostedt  *
2060c88fd863SSteven Rostedt  * The arch code that enables or disables the function tracing
2061c88fd863SSteven Rostedt  * can call ftrace_bug() when it has detected a problem in
2062c88fd863SSteven Rostedt  * modifying the code. @failed should be one of either:
2063c88fd863SSteven Rostedt  * EFAULT - if the problem happens on reading the @ip address
2064c88fd863SSteven Rostedt  * EINVAL - if what is read at @ip is not what was expected
20659efb85c5SHariprasad Kelam  * EPERM - if the problem happens on writing to the @ip address
2066c88fd863SSteven Rostedt  */
20674fd3279bSSteven Rostedt (Red Hat) void ftrace_bug(int failed, struct dyn_ftrace *rec)
20683c1720f0SSteven Rostedt {
20694fd3279bSSteven Rostedt (Red Hat) 	unsigned long ip = rec ? rec->ip : 0;
20704fd3279bSSteven Rostedt (Red Hat) 
2071c143b775SCheng Jian 	pr_info("------------[ ftrace bug ]------------\n");
2072c143b775SCheng Jian 
2073b17e8a37SSteven Rostedt 	switch (failed) {
2074593eb8a2SSteven Rostedt 	case -EFAULT:
207505736a42SSteven Rostedt 		pr_info("ftrace faulted on modifying ");
20762062a4e8SDmitry Safonov 		print_ip_sym(KERN_INFO, ip);
207705736a42SSteven Rostedt 		break;
2078593eb8a2SSteven Rostedt 	case -EINVAL:
207905736a42SSteven Rostedt 		pr_info("ftrace failed to modify ");
20802062a4e8SDmitry Safonov 		print_ip_sym(KERN_INFO, ip);
208105736a42SSteven Rostedt 		print_ip_ins(" actual:   ", (unsigned char *)ip);
20824fd3279bSSteven Rostedt (Red Hat) 		pr_cont("\n");
2083b05086c7SSteven Rostedt (Red Hat) 		if (ftrace_expected) {
2084b05086c7SSteven Rostedt (Red Hat) 			print_ip_ins(" expected: ", ftrace_expected);
2085b05086c7SSteven Rostedt (Red Hat) 			pr_cont("\n");
2086b05086c7SSteven Rostedt (Red Hat) 		}
208705736a42SSteven Rostedt 		break;
2088593eb8a2SSteven Rostedt 	case -EPERM:
2089593eb8a2SSteven Rostedt 		pr_info("ftrace faulted on writing ");
20902062a4e8SDmitry Safonov 		print_ip_sym(KERN_INFO, ip);
2091593eb8a2SSteven Rostedt 		break;
2092593eb8a2SSteven Rostedt 	default:
2093593eb8a2SSteven Rostedt 		pr_info("ftrace faulted on unknown error ");
20942062a4e8SDmitry Safonov 		print_ip_sym(KERN_INFO, ip);
209505736a42SSteven Rostedt 	}
209602a392a0SSteven Rostedt (Red Hat) 	print_bug_type();
20974fd3279bSSteven Rostedt (Red Hat) 	if (rec) {
20984fd3279bSSteven Rostedt (Red Hat) 		struct ftrace_ops *ops = NULL;
20994fd3279bSSteven Rostedt (Red Hat) 
21004fd3279bSSteven Rostedt (Red Hat) 		pr_info("ftrace record flags: %lx\n", rec->flags);
21014fd3279bSSteven Rostedt (Red Hat) 		pr_cont(" (%ld)%s", ftrace_rec_count(rec),
21024fd3279bSSteven Rostedt (Red Hat) 			rec->flags & FTRACE_FL_REGS ? " R" : "  ");
21034fd3279bSSteven Rostedt (Red Hat) 		if (rec->flags & FTRACE_FL_TRAMP_EN) {
21044fd3279bSSteven Rostedt (Red Hat) 			ops = ftrace_find_tramp_ops_any(rec);
210539daa7b9SSteven Rostedt (Red Hat) 			if (ops) {
210639daa7b9SSteven Rostedt (Red Hat) 				do {
210739daa7b9SSteven Rostedt (Red Hat) 					pr_cont("\ttramp: %pS (%pS)",
210839daa7b9SSteven Rostedt (Red Hat) 						(void *)ops->trampoline,
210939daa7b9SSteven Rostedt (Red Hat) 						(void *)ops->func);
211039daa7b9SSteven Rostedt (Red Hat) 					ops = ftrace_find_tramp_ops_next(rec, ops);
211139daa7b9SSteven Rostedt (Red Hat) 				} while (ops);
211239daa7b9SSteven Rostedt (Red Hat) 			} else
21134fd3279bSSteven Rostedt (Red Hat) 				pr_cont("\ttramp: ERROR!");
21144fd3279bSSteven Rostedt (Red Hat) 
21154fd3279bSSteven Rostedt (Red Hat) 		}
21164fd3279bSSteven Rostedt (Red Hat) 		ip = ftrace_get_addr_curr(rec);
211739daa7b9SSteven Rostedt (Red Hat) 		pr_cont("\n expected tramp: %lx\n", ip);
21184fd3279bSSteven Rostedt (Red Hat) 	}
2119c143b775SCheng Jian 
2120c143b775SCheng Jian 	FTRACE_WARN_ON_ONCE(1);
2121b17e8a37SSteven Rostedt }
212205736a42SSteven Rostedt 
21237375dca1SSteven Rostedt (VMware) static int ftrace_check_record(struct dyn_ftrace *rec, bool enable, bool update)
21243d083395SSteven Rostedt {
212564fbcd16SXiao Guangrong 	unsigned long flag = 0UL;
2126e7d3737eSFrederic Weisbecker 
212702a392a0SSteven Rostedt (Red Hat) 	ftrace_bug_type = FTRACE_BUG_UNKNOWN;
212802a392a0SSteven Rostedt (Red Hat) 
2129b7ffffbbSSteven Rostedt (Red Hat) 	if (rec->flags & FTRACE_FL_DISABLED)
2130b7ffffbbSSteven Rostedt (Red Hat) 		return FTRACE_UPDATE_IGNORE;
2131b7ffffbbSSteven Rostedt (Red Hat) 
21323d083395SSteven Rostedt 	/*
213330fb6aa7SJiri Olsa 	 * If we are updating calls:
21343d083395SSteven Rostedt 	 *
2135ed926f9bSSteven Rostedt 	 *   If the record has a ref count, then we need to enable it
2136ed926f9bSSteven Rostedt 	 *   because someone is using it.
21373d083395SSteven Rostedt 	 *
2138ed926f9bSSteven Rostedt 	 *   Otherwise we make sure its disabled.
2139ed926f9bSSteven Rostedt 	 *
214030fb6aa7SJiri Olsa 	 * If we are disabling calls, then disable all records that
2141ed926f9bSSteven Rostedt 	 * are enabled.
21423d083395SSteven Rostedt 	 */
21430376bde1SSteven Rostedt (Red Hat) 	if (enable && ftrace_rec_count(rec))
214464fbcd16SXiao Guangrong 		flag = FTRACE_FL_ENABLED;
21453d083395SSteven Rostedt 
214608f6fba5SSteven Rostedt 	/*
214779922b80SSteven Rostedt (Red Hat) 	 * If enabling and the REGS flag does not match the REGS_EN, or
214879922b80SSteven Rostedt (Red Hat) 	 * the TRAMP flag doesn't match the TRAMP_EN, then do not ignore
214979922b80SSteven Rostedt (Red Hat) 	 * this record. Set flags to fail the compare against ENABLED.
2150763e34e7SSteven Rostedt (VMware) 	 * Same for direct calls.
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;
2160763e34e7SSteven Rostedt (VMware) 
2161763e34e7SSteven Rostedt (VMware) 		/*
2162763e34e7SSteven Rostedt (VMware) 		 * Direct calls are special, as count matters.
2163763e34e7SSteven Rostedt (VMware) 		 * We must test the record for direct, if the
2164763e34e7SSteven Rostedt (VMware) 		 * DIRECT and DIRECT_EN do not match, but only
2165763e34e7SSteven Rostedt (VMware) 		 * if the count is 1. That's because, if the
2166763e34e7SSteven Rostedt (VMware) 		 * count is something other than one, we do not
2167763e34e7SSteven Rostedt (VMware) 		 * want the direct enabled (it will be done via the
2168763e34e7SSteven Rostedt (VMware) 		 * direct helper). But if DIRECT_EN is set, and
2169763e34e7SSteven Rostedt (VMware) 		 * the count is not one, we need to clear it.
2170763e34e7SSteven Rostedt (VMware) 		 */
2171763e34e7SSteven Rostedt (VMware) 		if (ftrace_rec_count(rec) == 1) {
2172763e34e7SSteven Rostedt (VMware) 			if (!(rec->flags & FTRACE_FL_DIRECT) !=
2173763e34e7SSteven Rostedt (VMware) 			    !(rec->flags & FTRACE_FL_DIRECT_EN))
2174763e34e7SSteven Rostedt (VMware) 				flag |= FTRACE_FL_DIRECT;
2175763e34e7SSteven Rostedt (VMware) 		} else if (rec->flags & FTRACE_FL_DIRECT_EN) {
2176763e34e7SSteven Rostedt (VMware) 			flag |= FTRACE_FL_DIRECT;
2177763e34e7SSteven Rostedt (VMware) 		}
217879922b80SSteven Rostedt (Red Hat) 	}
217979922b80SSteven Rostedt (Red Hat) 
218064fbcd16SXiao Guangrong 	/* If the state of this record hasn't changed, then do nothing */
218164fbcd16SXiao Guangrong 	if ((rec->flags & FTRACE_FL_ENABLED) == flag)
2182c88fd863SSteven Rostedt 		return FTRACE_UPDATE_IGNORE;
218364fbcd16SXiao Guangrong 
218464fbcd16SXiao Guangrong 	if (flag) {
218508f6fba5SSteven Rostedt 		/* Save off if rec is being enabled (for return value) */
218608f6fba5SSteven Rostedt 		flag ^= rec->flags & FTRACE_FL_ENABLED;
218708f6fba5SSteven Rostedt 
218808f6fba5SSteven Rostedt 		if (update) {
218964fbcd16SXiao Guangrong 			rec->flags |= FTRACE_FL_ENABLED;
219008f6fba5SSteven Rostedt 			if (flag & FTRACE_FL_REGS) {
219108f6fba5SSteven Rostedt 				if (rec->flags & FTRACE_FL_REGS)
219208f6fba5SSteven Rostedt 					rec->flags |= FTRACE_FL_REGS_EN;
219308f6fba5SSteven Rostedt 				else
219408f6fba5SSteven Rostedt 					rec->flags &= ~FTRACE_FL_REGS_EN;
219508f6fba5SSteven Rostedt 			}
219679922b80SSteven Rostedt (Red Hat) 			if (flag & FTRACE_FL_TRAMP) {
219779922b80SSteven Rostedt (Red Hat) 				if (rec->flags & FTRACE_FL_TRAMP)
219879922b80SSteven Rostedt (Red Hat) 					rec->flags |= FTRACE_FL_TRAMP_EN;
219979922b80SSteven Rostedt (Red Hat) 				else
220079922b80SSteven Rostedt (Red Hat) 					rec->flags &= ~FTRACE_FL_TRAMP_EN;
220179922b80SSteven Rostedt (Red Hat) 			}
2202d19ad077SSteven Rostedt (VMware) 
2203763e34e7SSteven Rostedt (VMware) 			if (flag & FTRACE_FL_DIRECT) {
2204763e34e7SSteven Rostedt (VMware) 				/*
2205763e34e7SSteven Rostedt (VMware) 				 * If there's only one user (direct_ops helper)
2206763e34e7SSteven Rostedt (VMware) 				 * then we can call the direct function
2207763e34e7SSteven Rostedt (VMware) 				 * directly (no ftrace trampoline).
2208763e34e7SSteven Rostedt (VMware) 				 */
2209763e34e7SSteven Rostedt (VMware) 				if (ftrace_rec_count(rec) == 1) {
2210763e34e7SSteven Rostedt (VMware) 					if (rec->flags & FTRACE_FL_DIRECT)
2211763e34e7SSteven Rostedt (VMware) 						rec->flags |= FTRACE_FL_DIRECT_EN;
2212763e34e7SSteven Rostedt (VMware) 					else
2213763e34e7SSteven Rostedt (VMware) 						rec->flags &= ~FTRACE_FL_DIRECT_EN;
2214763e34e7SSteven Rostedt (VMware) 				} else {
2215763e34e7SSteven Rostedt (VMware) 					/*
2216763e34e7SSteven Rostedt (VMware) 					 * Can only call directly if there's
2217763e34e7SSteven Rostedt (VMware) 					 * only one callback to the function.
2218763e34e7SSteven Rostedt (VMware) 					 */
2219763e34e7SSteven Rostedt (VMware) 					rec->flags &= ~FTRACE_FL_DIRECT_EN;
2220763e34e7SSteven Rostedt (VMware) 				}
2221763e34e7SSteven Rostedt (VMware) 			}
222264fbcd16SXiao Guangrong 		}
222364fbcd16SXiao Guangrong 
222408f6fba5SSteven Rostedt 		/*
222508f6fba5SSteven Rostedt 		 * If this record is being updated from a nop, then
222608f6fba5SSteven Rostedt 		 *   return UPDATE_MAKE_CALL.
222708f6fba5SSteven Rostedt 		 * Otherwise,
222808f6fba5SSteven Rostedt 		 *   return UPDATE_MODIFY_CALL to tell the caller to convert
2229f1b2f2bdSSteven Rostedt (Red Hat) 		 *   from the save regs, to a non-save regs function or
223079922b80SSteven Rostedt (Red Hat) 		 *   vice versa, or from a trampoline call.
223108f6fba5SSteven Rostedt 		 */
223202a392a0SSteven Rostedt (Red Hat) 		if (flag & FTRACE_FL_ENABLED) {
223302a392a0SSteven Rostedt (Red Hat) 			ftrace_bug_type = FTRACE_BUG_CALL;
223408f6fba5SSteven Rostedt 			return FTRACE_UPDATE_MAKE_CALL;
223502a392a0SSteven Rostedt (Red Hat) 		}
2236f1b2f2bdSSteven Rostedt (Red Hat) 
223702a392a0SSteven Rostedt (Red Hat) 		ftrace_bug_type = FTRACE_BUG_UPDATE;
223808f6fba5SSteven Rostedt 		return FTRACE_UPDATE_MODIFY_CALL;
223908f6fba5SSteven Rostedt 	}
224008f6fba5SSteven Rostedt 
224108f6fba5SSteven Rostedt 	if (update) {
224208f6fba5SSteven Rostedt 		/* If there's no more users, clear all flags */
22430376bde1SSteven Rostedt (Red Hat) 		if (!ftrace_rec_count(rec))
224408f6fba5SSteven Rostedt 			rec->flags = 0;
224508f6fba5SSteven Rostedt 		else
2246b24d443bSSteven Rostedt (Red Hat) 			/*
2247b24d443bSSteven Rostedt (Red Hat) 			 * Just disable the record, but keep the ops TRAMP
2248b24d443bSSteven Rostedt (Red Hat) 			 * and REGS states. The _EN flags must be disabled though.
2249b24d443bSSteven Rostedt (Red Hat) 			 */
2250b24d443bSSteven Rostedt (Red Hat) 			rec->flags &= ~(FTRACE_FL_ENABLED | FTRACE_FL_TRAMP_EN |
2251763e34e7SSteven Rostedt (VMware) 					FTRACE_FL_REGS_EN | FTRACE_FL_DIRECT_EN);
225208f6fba5SSteven Rostedt 	}
2253c88fd863SSteven Rostedt 
225402a392a0SSteven Rostedt (Red Hat) 	ftrace_bug_type = FTRACE_BUG_NOP;
2255c88fd863SSteven Rostedt 	return FTRACE_UPDATE_MAKE_NOP;
2256c88fd863SSteven Rostedt }
2257c88fd863SSteven Rostedt 
2258c88fd863SSteven Rostedt /**
22596130722fSSteven Rostedt (VMware)  * ftrace_update_record - set a record that now is tracing or not
2260c88fd863SSteven Rostedt  * @rec: the record to update
22617375dca1SSteven Rostedt (VMware)  * @enable: set to true if the record is tracing, false to force disable
2262c88fd863SSteven Rostedt  *
2263c88fd863SSteven Rostedt  * The records that represent all functions that can be traced need
2264c88fd863SSteven Rostedt  * to be updated when tracing has been enabled.
2265c88fd863SSteven Rostedt  */
22667375dca1SSteven Rostedt (VMware) int ftrace_update_record(struct dyn_ftrace *rec, bool enable)
2267c88fd863SSteven Rostedt {
22687375dca1SSteven Rostedt (VMware) 	return ftrace_check_record(rec, enable, true);
2269c88fd863SSteven Rostedt }
2270c88fd863SSteven Rostedt 
2271c88fd863SSteven Rostedt /**
22726130722fSSteven Rostedt (VMware)  * ftrace_test_record - check if the record has been enabled or not
2273c88fd863SSteven Rostedt  * @rec: the record to test
22747375dca1SSteven Rostedt (VMware)  * @enable: set to true to check if enabled, false if it is disabled
2275c88fd863SSteven Rostedt  *
2276c88fd863SSteven Rostedt  * The arch code may need to test if a record is already set to
2277c88fd863SSteven Rostedt  * tracing to determine how to modify the function code that it
2278c88fd863SSteven Rostedt  * represents.
2279c88fd863SSteven Rostedt  */
22807375dca1SSteven Rostedt (VMware) int ftrace_test_record(struct dyn_ftrace *rec, bool enable)
2281c88fd863SSteven Rostedt {
22827375dca1SSteven Rostedt (VMware) 	return ftrace_check_record(rec, enable, false);
2283c88fd863SSteven Rostedt }
2284c88fd863SSteven Rostedt 
228579922b80SSteven Rostedt (Red Hat) static struct ftrace_ops *
22865fecaa04SSteven Rostedt (Red Hat) ftrace_find_tramp_ops_any(struct dyn_ftrace *rec)
22875fecaa04SSteven Rostedt (Red Hat) {
22885fecaa04SSteven Rostedt (Red Hat) 	struct ftrace_ops *op;
2289fef5aeeeSSteven Rostedt (Red Hat) 	unsigned long ip = rec->ip;
22905fecaa04SSteven Rostedt (Red Hat) 
22915fecaa04SSteven Rostedt (Red Hat) 	do_for_each_ftrace_op(op, ftrace_ops_list) {
22925fecaa04SSteven Rostedt (Red Hat) 
22935fecaa04SSteven Rostedt (Red Hat) 		if (!op->trampoline)
22945fecaa04SSteven Rostedt (Red Hat) 			continue;
22955fecaa04SSteven Rostedt (Red Hat) 
2296fef5aeeeSSteven Rostedt (Red Hat) 		if (hash_contains_ip(ip, op->func_hash))
22975fecaa04SSteven Rostedt (Red Hat) 			return op;
22985fecaa04SSteven Rostedt (Red Hat) 	} while_for_each_ftrace_op(op);
22995fecaa04SSteven Rostedt (Red Hat) 
23005fecaa04SSteven Rostedt (Red Hat) 	return NULL;
23015fecaa04SSteven Rostedt (Red Hat) }
23025fecaa04SSteven Rostedt (Red Hat) 
23035fecaa04SSteven Rostedt (Red Hat) static struct ftrace_ops *
23044c75b0ffSNaveen N. Rao ftrace_find_tramp_ops_any_other(struct dyn_ftrace *rec, struct ftrace_ops *op_exclude)
23054c75b0ffSNaveen N. Rao {
23064c75b0ffSNaveen N. Rao 	struct ftrace_ops *op;
23074c75b0ffSNaveen N. Rao 	unsigned long ip = rec->ip;
23084c75b0ffSNaveen N. Rao 
23094c75b0ffSNaveen N. Rao 	do_for_each_ftrace_op(op, ftrace_ops_list) {
23104c75b0ffSNaveen N. Rao 
23114c75b0ffSNaveen N. Rao 		if (op == op_exclude || !op->trampoline)
23124c75b0ffSNaveen N. Rao 			continue;
23134c75b0ffSNaveen N. Rao 
23144c75b0ffSNaveen N. Rao 		if (hash_contains_ip(ip, op->func_hash))
23154c75b0ffSNaveen N. Rao 			return op;
23164c75b0ffSNaveen N. Rao 	} while_for_each_ftrace_op(op);
23174c75b0ffSNaveen N. Rao 
23184c75b0ffSNaveen N. Rao 	return NULL;
23194c75b0ffSNaveen N. Rao }
23204c75b0ffSNaveen N. Rao 
23214c75b0ffSNaveen N. Rao static struct ftrace_ops *
232239daa7b9SSteven Rostedt (Red Hat) ftrace_find_tramp_ops_next(struct dyn_ftrace *rec,
232339daa7b9SSteven Rostedt (Red Hat) 			   struct ftrace_ops *op)
232439daa7b9SSteven Rostedt (Red Hat) {
232539daa7b9SSteven Rostedt (Red Hat) 	unsigned long ip = rec->ip;
232639daa7b9SSteven Rostedt (Red Hat) 
232739daa7b9SSteven Rostedt (Red Hat) 	while_for_each_ftrace_op(op) {
232839daa7b9SSteven Rostedt (Red Hat) 
232939daa7b9SSteven Rostedt (Red Hat) 		if (!op->trampoline)
233039daa7b9SSteven Rostedt (Red Hat) 			continue;
233139daa7b9SSteven Rostedt (Red Hat) 
233239daa7b9SSteven Rostedt (Red Hat) 		if (hash_contains_ip(ip, op->func_hash))
233339daa7b9SSteven Rostedt (Red Hat) 			return op;
233439daa7b9SSteven Rostedt (Red Hat) 	}
233539daa7b9SSteven Rostedt (Red Hat) 
233639daa7b9SSteven Rostedt (Red Hat) 	return NULL;
233739daa7b9SSteven Rostedt (Red Hat) }
233839daa7b9SSteven Rostedt (Red Hat) 
233939daa7b9SSteven Rostedt (Red Hat) static struct ftrace_ops *
234079922b80SSteven Rostedt (Red Hat) ftrace_find_tramp_ops_curr(struct dyn_ftrace *rec)
234179922b80SSteven Rostedt (Red Hat) {
234279922b80SSteven Rostedt (Red Hat) 	struct ftrace_ops *op;
2343fef5aeeeSSteven Rostedt (Red Hat) 	unsigned long ip = rec->ip;
234479922b80SSteven Rostedt (Red Hat) 
2345fef5aeeeSSteven Rostedt (Red Hat) 	/*
2346fef5aeeeSSteven Rostedt (Red Hat) 	 * Need to check removed ops first.
2347fef5aeeeSSteven Rostedt (Red Hat) 	 * If they are being removed, and this rec has a tramp,
2348fef5aeeeSSteven Rostedt (Red Hat) 	 * and this rec is in the ops list, then it would be the
2349fef5aeeeSSteven Rostedt (Red Hat) 	 * one with the tramp.
2350fef5aeeeSSteven Rostedt (Red Hat) 	 */
2351fef5aeeeSSteven Rostedt (Red Hat) 	if (removed_ops) {
2352fef5aeeeSSteven Rostedt (Red Hat) 		if (hash_contains_ip(ip, &removed_ops->old_hash))
235379922b80SSteven Rostedt (Red Hat) 			return removed_ops;
235479922b80SSteven Rostedt (Red Hat) 	}
235579922b80SSteven Rostedt (Red Hat) 
2356fef5aeeeSSteven Rostedt (Red Hat) 	/*
2357fef5aeeeSSteven Rostedt (Red Hat) 	 * Need to find the current trampoline for a rec.
2358fef5aeeeSSteven Rostedt (Red Hat) 	 * Now, a trampoline is only attached to a rec if there
2359fef5aeeeSSteven Rostedt (Red Hat) 	 * was a single 'ops' attached to it. But this can be called
2360fef5aeeeSSteven Rostedt (Red Hat) 	 * when we are adding another op to the rec or removing the
2361fef5aeeeSSteven Rostedt (Red Hat) 	 * current one. Thus, if the op is being added, we can
2362fef5aeeeSSteven Rostedt (Red Hat) 	 * ignore it because it hasn't attached itself to the rec
23634fc40904SSteven Rostedt (Red Hat) 	 * yet.
23644fc40904SSteven Rostedt (Red Hat) 	 *
23654fc40904SSteven Rostedt (Red Hat) 	 * If an ops is being modified (hooking to different functions)
23664fc40904SSteven Rostedt (Red Hat) 	 * then we don't care about the new functions that are being
23674fc40904SSteven Rostedt (Red Hat) 	 * added, just the old ones (that are probably being removed).
23684fc40904SSteven Rostedt (Red Hat) 	 *
23694fc40904SSteven Rostedt (Red Hat) 	 * If we are adding an ops to a function that already is using
23704fc40904SSteven Rostedt (Red Hat) 	 * a trampoline, it needs to be removed (trampolines are only
23714fc40904SSteven Rostedt (Red Hat) 	 * for single ops connected), then an ops that is not being
23724fc40904SSteven Rostedt (Red Hat) 	 * modified also needs to be checked.
2373fef5aeeeSSteven Rostedt (Red Hat) 	 */
237479922b80SSteven Rostedt (Red Hat) 	do_for_each_ftrace_op(op, ftrace_ops_list) {
2375fef5aeeeSSteven Rostedt (Red Hat) 
2376fef5aeeeSSteven Rostedt (Red Hat) 		if (!op->trampoline)
237779922b80SSteven Rostedt (Red Hat) 			continue;
237879922b80SSteven Rostedt (Red Hat) 
2379fef5aeeeSSteven Rostedt (Red Hat) 		/*
2380fef5aeeeSSteven Rostedt (Red Hat) 		 * If the ops is being added, it hasn't gotten to
2381fef5aeeeSSteven Rostedt (Red Hat) 		 * the point to be removed from this tree yet.
2382fef5aeeeSSteven Rostedt (Red Hat) 		 */
2383fef5aeeeSSteven Rostedt (Red Hat) 		if (op->flags & FTRACE_OPS_FL_ADDING)
2384fef5aeeeSSteven Rostedt (Red Hat) 			continue;
2385fef5aeeeSSteven Rostedt (Red Hat) 
2386fef5aeeeSSteven Rostedt (Red Hat) 
23874fc40904SSteven Rostedt (Red Hat) 		/*
23884fc40904SSteven Rostedt (Red Hat) 		 * If the ops is being modified and is in the old
23894fc40904SSteven Rostedt (Red Hat) 		 * hash, then it is probably being removed from this
23904fc40904SSteven Rostedt (Red Hat) 		 * function.
23914fc40904SSteven Rostedt (Red Hat) 		 */
2392fef5aeeeSSteven Rostedt (Red Hat) 		if ((op->flags & FTRACE_OPS_FL_MODIFYING) &&
2393fef5aeeeSSteven Rostedt (Red Hat) 		    hash_contains_ip(ip, &op->old_hash))
239479922b80SSteven Rostedt (Red Hat) 			return op;
23954fc40904SSteven Rostedt (Red Hat) 		/*
23964fc40904SSteven Rostedt (Red Hat) 		 * If the ops is not being added or modified, and it's
23974fc40904SSteven Rostedt (Red Hat) 		 * in its normal filter hash, then this must be the one
23984fc40904SSteven Rostedt (Red Hat) 		 * we want!
23994fc40904SSteven Rostedt (Red Hat) 		 */
24004fc40904SSteven Rostedt (Red Hat) 		if (!(op->flags & FTRACE_OPS_FL_MODIFYING) &&
24014fc40904SSteven Rostedt (Red Hat) 		    hash_contains_ip(ip, op->func_hash))
24024fc40904SSteven Rostedt (Red Hat) 			return op;
240379922b80SSteven Rostedt (Red Hat) 
240479922b80SSteven Rostedt (Red Hat) 	} while_for_each_ftrace_op(op);
240579922b80SSteven Rostedt (Red Hat) 
240679922b80SSteven Rostedt (Red Hat) 	return NULL;
240779922b80SSteven Rostedt (Red Hat) }
240879922b80SSteven Rostedt (Red Hat) 
240979922b80SSteven Rostedt (Red Hat) static struct ftrace_ops *
241079922b80SSteven Rostedt (Red Hat) ftrace_find_tramp_ops_new(struct dyn_ftrace *rec)
241179922b80SSteven Rostedt (Red Hat) {
241279922b80SSteven Rostedt (Red Hat) 	struct ftrace_ops *op;
2413fef5aeeeSSteven Rostedt (Red Hat) 	unsigned long ip = rec->ip;
241479922b80SSteven Rostedt (Red Hat) 
241579922b80SSteven Rostedt (Red Hat) 	do_for_each_ftrace_op(op, ftrace_ops_list) {
241679922b80SSteven Rostedt (Red Hat) 		/* pass rec in as regs to have non-NULL val */
2417fef5aeeeSSteven Rostedt (Red Hat) 		if (hash_contains_ip(ip, op->func_hash))
241879922b80SSteven Rostedt (Red Hat) 			return op;
241979922b80SSteven Rostedt (Red Hat) 	} while_for_each_ftrace_op(op);
242079922b80SSteven Rostedt (Red Hat) 
242179922b80SSteven Rostedt (Red Hat) 	return NULL;
242279922b80SSteven Rostedt (Red Hat) }
242379922b80SSteven Rostedt (Red Hat) 
2424763e34e7SSteven Rostedt (VMware) #ifdef CONFIG_DYNAMIC_FTRACE_WITH_DIRECT_CALLS
2425763e34e7SSteven Rostedt (VMware) /* Protected by rcu_tasks for reading, and direct_mutex for writing */
2426763e34e7SSteven Rostedt (VMware) static struct ftrace_hash *direct_functions = EMPTY_HASH;
2427763e34e7SSteven Rostedt (VMware) static DEFINE_MUTEX(direct_mutex);
2428a3ad1a7eSSteven Rostedt (VMware) int ftrace_direct_func_count;
2429763e34e7SSteven Rostedt (VMware) 
2430763e34e7SSteven Rostedt (VMware) /*
2431763e34e7SSteven Rostedt (VMware)  * Search the direct_functions hash to see if the given instruction pointer
2432763e34e7SSteven Rostedt (VMware)  * has a direct caller attached to it.
2433763e34e7SSteven Rostedt (VMware)  */
2434ff205766SAlexei Starovoitov unsigned long ftrace_find_rec_direct(unsigned long ip)
2435763e34e7SSteven Rostedt (VMware) {
2436763e34e7SSteven Rostedt (VMware) 	struct ftrace_func_entry *entry;
2437763e34e7SSteven Rostedt (VMware) 
2438763e34e7SSteven Rostedt (VMware) 	entry = __ftrace_lookup_ip(direct_functions, ip);
2439763e34e7SSteven Rostedt (VMware) 	if (!entry)
2440763e34e7SSteven Rostedt (VMware) 		return 0;
2441763e34e7SSteven Rostedt (VMware) 
2442763e34e7SSteven Rostedt (VMware) 	return entry->direct;
2443763e34e7SSteven Rostedt (VMware) }
2444763e34e7SSteven Rostedt (VMware) 
24451904a814SJiri Olsa static struct ftrace_func_entry*
24461904a814SJiri Olsa ftrace_add_rec_direct(unsigned long ip, unsigned long addr,
24471904a814SJiri Olsa 		      struct ftrace_hash **free_hash)
24481904a814SJiri Olsa {
24491904a814SJiri Olsa 	struct ftrace_func_entry *entry;
24501904a814SJiri Olsa 
24511904a814SJiri Olsa 	if (ftrace_hash_empty(direct_functions) ||
24521904a814SJiri Olsa 	    direct_functions->count > 2 * (1 << direct_functions->size_bits)) {
24531904a814SJiri Olsa 		struct ftrace_hash *new_hash;
24541904a814SJiri Olsa 		int size = ftrace_hash_empty(direct_functions) ? 0 :
24551904a814SJiri Olsa 			direct_functions->count + 1;
24561904a814SJiri Olsa 
24571904a814SJiri Olsa 		if (size < 32)
24581904a814SJiri Olsa 			size = 32;
24591904a814SJiri Olsa 
24601904a814SJiri Olsa 		new_hash = dup_hash(direct_functions, size);
24611904a814SJiri Olsa 		if (!new_hash)
24621904a814SJiri Olsa 			return NULL;
24631904a814SJiri Olsa 
24641904a814SJiri Olsa 		*free_hash = direct_functions;
24651904a814SJiri Olsa 		direct_functions = new_hash;
24661904a814SJiri Olsa 	}
24671904a814SJiri Olsa 
24681904a814SJiri Olsa 	entry = kmalloc(sizeof(*entry), GFP_KERNEL);
24691904a814SJiri Olsa 	if (!entry)
24701904a814SJiri Olsa 		return NULL;
24711904a814SJiri Olsa 
24721904a814SJiri Olsa 	entry->ip = ip;
24731904a814SJiri Olsa 	entry->direct = addr;
24741904a814SJiri Olsa 	__add_hash_entry(direct_functions, entry);
24751904a814SJiri Olsa 	return entry;
24761904a814SJiri Olsa }
24771904a814SJiri Olsa 
2478763e34e7SSteven Rostedt (VMware) static void call_direct_funcs(unsigned long ip, unsigned long pip,
2479d19ad077SSteven Rostedt (VMware) 			      struct ftrace_ops *ops, struct ftrace_regs *fregs)
2480763e34e7SSteven Rostedt (VMware) {
2481d19ad077SSteven Rostedt (VMware) 	struct pt_regs *regs = ftrace_get_regs(fregs);
2482763e34e7SSteven Rostedt (VMware) 	unsigned long addr;
2483763e34e7SSteven Rostedt (VMware) 
2484ff205766SAlexei Starovoitov 	addr = ftrace_find_rec_direct(ip);
2485763e34e7SSteven Rostedt (VMware) 	if (!addr)
2486763e34e7SSteven Rostedt (VMware) 		return;
2487763e34e7SSteven Rostedt (VMware) 
2488763e34e7SSteven Rostedt (VMware) 	arch_ftrace_set_direct_caller(regs, addr);
2489763e34e7SSteven Rostedt (VMware) }
2490763e34e7SSteven Rostedt (VMware) 
2491763e34e7SSteven Rostedt (VMware) struct ftrace_ops direct_ops = {
2492763e34e7SSteven Rostedt (VMware) 	.func		= call_direct_funcs,
249353cd885bSSong Liu 	.flags		= FTRACE_OPS_FL_DIRECT | FTRACE_OPS_FL_SAVE_REGS
2494763e34e7SSteven Rostedt (VMware) 			  | FTRACE_OPS_FL_PERMANENT,
24955da7cd11SSteven Rostedt (VMware) 	/*
24965da7cd11SSteven Rostedt (VMware) 	 * By declaring the main trampoline as this trampoline
24975da7cd11SSteven Rostedt (VMware) 	 * it will never have one allocated for it. Allocated
24985da7cd11SSteven Rostedt (VMware) 	 * trampolines should not call direct functions.
24995da7cd11SSteven Rostedt (VMware) 	 * The direct_ops should only be called by the builtin
25005da7cd11SSteven Rostedt (VMware) 	 * ftrace_regs_caller trampoline.
25015da7cd11SSteven Rostedt (VMware) 	 */
25025da7cd11SSteven Rostedt (VMware) 	.trampoline	= FTRACE_REGS_ADDR,
2503763e34e7SSteven Rostedt (VMware) };
2504763e34e7SSteven Rostedt (VMware) #endif /* CONFIG_DYNAMIC_FTRACE_WITH_DIRECT_CALLS */
2505763e34e7SSteven Rostedt (VMware) 
25067413af1fSSteven Rostedt (Red Hat) /**
25077413af1fSSteven Rostedt (Red Hat)  * ftrace_get_addr_new - Get the call address to set to
25087413af1fSSteven Rostedt (Red Hat)  * @rec:  The ftrace record descriptor
25097413af1fSSteven Rostedt (Red Hat)  *
25107413af1fSSteven Rostedt (Red Hat)  * If the record has the FTRACE_FL_REGS set, that means that it
25117413af1fSSteven Rostedt (Red Hat)  * wants to convert to a callback that saves all regs. If FTRACE_FL_REGS
25125c8c206eSRandy Dunlap  * is not set, then it wants to convert to the normal callback.
25137413af1fSSteven Rostedt (Red Hat)  *
25147413af1fSSteven Rostedt (Red Hat)  * Returns the address of the trampoline to set to
25157413af1fSSteven Rostedt (Red Hat)  */
25167413af1fSSteven Rostedt (Red Hat) unsigned long ftrace_get_addr_new(struct dyn_ftrace *rec)
25177413af1fSSteven Rostedt (Red Hat) {
251879922b80SSteven Rostedt (Red Hat) 	struct ftrace_ops *ops;
2519763e34e7SSteven Rostedt (VMware) 	unsigned long addr;
2520763e34e7SSteven Rostedt (VMware) 
2521763e34e7SSteven Rostedt (VMware) 	if ((rec->flags & FTRACE_FL_DIRECT) &&
2522763e34e7SSteven Rostedt (VMware) 	    (ftrace_rec_count(rec) == 1)) {
2523ff205766SAlexei Starovoitov 		addr = ftrace_find_rec_direct(rec->ip);
2524763e34e7SSteven Rostedt (VMware) 		if (addr)
2525763e34e7SSteven Rostedt (VMware) 			return addr;
2526763e34e7SSteven Rostedt (VMware) 		WARN_ON_ONCE(1);
2527763e34e7SSteven Rostedt (VMware) 	}
252879922b80SSteven Rostedt (Red Hat) 
252979922b80SSteven Rostedt (Red Hat) 	/* Trampolines take precedence over regs */
253079922b80SSteven Rostedt (Red Hat) 	if (rec->flags & FTRACE_FL_TRAMP) {
253179922b80SSteven Rostedt (Red Hat) 		ops = ftrace_find_tramp_ops_new(rec);
253279922b80SSteven Rostedt (Red Hat) 		if (FTRACE_WARN_ON(!ops || !ops->trampoline)) {
2533bce0b6c5SSteven Rostedt (Red Hat) 			pr_warn("Bad trampoline accounting at: %p (%pS) (%lx)\n",
2534bce0b6c5SSteven Rostedt (Red Hat) 				(void *)rec->ip, (void *)rec->ip, rec->flags);
253579922b80SSteven Rostedt (Red Hat) 			/* Ftrace is shutting down, return anything */
253679922b80SSteven Rostedt (Red Hat) 			return (unsigned long)FTRACE_ADDR;
253779922b80SSteven Rostedt (Red Hat) 		}
253879922b80SSteven Rostedt (Red Hat) 		return ops->trampoline;
253979922b80SSteven Rostedt (Red Hat) 	}
254079922b80SSteven Rostedt (Red Hat) 
25417413af1fSSteven Rostedt (Red Hat) 	if (rec->flags & FTRACE_FL_REGS)
25427413af1fSSteven Rostedt (Red Hat) 		return (unsigned long)FTRACE_REGS_ADDR;
25437413af1fSSteven Rostedt (Red Hat) 	else
25447413af1fSSteven Rostedt (Red Hat) 		return (unsigned long)FTRACE_ADDR;
25457413af1fSSteven Rostedt (Red Hat) }
25467413af1fSSteven Rostedt (Red Hat) 
25477413af1fSSteven Rostedt (Red Hat) /**
25487413af1fSSteven Rostedt (Red Hat)  * ftrace_get_addr_curr - Get the call address that is already there
25497413af1fSSteven Rostedt (Red Hat)  * @rec:  The ftrace record descriptor
25507413af1fSSteven Rostedt (Red Hat)  *
25517413af1fSSteven Rostedt (Red Hat)  * The FTRACE_FL_REGS_EN is set when the record already points to
25527413af1fSSteven Rostedt (Red Hat)  * a function that saves all the regs. Basically the '_EN' version
25537413af1fSSteven Rostedt (Red Hat)  * represents the current state of the function.
25547413af1fSSteven Rostedt (Red Hat)  *
25557413af1fSSteven Rostedt (Red Hat)  * Returns the address of the trampoline that is currently being called
25567413af1fSSteven Rostedt (Red Hat)  */
25577413af1fSSteven Rostedt (Red Hat) unsigned long ftrace_get_addr_curr(struct dyn_ftrace *rec)
25587413af1fSSteven Rostedt (Red Hat) {
255979922b80SSteven Rostedt (Red Hat) 	struct ftrace_ops *ops;
2560763e34e7SSteven Rostedt (VMware) 	unsigned long addr;
2561763e34e7SSteven Rostedt (VMware) 
2562763e34e7SSteven Rostedt (VMware) 	/* Direct calls take precedence over trampolines */
2563763e34e7SSteven Rostedt (VMware) 	if (rec->flags & FTRACE_FL_DIRECT_EN) {
2564ff205766SAlexei Starovoitov 		addr = ftrace_find_rec_direct(rec->ip);
2565763e34e7SSteven Rostedt (VMware) 		if (addr)
2566763e34e7SSteven Rostedt (VMware) 			return addr;
2567763e34e7SSteven Rostedt (VMware) 		WARN_ON_ONCE(1);
2568763e34e7SSteven Rostedt (VMware) 	}
256979922b80SSteven Rostedt (Red Hat) 
257079922b80SSteven Rostedt (Red Hat) 	/* Trampolines take precedence over regs */
257179922b80SSteven Rostedt (Red Hat) 	if (rec->flags & FTRACE_FL_TRAMP_EN) {
257279922b80SSteven Rostedt (Red Hat) 		ops = ftrace_find_tramp_ops_curr(rec);
257379922b80SSteven Rostedt (Red Hat) 		if (FTRACE_WARN_ON(!ops)) {
2574a395d6a7SJoe Perches 			pr_warn("Bad trampoline accounting at: %p (%pS)\n",
257579922b80SSteven Rostedt (Red Hat) 				(void *)rec->ip, (void *)rec->ip);
257679922b80SSteven Rostedt (Red Hat) 			/* Ftrace is shutting down, return anything */
257779922b80SSteven Rostedt (Red Hat) 			return (unsigned long)FTRACE_ADDR;
257879922b80SSteven Rostedt (Red Hat) 		}
257979922b80SSteven Rostedt (Red Hat) 		return ops->trampoline;
258079922b80SSteven Rostedt (Red Hat) 	}
258179922b80SSteven Rostedt (Red Hat) 
25827413af1fSSteven Rostedt (Red Hat) 	if (rec->flags & FTRACE_FL_REGS_EN)
25837413af1fSSteven Rostedt (Red Hat) 		return (unsigned long)FTRACE_REGS_ADDR;
25847413af1fSSteven Rostedt (Red Hat) 	else
25857413af1fSSteven Rostedt (Red Hat) 		return (unsigned long)FTRACE_ADDR;
25867413af1fSSteven Rostedt (Red Hat) }
25877413af1fSSteven Rostedt (Red Hat) 
2588c88fd863SSteven Rostedt static int
25897375dca1SSteven Rostedt (VMware) __ftrace_replace_code(struct dyn_ftrace *rec, bool enable)
2590c88fd863SSteven Rostedt {
259108f6fba5SSteven Rostedt 	unsigned long ftrace_old_addr;
2592c88fd863SSteven Rostedt 	unsigned long ftrace_addr;
2593c88fd863SSteven Rostedt 	int ret;
2594c88fd863SSteven Rostedt 
25957c0868e0SSteven Rostedt (Red Hat) 	ftrace_addr = ftrace_get_addr_new(rec);
2596c88fd863SSteven Rostedt 
25977c0868e0SSteven Rostedt (Red Hat) 	/* This needs to be done before we call ftrace_update_record */
25987c0868e0SSteven Rostedt (Red Hat) 	ftrace_old_addr = ftrace_get_addr_curr(rec);
25997c0868e0SSteven Rostedt (Red Hat) 
26007c0868e0SSteven Rostedt (Red Hat) 	ret = ftrace_update_record(rec, enable);
260108f6fba5SSteven Rostedt 
260202a392a0SSteven Rostedt (Red Hat) 	ftrace_bug_type = FTRACE_BUG_UNKNOWN;
260302a392a0SSteven Rostedt (Red Hat) 
2604c88fd863SSteven Rostedt 	switch (ret) {
2605c88fd863SSteven Rostedt 	case FTRACE_UPDATE_IGNORE:
2606c88fd863SSteven Rostedt 		return 0;
2607c88fd863SSteven Rostedt 
2608c88fd863SSteven Rostedt 	case FTRACE_UPDATE_MAKE_CALL:
260902a392a0SSteven Rostedt (Red Hat) 		ftrace_bug_type = FTRACE_BUG_CALL;
2610c88fd863SSteven Rostedt 		return ftrace_make_call(rec, ftrace_addr);
2611c88fd863SSteven Rostedt 
2612c88fd863SSteven Rostedt 	case FTRACE_UPDATE_MAKE_NOP:
261302a392a0SSteven Rostedt (Red Hat) 		ftrace_bug_type = FTRACE_BUG_NOP;
261439b5552cSSteven Rostedt (Red Hat) 		return ftrace_make_nop(NULL, rec, ftrace_old_addr);
261508f6fba5SSteven Rostedt 
261608f6fba5SSteven Rostedt 	case FTRACE_UPDATE_MODIFY_CALL:
261702a392a0SSteven Rostedt (Red Hat) 		ftrace_bug_type = FTRACE_BUG_UPDATE;
261808f6fba5SSteven Rostedt 		return ftrace_modify_call(rec, ftrace_old_addr, ftrace_addr);
26193d083395SSteven Rostedt 	}
26203d083395SSteven Rostedt 
26219efb85c5SHariprasad Kelam 	return -1; /* unknown ftrace bug */
2622c88fd863SSteven Rostedt }
2623c88fd863SSteven Rostedt 
2624a0572f68SSteven Rostedt (VMware) void __weak ftrace_replace_code(int mod_flags)
26253d083395SSteven Rostedt {
26263d083395SSteven Rostedt 	struct dyn_ftrace *rec;
26273d083395SSteven Rostedt 	struct ftrace_page *pg;
26287375dca1SSteven Rostedt (VMware) 	bool enable = mod_flags & FTRACE_MODIFY_ENABLE_FL;
2629a0572f68SSteven Rostedt (VMware) 	int schedulable = mod_flags & FTRACE_MODIFY_MAY_SLEEP_FL;
26306a24a244SSteven Rostedt 	int failed;
26313d083395SSteven Rostedt 
263245a4a237SSteven Rostedt 	if (unlikely(ftrace_disabled))
263345a4a237SSteven Rostedt 		return;
263445a4a237SSteven Rostedt 
2635265c831cSSteven Rostedt 	do_for_each_ftrace_rec(pg, rec) {
2636546fece4SSteven Rostedt (Red Hat) 
2637546fece4SSteven Rostedt (Red Hat) 		if (rec->flags & FTRACE_FL_DISABLED)
2638546fece4SSteven Rostedt (Red Hat) 			continue;
2639546fece4SSteven Rostedt (Red Hat) 
2640e4f5d544SSteven Rostedt 		failed = __ftrace_replace_code(rec, enable);
2641fa9d13cfSZhaolei 		if (failed) {
26424fd3279bSSteven Rostedt (Red Hat) 			ftrace_bug(failed, rec);
26434377245aSSteven Rostedt 			/* Stop processing */
26444377245aSSteven Rostedt 			return;
26454377245aSSteven Rostedt 		}
2646a0572f68SSteven Rostedt (VMware) 		if (schedulable)
2647a0572f68SSteven Rostedt (VMware) 			cond_resched();
2648265c831cSSteven Rostedt 	} while_for_each_ftrace_rec();
26493d083395SSteven Rostedt }
26503c1720f0SSteven Rostedt 
2651c88fd863SSteven Rostedt struct ftrace_rec_iter {
2652c88fd863SSteven Rostedt 	struct ftrace_page	*pg;
2653c88fd863SSteven Rostedt 	int			index;
2654c88fd863SSteven Rostedt };
2655c88fd863SSteven Rostedt 
2656c88fd863SSteven Rostedt /**
26576130722fSSteven Rostedt (VMware)  * ftrace_rec_iter_start - start up iterating over traced functions
2658c88fd863SSteven Rostedt  *
2659c88fd863SSteven Rostedt  * Returns an iterator handle that is used to iterate over all
2660c88fd863SSteven Rostedt  * the records that represent address locations where functions
2661c88fd863SSteven Rostedt  * are traced.
2662c88fd863SSteven Rostedt  *
2663c88fd863SSteven Rostedt  * May return NULL if no records are available.
2664c88fd863SSteven Rostedt  */
2665c88fd863SSteven Rostedt struct ftrace_rec_iter *ftrace_rec_iter_start(void)
2666c88fd863SSteven Rostedt {
2667c88fd863SSteven Rostedt 	/*
2668c88fd863SSteven Rostedt 	 * We only use a single iterator.
2669c88fd863SSteven Rostedt 	 * Protected by the ftrace_lock mutex.
2670c88fd863SSteven Rostedt 	 */
2671c88fd863SSteven Rostedt 	static struct ftrace_rec_iter ftrace_rec_iter;
2672c88fd863SSteven Rostedt 	struct ftrace_rec_iter *iter = &ftrace_rec_iter;
2673c88fd863SSteven Rostedt 
2674c88fd863SSteven Rostedt 	iter->pg = ftrace_pages_start;
2675c88fd863SSteven Rostedt 	iter->index = 0;
2676c88fd863SSteven Rostedt 
2677c88fd863SSteven Rostedt 	/* Could have empty pages */
2678c88fd863SSteven Rostedt 	while (iter->pg && !iter->pg->index)
2679c88fd863SSteven Rostedt 		iter->pg = iter->pg->next;
2680c88fd863SSteven Rostedt 
2681c88fd863SSteven Rostedt 	if (!iter->pg)
2682c88fd863SSteven Rostedt 		return NULL;
2683c88fd863SSteven Rostedt 
2684c88fd863SSteven Rostedt 	return iter;
2685c88fd863SSteven Rostedt }
2686c88fd863SSteven Rostedt 
2687c88fd863SSteven Rostedt /**
26886130722fSSteven Rostedt (VMware)  * ftrace_rec_iter_next - get the next record to process.
2689c88fd863SSteven Rostedt  * @iter: The handle to the iterator.
2690c88fd863SSteven Rostedt  *
2691c88fd863SSteven Rostedt  * Returns the next iterator after the given iterator @iter.
2692c88fd863SSteven Rostedt  */
2693c88fd863SSteven Rostedt struct ftrace_rec_iter *ftrace_rec_iter_next(struct ftrace_rec_iter *iter)
2694c88fd863SSteven Rostedt {
2695c88fd863SSteven Rostedt 	iter->index++;
2696c88fd863SSteven Rostedt 
2697c88fd863SSteven Rostedt 	if (iter->index >= iter->pg->index) {
2698c88fd863SSteven Rostedt 		iter->pg = iter->pg->next;
2699c88fd863SSteven Rostedt 		iter->index = 0;
2700c88fd863SSteven Rostedt 
2701c88fd863SSteven Rostedt 		/* Could have empty pages */
2702c88fd863SSteven Rostedt 		while (iter->pg && !iter->pg->index)
2703c88fd863SSteven Rostedt 			iter->pg = iter->pg->next;
2704c88fd863SSteven Rostedt 	}
2705c88fd863SSteven Rostedt 
2706c88fd863SSteven Rostedt 	if (!iter->pg)
2707c88fd863SSteven Rostedt 		return NULL;
2708c88fd863SSteven Rostedt 
2709c88fd863SSteven Rostedt 	return iter;
2710c88fd863SSteven Rostedt }
2711c88fd863SSteven Rostedt 
2712c88fd863SSteven Rostedt /**
27136130722fSSteven Rostedt (VMware)  * ftrace_rec_iter_record - get the record at the iterator location
2714c88fd863SSteven Rostedt  * @iter: The current iterator location
2715c88fd863SSteven Rostedt  *
2716c88fd863SSteven Rostedt  * Returns the record that the current @iter is at.
2717c88fd863SSteven Rostedt  */
2718c88fd863SSteven Rostedt struct dyn_ftrace *ftrace_rec_iter_record(struct ftrace_rec_iter *iter)
2719c88fd863SSteven Rostedt {
2720c88fd863SSteven Rostedt 	return &iter->pg->records[iter->index];
2721c88fd863SSteven Rostedt }
2722c88fd863SSteven Rostedt 
27233b47bfc1SSteven Rostedt static int
2724fbf6c73cSMark Rutland ftrace_nop_initialize(struct module *mod, struct dyn_ftrace *rec)
27253c1720f0SSteven Rostedt {
2726492a7ea5SAbhishek Sagar 	int ret;
272737ad5084SSteven Rostedt 
272845a4a237SSteven Rostedt 	if (unlikely(ftrace_disabled))
272945a4a237SSteven Rostedt 		return 0;
273045a4a237SSteven Rostedt 
2731fbf6c73cSMark Rutland 	ret = ftrace_init_nop(mod, rec);
27323d083395SSteven Rostedt 	if (ret) {
273302a392a0SSteven Rostedt (Red Hat) 		ftrace_bug_type = FTRACE_BUG_INIT;
27344fd3279bSSteven Rostedt (Red Hat) 		ftrace_bug(ret, rec);
27353d083395SSteven Rostedt 		return 0;
2736d61f82d0SSteven Rostedt 	}
2737d61f82d0SSteven Rostedt 	return 1;
27383d083395SSteven Rostedt }
27393d083395SSteven Rostedt 
2740000ab691SSteven Rostedt /*
2741000ab691SSteven Rostedt  * archs can override this function if they must do something
2742000ab691SSteven Rostedt  * before the modifying code is performed.
2743000ab691SSteven Rostedt  */
27443a2bfec0SLi kunyu void __weak ftrace_arch_code_modify_prepare(void)
2745000ab691SSteven Rostedt {
2746000ab691SSteven Rostedt }
2747000ab691SSteven Rostedt 
2748000ab691SSteven Rostedt /*
2749000ab691SSteven Rostedt  * archs can override this function if they must do something
2750000ab691SSteven Rostedt  * after the modifying code is performed.
2751000ab691SSteven Rostedt  */
27523a2bfec0SLi kunyu void __weak ftrace_arch_code_modify_post_process(void)
2753000ab691SSteven Rostedt {
2754000ab691SSteven Rostedt }
2755000ab691SSteven Rostedt 
27568ed3e2cfSSteven Rostedt void ftrace_modify_all_code(int command)
27578ed3e2cfSSteven Rostedt {
275859338f75SSteven Rostedt (Red Hat) 	int update = command & FTRACE_UPDATE_TRACE_FUNC;
2759a0572f68SSteven Rostedt (VMware) 	int mod_flags = 0;
2760cd21067fSPetr Mladek 	int err = 0;
276159338f75SSteven Rostedt (Red Hat) 
2762a0572f68SSteven Rostedt (VMware) 	if (command & FTRACE_MAY_SLEEP)
2763a0572f68SSteven Rostedt (VMware) 		mod_flags = FTRACE_MODIFY_MAY_SLEEP_FL;
2764a0572f68SSteven Rostedt (VMware) 
276559338f75SSteven Rostedt (Red Hat) 	/*
276659338f75SSteven Rostedt (Red Hat) 	 * If the ftrace_caller calls a ftrace_ops func directly,
276759338f75SSteven Rostedt (Red Hat) 	 * we need to make sure that it only traces functions it
276859338f75SSteven Rostedt (Red Hat) 	 * expects to trace. When doing the switch of functions,
276959338f75SSteven Rostedt (Red Hat) 	 * we need to update to the ftrace_ops_list_func first
277059338f75SSteven Rostedt (Red Hat) 	 * before the transition between old and new calls are set,
277159338f75SSteven Rostedt (Red Hat) 	 * as the ftrace_ops_list_func will check the ops hashes
277259338f75SSteven Rostedt (Red Hat) 	 * to make sure the ops are having the right functions
277359338f75SSteven Rostedt (Red Hat) 	 * traced.
277459338f75SSteven Rostedt (Red Hat) 	 */
2775cd21067fSPetr Mladek 	if (update) {
2776cd21067fSPetr Mladek 		err = ftrace_update_ftrace_func(ftrace_ops_list_func);
2777cd21067fSPetr Mladek 		if (FTRACE_WARN_ON(err))
2778cd21067fSPetr Mladek 			return;
2779cd21067fSPetr Mladek 	}
278059338f75SSteven Rostedt (Red Hat) 
27818ed3e2cfSSteven Rostedt 	if (command & FTRACE_UPDATE_CALLS)
2782a0572f68SSteven Rostedt (VMware) 		ftrace_replace_code(mod_flags | FTRACE_MODIFY_ENABLE_FL);
27838ed3e2cfSSteven Rostedt 	else if (command & FTRACE_DISABLE_CALLS)
2784a0572f68SSteven Rostedt (VMware) 		ftrace_replace_code(mod_flags);
27858ed3e2cfSSteven Rostedt 
2786405e1d83SSteven Rostedt (Red Hat) 	if (update && ftrace_trace_function != ftrace_ops_list_func) {
2787405e1d83SSteven Rostedt (Red Hat) 		function_trace_op = set_function_trace_op;
2788405e1d83SSteven Rostedt (Red Hat) 		smp_wmb();
2789405e1d83SSteven Rostedt (Red Hat) 		/* If irqs are disabled, we are in stop machine */
2790405e1d83SSteven Rostedt (Red Hat) 		if (!irqs_disabled())
2791405e1d83SSteven Rostedt (Red Hat) 			smp_call_function(ftrace_sync_ipi, NULL, 1);
2792cd21067fSPetr Mladek 		err = ftrace_update_ftrace_func(ftrace_trace_function);
2793cd21067fSPetr Mladek 		if (FTRACE_WARN_ON(err))
2794cd21067fSPetr Mladek 			return;
2795405e1d83SSteven Rostedt (Red Hat) 	}
27968ed3e2cfSSteven Rostedt 
27978ed3e2cfSSteven Rostedt 	if (command & FTRACE_START_FUNC_RET)
2798cd21067fSPetr Mladek 		err = ftrace_enable_ftrace_graph_caller();
27998ed3e2cfSSteven Rostedt 	else if (command & FTRACE_STOP_FUNC_RET)
2800cd21067fSPetr Mladek 		err = ftrace_disable_ftrace_graph_caller();
2801cd21067fSPetr Mladek 	FTRACE_WARN_ON(err);
28028ed3e2cfSSteven Rostedt }
28038ed3e2cfSSteven Rostedt 
28043d083395SSteven Rostedt static int __ftrace_modify_code(void *data)
28053d083395SSteven Rostedt {
28063d083395SSteven Rostedt 	int *command = data;
28073d083395SSteven Rostedt 
28088ed3e2cfSSteven Rostedt 	ftrace_modify_all_code(*command);
28095a45cfe1SSteven Rostedt 
2810c88fd863SSteven Rostedt 	return 0;
2811c88fd863SSteven Rostedt }
2812c88fd863SSteven Rostedt 
2813c88fd863SSteven Rostedt /**
28146130722fSSteven Rostedt (VMware)  * ftrace_run_stop_machine - go back to the stop machine method
2815c88fd863SSteven Rostedt  * @command: The command to tell ftrace what to do
2816c88fd863SSteven Rostedt  *
2817c88fd863SSteven Rostedt  * If an arch needs to fall back to the stop machine method, the
2818c88fd863SSteven Rostedt  * it can call this function.
2819c88fd863SSteven Rostedt  */
2820c88fd863SSteven Rostedt void ftrace_run_stop_machine(int command)
2821c88fd863SSteven Rostedt {
2822c88fd863SSteven Rostedt 	stop_machine(__ftrace_modify_code, &command, NULL);
2823c88fd863SSteven Rostedt }
2824c88fd863SSteven Rostedt 
2825c88fd863SSteven Rostedt /**
28266130722fSSteven Rostedt (VMware)  * arch_ftrace_update_code - modify the code to trace or not trace
2827c88fd863SSteven Rostedt  * @command: The command that needs to be done
2828c88fd863SSteven Rostedt  *
2829c88fd863SSteven Rostedt  * Archs can override this function if it does not need to
2830c88fd863SSteven Rostedt  * run stop_machine() to modify code.
2831c88fd863SSteven Rostedt  */
2832c88fd863SSteven Rostedt void __weak arch_ftrace_update_code(int command)
2833c88fd863SSteven Rostedt {
2834c88fd863SSteven Rostedt 	ftrace_run_stop_machine(command);
2835c88fd863SSteven Rostedt }
2836c88fd863SSteven Rostedt 
2837c88fd863SSteven Rostedt static void ftrace_run_update_code(int command)
2838c88fd863SSteven Rostedt {
28393a2bfec0SLi kunyu 	ftrace_arch_code_modify_prepare();
2840c88fd863SSteven Rostedt 
2841c88fd863SSteven Rostedt 	/*
2842c88fd863SSteven Rostedt 	 * By default we use stop_machine() to modify the code.
2843c88fd863SSteven Rostedt 	 * But archs can do what ever they want as long as it
2844c88fd863SSteven Rostedt 	 * is safe. The stop_machine() is the safest, but also
2845c88fd863SSteven Rostedt 	 * produces the most overhead.
2846c88fd863SSteven Rostedt 	 */
2847c88fd863SSteven Rostedt 	arch_ftrace_update_code(command);
2848c88fd863SSteven Rostedt 
28493a2bfec0SLi kunyu 	ftrace_arch_code_modify_post_process();
28503d083395SSteven Rostedt }
28513d083395SSteven Rostedt 
28528252ecf3SSteven Rostedt (Red Hat) static void ftrace_run_modify_code(struct ftrace_ops *ops, int command,
28537485058eSSteven Rostedt (Red Hat) 				   struct ftrace_ops_hash *old_hash)
2854e1effa01SSteven Rostedt (Red Hat) {
2855e1effa01SSteven Rostedt (Red Hat) 	ops->flags |= FTRACE_OPS_FL_MODIFYING;
28567485058eSSteven Rostedt (Red Hat) 	ops->old_hash.filter_hash = old_hash->filter_hash;
28577485058eSSteven Rostedt (Red Hat) 	ops->old_hash.notrace_hash = old_hash->notrace_hash;
2858e1effa01SSteven Rostedt (Red Hat) 	ftrace_run_update_code(command);
28598252ecf3SSteven Rostedt (Red Hat) 	ops->old_hash.filter_hash = NULL;
28607485058eSSteven Rostedt (Red Hat) 	ops->old_hash.notrace_hash = NULL;
2861e1effa01SSteven Rostedt (Red Hat) 	ops->flags &= ~FTRACE_OPS_FL_MODIFYING;
2862e1effa01SSteven Rostedt (Red Hat) }
2863e1effa01SSteven Rostedt (Red Hat) 
28643d083395SSteven Rostedt static ftrace_func_t saved_ftrace_func;
286560a7ecf4SSteven Rostedt static int ftrace_start_up;
2866df4fc315SSteven Rostedt 
286712cce594SSteven Rostedt (Red Hat) void __weak arch_ftrace_trampoline_free(struct ftrace_ops *ops)
286812cce594SSteven Rostedt (Red Hat) {
286912cce594SSteven Rostedt (Red Hat) }
287012cce594SSteven Rostedt (Red Hat) 
2871fc0ea795SAdrian Hunter /* List of trace_ops that have allocated trampolines */
2872fc0ea795SAdrian Hunter static LIST_HEAD(ftrace_ops_trampoline_list);
2873fc0ea795SAdrian Hunter 
2874fc0ea795SAdrian Hunter static void ftrace_add_trampoline_to_kallsyms(struct ftrace_ops *ops)
2875fc0ea795SAdrian Hunter {
2876fc0ea795SAdrian Hunter 	lockdep_assert_held(&ftrace_lock);
2877fc0ea795SAdrian Hunter 	list_add_rcu(&ops->list, &ftrace_ops_trampoline_list);
2878fc0ea795SAdrian Hunter }
2879fc0ea795SAdrian Hunter 
2880fc0ea795SAdrian Hunter static void ftrace_remove_trampoline_from_kallsyms(struct ftrace_ops *ops)
2881fc0ea795SAdrian Hunter {
2882fc0ea795SAdrian Hunter 	lockdep_assert_held(&ftrace_lock);
2883fc0ea795SAdrian Hunter 	list_del_rcu(&ops->list);
2884478ece95SAdrian Hunter 	synchronize_rcu();
2885fc0ea795SAdrian Hunter }
2886fc0ea795SAdrian Hunter 
2887fc0ea795SAdrian Hunter /*
2888fc0ea795SAdrian Hunter  * "__builtin__ftrace" is used as a module name in /proc/kallsyms for symbols
2889fc0ea795SAdrian Hunter  * for pages allocated for ftrace purposes, even though "__builtin__ftrace" is
2890fc0ea795SAdrian Hunter  * not a module.
2891fc0ea795SAdrian Hunter  */
2892fc0ea795SAdrian Hunter #define FTRACE_TRAMPOLINE_MOD "__builtin__ftrace"
2893fc0ea795SAdrian Hunter #define FTRACE_TRAMPOLINE_SYM "ftrace_trampoline"
2894fc0ea795SAdrian Hunter 
2895fc0ea795SAdrian Hunter static void ftrace_trampoline_free(struct ftrace_ops *ops)
2896fc0ea795SAdrian Hunter {
2897fc0ea795SAdrian Hunter 	if (ops && (ops->flags & FTRACE_OPS_FL_ALLOC_TRAMP) &&
2898dd9ddf46SAdrian Hunter 	    ops->trampoline) {
2899548e1f6cSAdrian Hunter 		/*
2900548e1f6cSAdrian Hunter 		 * Record the text poke event before the ksymbol unregister
2901548e1f6cSAdrian Hunter 		 * event.
2902548e1f6cSAdrian Hunter 		 */
2903548e1f6cSAdrian Hunter 		perf_event_text_poke((void *)ops->trampoline,
2904548e1f6cSAdrian Hunter 				     (void *)ops->trampoline,
2905548e1f6cSAdrian Hunter 				     ops->trampoline_size, NULL, 0);
2906dd9ddf46SAdrian Hunter 		perf_event_ksymbol(PERF_RECORD_KSYMBOL_TYPE_OOL,
2907dd9ddf46SAdrian Hunter 				   ops->trampoline, ops->trampoline_size,
2908dd9ddf46SAdrian Hunter 				   true, FTRACE_TRAMPOLINE_SYM);
2909dd9ddf46SAdrian Hunter 		/* Remove from kallsyms after the perf events */
2910fc0ea795SAdrian Hunter 		ftrace_remove_trampoline_from_kallsyms(ops);
2911dd9ddf46SAdrian Hunter 	}
2912fc0ea795SAdrian Hunter 
2913fc0ea795SAdrian Hunter 	arch_ftrace_trampoline_free(ops);
2914fc0ea795SAdrian Hunter }
2915fc0ea795SAdrian Hunter 
2916df4fc315SSteven Rostedt static void ftrace_startup_enable(int command)
2917df4fc315SSteven Rostedt {
2918df4fc315SSteven Rostedt 	if (saved_ftrace_func != ftrace_trace_function) {
2919df4fc315SSteven Rostedt 		saved_ftrace_func = ftrace_trace_function;
2920df4fc315SSteven Rostedt 		command |= FTRACE_UPDATE_TRACE_FUNC;
2921df4fc315SSteven Rostedt 	}
2922df4fc315SSteven Rostedt 
2923df4fc315SSteven Rostedt 	if (!command || !ftrace_enabled)
2924df4fc315SSteven Rostedt 		return;
2925df4fc315SSteven Rostedt 
2926df4fc315SSteven Rostedt 	ftrace_run_update_code(command);
2927df4fc315SSteven Rostedt }
29283d083395SSteven Rostedt 
2929e1effa01SSteven Rostedt (Red Hat) static void ftrace_startup_all(int command)
2930e1effa01SSteven Rostedt (Red Hat) {
2931e1effa01SSteven Rostedt (Red Hat) 	update_all_ops = true;
2932e1effa01SSteven Rostedt (Red Hat) 	ftrace_startup_enable(command);
2933e1effa01SSteven Rostedt (Red Hat) 	update_all_ops = false;
2934e1effa01SSteven Rostedt (Red Hat) }
2935e1effa01SSteven Rostedt (Red Hat) 
29363306fc4aSSteven Rostedt (VMware) int ftrace_startup(struct ftrace_ops *ops, int command)
29373d083395SSteven Rostedt {
29388a56d776SSteven Rostedt (Red Hat) 	int ret;
2939b848914cSSteven Rostedt 
29404eebcc81SSteven Rostedt 	if (unlikely(ftrace_disabled))
2941a1cd6173SSteven Rostedt 		return -ENODEV;
29424eebcc81SSteven Rostedt 
29438a56d776SSteven Rostedt (Red Hat) 	ret = __register_ftrace_function(ops);
29448a56d776SSteven Rostedt (Red Hat) 	if (ret)
29458a56d776SSteven Rostedt (Red Hat) 		return ret;
29468a56d776SSteven Rostedt (Red Hat) 
294760a7ecf4SSteven Rostedt 	ftrace_start_up++;
29483d083395SSteven Rostedt 
2949e1effa01SSteven Rostedt (Red Hat) 	/*
2950e1effa01SSteven Rostedt (Red Hat) 	 * Note that ftrace probes uses this to start up
2951e1effa01SSteven Rostedt (Red Hat) 	 * and modify functions it will probe. But we still
2952e1effa01SSteven Rostedt (Red Hat) 	 * set the ADDING flag for modification, as probes
2953e1effa01SSteven Rostedt (Red Hat) 	 * do not have trampolines. If they add them in the
2954e1effa01SSteven Rostedt (Red Hat) 	 * future, then the probes will need to distinguish
2955e1effa01SSteven Rostedt (Red Hat) 	 * between adding and updating probes.
2956e1effa01SSteven Rostedt (Red Hat) 	 */
2957e1effa01SSteven Rostedt (Red Hat) 	ops->flags |= FTRACE_OPS_FL_ENABLED | FTRACE_OPS_FL_ADDING;
295866209a5bSSteven Rostedt (Red Hat) 
2959f8b8be8aSMasami Hiramatsu 	ret = ftrace_hash_ipmodify_enable(ops);
2960f8b8be8aSMasami Hiramatsu 	if (ret < 0) {
2961f8b8be8aSMasami Hiramatsu 		/* Rollback registration process */
2962f8b8be8aSMasami Hiramatsu 		__unregister_ftrace_function(ops);
2963f8b8be8aSMasami Hiramatsu 		ftrace_start_up--;
2964f8b8be8aSMasami Hiramatsu 		ops->flags &= ~FTRACE_OPS_FL_ENABLED;
2965d5e47505SMiroslav Benes 		if (ops->flags & FTRACE_OPS_FL_DYNAMIC)
2966d5e47505SMiroslav Benes 			ftrace_trampoline_free(ops);
2967f8b8be8aSMasami Hiramatsu 		return ret;
2968f8b8be8aSMasami Hiramatsu 	}
2969f8b8be8aSMasami Hiramatsu 
29707f50d06bSJiri Olsa 	if (ftrace_hash_rec_enable(ops, 1))
29717f50d06bSJiri Olsa 		command |= FTRACE_UPDATE_CALLS;
2972ed926f9bSSteven Rostedt 
2973df4fc315SSteven Rostedt 	ftrace_startup_enable(command);
2974a1cd6173SSteven Rostedt 
2975c3b0f72eSYang Jihong 	/*
2976c3b0f72eSYang Jihong 	 * If ftrace is in an undefined state, we just remove ops from list
2977c3b0f72eSYang Jihong 	 * to prevent the NULL pointer, instead of totally rolling it back and
2978c3b0f72eSYang Jihong 	 * free trampoline, because those actions could cause further damage.
2979c3b0f72eSYang Jihong 	 */
2980c3b0f72eSYang Jihong 	if (unlikely(ftrace_disabled)) {
2981c3b0f72eSYang Jihong 		__unregister_ftrace_function(ops);
2982c3b0f72eSYang Jihong 		return -ENODEV;
2983c3b0f72eSYang Jihong 	}
2984c3b0f72eSYang Jihong 
2985e1effa01SSteven Rostedt (Red Hat) 	ops->flags &= ~FTRACE_OPS_FL_ADDING;
2986e1effa01SSteven Rostedt (Red Hat) 
2987a1cd6173SSteven Rostedt 	return 0;
29883d083395SSteven Rostedt }
29893d083395SSteven Rostedt 
29903306fc4aSSteven Rostedt (VMware) int ftrace_shutdown(struct ftrace_ops *ops, int command)
29913d083395SSteven Rostedt {
29928a56d776SSteven Rostedt (Red Hat) 	int ret;
2993b848914cSSteven Rostedt 
29944eebcc81SSteven Rostedt 	if (unlikely(ftrace_disabled))
29958a56d776SSteven Rostedt (Red Hat) 		return -ENODEV;
29968a56d776SSteven Rostedt (Red Hat) 
29978a56d776SSteven Rostedt (Red Hat) 	ret = __unregister_ftrace_function(ops);
29988a56d776SSteven Rostedt (Red Hat) 	if (ret)
29998a56d776SSteven Rostedt (Red Hat) 		return ret;
30004eebcc81SSteven Rostedt 
300160a7ecf4SSteven Rostedt 	ftrace_start_up--;
30029ea1a153SFrederic Weisbecker 	/*
30039ea1a153SFrederic Weisbecker 	 * Just warn in case of unbalance, no need to kill ftrace, it's not
30049ea1a153SFrederic Weisbecker 	 * critical but the ftrace_call callers may be never nopped again after
30059ea1a153SFrederic Weisbecker 	 * further ftrace uses.
30069ea1a153SFrederic Weisbecker 	 */
30079ea1a153SFrederic Weisbecker 	WARN_ON_ONCE(ftrace_start_up < 0);
30089ea1a153SFrederic Weisbecker 
3009f8b8be8aSMasami Hiramatsu 	/* Disabling ipmodify never fails */
3010f8b8be8aSMasami Hiramatsu 	ftrace_hash_ipmodify_disable(ops);
30117f50d06bSJiri Olsa 
30127f50d06bSJiri Olsa 	if (ftrace_hash_rec_disable(ops, 1))
30137f50d06bSJiri Olsa 		command |= FTRACE_UPDATE_CALLS;
3014ed926f9bSSteven Rostedt 
3015ed926f9bSSteven Rostedt 	ops->flags &= ~FTRACE_OPS_FL_ENABLED;
3016b848914cSSteven Rostedt 
3017d61f82d0SSteven Rostedt 	if (saved_ftrace_func != ftrace_trace_function) {
3018d61f82d0SSteven Rostedt 		saved_ftrace_func = ftrace_trace_function;
3019d61f82d0SSteven Rostedt 		command |= FTRACE_UPDATE_TRACE_FUNC;
3020d61f82d0SSteven Rostedt 	}
3021d61f82d0SSteven Rostedt 
3022a4c35ed2SSteven Rostedt (Red Hat) 	if (!command || !ftrace_enabled) {
3023a4c35ed2SSteven Rostedt (Red Hat) 		/*
3024edb096e0SSteven Rostedt (VMware) 		 * If these are dynamic or per_cpu ops, they still
3025edb096e0SSteven Rostedt (VMware) 		 * need their data freed. Since, function tracing is
3026a4c35ed2SSteven Rostedt (Red Hat) 		 * not currently active, we can just free them
3027a4c35ed2SSteven Rostedt (Red Hat) 		 * without synchronizing all CPUs.
3028a4c35ed2SSteven Rostedt (Red Hat) 		 */
3029b3a88803SPeter Zijlstra 		if (ops->flags & FTRACE_OPS_FL_DYNAMIC)
3030edb096e0SSteven Rostedt (VMware) 			goto free_ops;
3031edb096e0SSteven Rostedt (VMware) 
30328a56d776SSteven Rostedt (Red Hat) 		return 0;
3033a4c35ed2SSteven Rostedt (Red Hat) 	}
30343d083395SSteven Rostedt 
303579922b80SSteven Rostedt (Red Hat) 	/*
303679922b80SSteven Rostedt (Red Hat) 	 * If the ops uses a trampoline, then it needs to be
303779922b80SSteven Rostedt (Red Hat) 	 * tested first on update.
303879922b80SSteven Rostedt (Red Hat) 	 */
3039e1effa01SSteven Rostedt (Red Hat) 	ops->flags |= FTRACE_OPS_FL_REMOVING;
304079922b80SSteven Rostedt (Red Hat) 	removed_ops = ops;
304179922b80SSteven Rostedt (Red Hat) 
3042fef5aeeeSSteven Rostedt (Red Hat) 	/* The trampoline logic checks the old hashes */
3043fef5aeeeSSteven Rostedt (Red Hat) 	ops->old_hash.filter_hash = ops->func_hash->filter_hash;
3044fef5aeeeSSteven Rostedt (Red Hat) 	ops->old_hash.notrace_hash = ops->func_hash->notrace_hash;
3045fef5aeeeSSteven Rostedt (Red Hat) 
3046d61f82d0SSteven Rostedt 	ftrace_run_update_code(command);
3047a4c35ed2SSteven Rostedt (Red Hat) 
304884bde62cSSteven Rostedt (Red Hat) 	/*
304984bde62cSSteven Rostedt (Red Hat) 	 * If there's no more ops registered with ftrace, run a
305084bde62cSSteven Rostedt (Red Hat) 	 * sanity check to make sure all rec flags are cleared.
305184bde62cSSteven Rostedt (Red Hat) 	 */
3052f86f4180SChunyan Zhang 	if (rcu_dereference_protected(ftrace_ops_list,
3053f86f4180SChunyan Zhang 			lockdep_is_held(&ftrace_lock)) == &ftrace_list_end) {
305484bde62cSSteven Rostedt (Red Hat) 		struct ftrace_page *pg;
305584bde62cSSteven Rostedt (Red Hat) 		struct dyn_ftrace *rec;
305684bde62cSSteven Rostedt (Red Hat) 
305784bde62cSSteven Rostedt (Red Hat) 		do_for_each_ftrace_rec(pg, rec) {
3058977c1f9cSAlexei Starovoitov 			if (FTRACE_WARN_ON_ONCE(rec->flags & ~FTRACE_FL_DISABLED))
305984bde62cSSteven Rostedt (Red Hat) 				pr_warn("  %pS flags:%lx\n",
306084bde62cSSteven Rostedt (Red Hat) 					(void *)rec->ip, rec->flags);
306184bde62cSSteven Rostedt (Red Hat) 		} while_for_each_ftrace_rec();
306284bde62cSSteven Rostedt (Red Hat) 	}
306384bde62cSSteven Rostedt (Red Hat) 
3064fef5aeeeSSteven Rostedt (Red Hat) 	ops->old_hash.filter_hash = NULL;
3065fef5aeeeSSteven Rostedt (Red Hat) 	ops->old_hash.notrace_hash = NULL;
3066fef5aeeeSSteven Rostedt (Red Hat) 
3067fef5aeeeSSteven Rostedt (Red Hat) 	removed_ops = NULL;
3068e1effa01SSteven Rostedt (Red Hat) 	ops->flags &= ~FTRACE_OPS_FL_REMOVING;
306979922b80SSteven Rostedt (Red Hat) 
3070a4c35ed2SSteven Rostedt (Red Hat) 	/*
3071a4c35ed2SSteven Rostedt (Red Hat) 	 * Dynamic ops may be freed, we must make sure that all
3072a4c35ed2SSteven Rostedt (Red Hat) 	 * callers are done before leaving this function.
3073ba27f2bcSSteven Rostedt (Red Hat) 	 * The same goes for freeing the per_cpu data of the per_cpu
3074a4c35ed2SSteven Rostedt (Red Hat) 	 * ops.
30750598e4f0SSteven Rostedt (VMware) 	 */
3076b3a88803SPeter Zijlstra 	if (ops->flags & FTRACE_OPS_FL_DYNAMIC) {
30770598e4f0SSteven Rostedt (VMware) 		/*
3078a4c35ed2SSteven Rostedt (Red Hat) 		 * We need to do a hard force of sched synchronization.
3079a4c35ed2SSteven Rostedt (Red Hat) 		 * This is because we use preempt_disable() to do RCU, but
3080a4c35ed2SSteven Rostedt (Red Hat) 		 * the function tracers can be called where RCU is not watching
3081a4c35ed2SSteven Rostedt (Red Hat) 		 * (like before user_exit()). We can not rely on the RCU
3082a4c35ed2SSteven Rostedt (Red Hat) 		 * infrastructure to do the synchronization, thus we must do it
3083a4c35ed2SSteven Rostedt (Red Hat) 		 * ourselves.
3084a4c35ed2SSteven Rostedt (Red Hat) 		 */
3085e5a971d7SPaul E. McKenney 		synchronize_rcu_tasks_rude();
3086a4c35ed2SSteven Rostedt (Red Hat) 
30870598e4f0SSteven Rostedt (VMware) 		/*
3088fdda88d3SQiujun Huang 		 * When the kernel is preemptive, tasks can be preempted
30890598e4f0SSteven Rostedt (VMware) 		 * while on a ftrace trampoline. Just scheduling a task on
30900598e4f0SSteven Rostedt (VMware) 		 * a CPU is not good enough to flush them. Calling
3091f2cc020dSIngo Molnar 		 * synchronize_rcu_tasks() will wait for those tasks to
30920598e4f0SSteven Rostedt (VMware) 		 * execute and either schedule voluntarily or enter user space.
30930598e4f0SSteven Rostedt (VMware) 		 */
309430c93704SThomas Gleixner 		if (IS_ENABLED(CONFIG_PREEMPTION))
30950598e4f0SSteven Rostedt (VMware) 			synchronize_rcu_tasks();
30960598e4f0SSteven Rostedt (VMware) 
3097edb096e0SSteven Rostedt (VMware)  free_ops:
3098fc0ea795SAdrian Hunter 		ftrace_trampoline_free(ops);
3099a4c35ed2SSteven Rostedt (Red Hat) 	}
3100a4c35ed2SSteven Rostedt (Red Hat) 
31018a56d776SSteven Rostedt (Red Hat) 	return 0;
31023d083395SSteven Rostedt }
31033d083395SSteven Rostedt 
3104a5a1d1c2SThomas Gleixner static u64		ftrace_update_time;
31053d083395SSteven Rostedt unsigned long		ftrace_update_tot_cnt;
3106da537f0aSSteven Rostedt (VMware) unsigned long		ftrace_number_of_pages;
3107da537f0aSSteven Rostedt (VMware) unsigned long		ftrace_number_of_groups;
31083d083395SSteven Rostedt 
31098c4f3c3fSSteven Rostedt (Red Hat) static inline int ops_traces_mod(struct ftrace_ops *ops)
3110f7bc8b61SSteven Rostedt {
31118c4f3c3fSSteven Rostedt (Red Hat) 	/*
31128c4f3c3fSSteven Rostedt (Red Hat) 	 * Filter_hash being empty will default to trace module.
31138c4f3c3fSSteven Rostedt (Red Hat) 	 * But notrace hash requires a test of individual module functions.
31148c4f3c3fSSteven Rostedt (Red Hat) 	 */
311533b7f99cSSteven Rostedt (Red Hat) 	return ftrace_hash_empty(ops->func_hash->filter_hash) &&
311633b7f99cSSteven Rostedt (Red Hat) 		ftrace_hash_empty(ops->func_hash->notrace_hash);
31178c4f3c3fSSteven Rostedt (Red Hat) }
3118f7bc8b61SSteven Rostedt 
31191dc43cf0SJiri Slaby static int ftrace_update_code(struct module *mod, struct ftrace_page *new_pgs)
31203d083395SSteven Rostedt {
312167ccddf8SIlya Leoshkevich 	bool init_nop = ftrace_need_init_nop();
312285ae32aeSSteven Rostedt 	struct ftrace_page *pg;
3123e94142a6SLai Jiangshan 	struct dyn_ftrace *p;
3124a5a1d1c2SThomas Gleixner 	u64 start, stop;
31251dc43cf0SJiri Slaby 	unsigned long update_cnt = 0;
3126b7ffffbbSSteven Rostedt (Red Hat) 	unsigned long rec_flags = 0;
312785ae32aeSSteven Rostedt 	int i;
3128f7bc8b61SSteven Rostedt 
3129750ed1a4SIngo Molnar 	start = ftrace_now(raw_smp_processor_id());
31303d083395SSteven Rostedt 
3131b7ffffbbSSteven Rostedt (Red Hat) 	/*
3132b7ffffbbSSteven Rostedt (Red Hat) 	 * When a module is loaded, this function is called to convert
3133b7ffffbbSSteven Rostedt (Red Hat) 	 * the calls to mcount in its text to nops, and also to create
3134b7ffffbbSSteven Rostedt (Red Hat) 	 * an entry in the ftrace data. Now, if ftrace is activated
3135b7ffffbbSSteven Rostedt (Red Hat) 	 * after this call, but before the module sets its text to
3136b7ffffbbSSteven Rostedt (Red Hat) 	 * read-only, the modification of enabling ftrace can fail if
3137b7ffffbbSSteven Rostedt (Red Hat) 	 * the read-only is done while ftrace is converting the calls.
3138b7ffffbbSSteven Rostedt (Red Hat) 	 * To prevent this, the module's records are set as disabled
3139b7ffffbbSSteven Rostedt (Red Hat) 	 * and will be enabled after the call to set the module's text
3140b7ffffbbSSteven Rostedt (Red Hat) 	 * to read-only.
3141b7ffffbbSSteven Rostedt (Red Hat) 	 */
3142b7ffffbbSSteven Rostedt (Red Hat) 	if (mod)
3143b7ffffbbSSteven Rostedt (Red Hat) 		rec_flags |= FTRACE_FL_DISABLED;
3144b7ffffbbSSteven Rostedt (Red Hat) 
31451dc43cf0SJiri Slaby 	for (pg = new_pgs; pg; pg = pg->next) {
3146f22f9a89SAbhishek Sagar 
314785ae32aeSSteven Rostedt 		for (i = 0; i < pg->index; i++) {
31488c4f3c3fSSteven Rostedt (Red Hat) 
314908f5ac90SSteven Rostedt 			/* If something went wrong, bail without enabling anything */
315008f5ac90SSteven Rostedt 			if (unlikely(ftrace_disabled))
315108f5ac90SSteven Rostedt 				return -1;
31523d083395SSteven Rostedt 
315385ae32aeSSteven Rostedt 			p = &pg->records[i];
3154b7ffffbbSSteven Rostedt (Red Hat) 			p->flags = rec_flags;
3155f22f9a89SAbhishek Sagar 
31565cb084bbSJiri Olsa 			/*
315725985edcSLucas De Marchi 			 * Do the initial record conversion from mcount jump
31585cb084bbSJiri Olsa 			 * to the NOP instructions.
31595cb084bbSJiri Olsa 			 */
316067ccddf8SIlya Leoshkevich 			if (init_nop && !ftrace_nop_initialize(mod, p))
3161d2c8c3eaSSteven Rostedt 				break;
31625cb084bbSJiri Olsa 
31631dc43cf0SJiri Slaby 			update_cnt++;
31645cb084bbSJiri Olsa 		}
316585ae32aeSSteven Rostedt 	}
316685ae32aeSSteven Rostedt 
3167750ed1a4SIngo Molnar 	stop = ftrace_now(raw_smp_processor_id());
31683d083395SSteven Rostedt 	ftrace_update_time = stop - start;
31691dc43cf0SJiri Slaby 	ftrace_update_tot_cnt += update_cnt;
31703d083395SSteven Rostedt 
317116444a8aSArnaldo Carvalho de Melo 	return 0;
317216444a8aSArnaldo Carvalho de Melo }
317316444a8aSArnaldo Carvalho de Melo 
3174a7900875SSteven Rostedt static int ftrace_allocate_records(struct ftrace_page *pg, int count)
31753c1720f0SSteven Rostedt {
3176a7900875SSteven Rostedt 	int order;
31777ba031e8SSteven Rostedt (VMware) 	int pages;
31783c1720f0SSteven Rostedt 	int cnt;
31793c1720f0SSteven Rostedt 
3180a7900875SSteven Rostedt 	if (WARN_ON(!count))
3181a7900875SSteven Rostedt 		return -EINVAL;
3182a7900875SSteven Rostedt 
3183ceaaa129SSteven Rostedt (VMware) 	/* We want to fill as much as possible, with no empty pages */
3184b40c6eabSWei Yang 	pages = DIV_ROUND_UP(count, ENTRIES_PER_PAGE);
3185ceaaa129SSteven Rostedt (VMware) 	order = fls(pages) - 1;
31863c1720f0SSteven Rostedt 
3187a7900875SSteven Rostedt  again:
3188a7900875SSteven Rostedt 	pg->records = (void *)__get_free_pages(GFP_KERNEL | __GFP_ZERO, order);
3189a7900875SSteven Rostedt 
3190a7900875SSteven Rostedt 	if (!pg->records) {
3191a7900875SSteven Rostedt 		/* if we can't allocate this size, try something smaller */
3192a7900875SSteven Rostedt 		if (!order)
3193a7900875SSteven Rostedt 			return -ENOMEM;
3194a7900875SSteven Rostedt 		order >>= 1;
3195a7900875SSteven Rostedt 		goto again;
3196a7900875SSteven Rostedt 	}
3197a7900875SSteven Rostedt 
3198da537f0aSSteven Rostedt (VMware) 	ftrace_number_of_pages += 1 << order;
3199da537f0aSSteven Rostedt (VMware) 	ftrace_number_of_groups++;
3200da537f0aSSteven Rostedt (VMware) 
3201a7900875SSteven Rostedt 	cnt = (PAGE_SIZE << order) / ENTRY_SIZE;
3202db42523bSLinus Torvalds 	pg->order = order;
3203a7900875SSteven Rostedt 
3204a7900875SSteven Rostedt 	if (cnt > count)
3205a7900875SSteven Rostedt 		cnt = count;
3206a7900875SSteven Rostedt 
3207a7900875SSteven Rostedt 	return cnt;
3208a7900875SSteven Rostedt }
3209a7900875SSteven Rostedt 
3210a7900875SSteven Rostedt static struct ftrace_page *
3211a7900875SSteven Rostedt ftrace_allocate_pages(unsigned long num_to_init)
3212a7900875SSteven Rostedt {
3213a7900875SSteven Rostedt 	struct ftrace_page *start_pg;
3214a7900875SSteven Rostedt 	struct ftrace_page *pg;
3215a7900875SSteven Rostedt 	int cnt;
3216a7900875SSteven Rostedt 
3217a7900875SSteven Rostedt 	if (!num_to_init)
32189efb85c5SHariprasad Kelam 		return NULL;
3219a7900875SSteven Rostedt 
3220a7900875SSteven Rostedt 	start_pg = pg = kzalloc(sizeof(*pg), GFP_KERNEL);
3221a7900875SSteven Rostedt 	if (!pg)
3222a7900875SSteven Rostedt 		return NULL;
3223a7900875SSteven Rostedt 
3224a7900875SSteven Rostedt 	/*
3225a7900875SSteven Rostedt 	 * Try to allocate as much as possible in one continues
3226a7900875SSteven Rostedt 	 * location that fills in all of the space. We want to
3227a7900875SSteven Rostedt 	 * waste as little space as possible.
3228a7900875SSteven Rostedt 	 */
3229a7900875SSteven Rostedt 	for (;;) {
3230a7900875SSteven Rostedt 		cnt = ftrace_allocate_records(pg, num_to_init);
3231a7900875SSteven Rostedt 		if (cnt < 0)
3232a7900875SSteven Rostedt 			goto free_pages;
3233a7900875SSteven Rostedt 
3234a7900875SSteven Rostedt 		num_to_init -= cnt;
3235a7900875SSteven Rostedt 		if (!num_to_init)
3236a7900875SSteven Rostedt 			break;
3237a7900875SSteven Rostedt 
3238a7900875SSteven Rostedt 		pg->next = kzalloc(sizeof(*pg), GFP_KERNEL);
3239a7900875SSteven Rostedt 		if (!pg->next)
3240a7900875SSteven Rostedt 			goto free_pages;
3241a7900875SSteven Rostedt 
3242a7900875SSteven Rostedt 		pg = pg->next;
3243a7900875SSteven Rostedt 	}
3244a7900875SSteven Rostedt 
3245a7900875SSteven Rostedt 	return start_pg;
3246a7900875SSteven Rostedt 
3247a7900875SSteven Rostedt  free_pages:
32481f61be00SNamhyung Kim 	pg = start_pg;
32491f61be00SNamhyung Kim 	while (pg) {
3250db42523bSLinus Torvalds 		if (pg->records) {
3251db42523bSLinus Torvalds 			free_pages((unsigned long)pg->records, pg->order);
3252db42523bSLinus Torvalds 			ftrace_number_of_pages -= 1 << pg->order;
3253db42523bSLinus Torvalds 		}
3254a7900875SSteven Rostedt 		start_pg = pg->next;
3255a7900875SSteven Rostedt 		kfree(pg);
3256a7900875SSteven Rostedt 		pg = start_pg;
3257da537f0aSSteven Rostedt (VMware) 		ftrace_number_of_groups--;
3258a7900875SSteven Rostedt 	}
3259a7900875SSteven Rostedt 	pr_info("ftrace: FAILED to allocate memory for functions\n");
3260a7900875SSteven Rostedt 	return NULL;
3261a7900875SSteven Rostedt }
3262a7900875SSteven Rostedt 
32635072c59fSSteven Rostedt #define FTRACE_BUFF_MAX (KSYM_SYMBOL_LEN+4) /* room for wildcards */
32645072c59fSSteven Rostedt 
32655072c59fSSteven Rostedt struct ftrace_iterator {
326698c4fd04SSteven Rostedt 	loff_t				pos;
32672bccfffdSSteven Rostedt 	loff_t				func_pos;
32685985ea8bSSteven Rostedt (VMware) 	loff_t				mod_pos;
32695072c59fSSteven Rostedt 	struct ftrace_page		*pg;
32704aeb6967SSteven Rostedt 	struct dyn_ftrace		*func;
32714aeb6967SSteven Rostedt 	struct ftrace_func_probe	*probe;
3272eee8ded1SSteven Rostedt (VMware) 	struct ftrace_func_entry	*probe_entry;
32734aeb6967SSteven Rostedt 	struct trace_parser		parser;
32741cf41dd7SSteven Rostedt 	struct ftrace_hash		*hash;
327533dc9b12SSteven Rostedt 	struct ftrace_ops		*ops;
32765985ea8bSSteven Rostedt (VMware) 	struct trace_array		*tr;
32775985ea8bSSteven Rostedt (VMware) 	struct list_head		*mod_list;
3278eee8ded1SSteven Rostedt (VMware) 	int				pidx;
3279431aa3fbSSteven Rostedt 	int				idx;
32805072c59fSSteven Rostedt 	unsigned			flags;
32815072c59fSSteven Rostedt };
32825072c59fSSteven Rostedt 
3283e309b41dSIngo Molnar static void *
3284eee8ded1SSteven Rostedt (VMware) t_probe_next(struct seq_file *m, loff_t *pos)
32858fc0c701SSteven Rostedt {
32868fc0c701SSteven Rostedt 	struct ftrace_iterator *iter = m->private;
3287d2afd57aSSteven Rostedt (VMware) 	struct trace_array *tr = iter->ops->private;
328804ec7bb6SSteven Rostedt (VMware) 	struct list_head *func_probes;
3289eee8ded1SSteven Rostedt (VMware) 	struct ftrace_hash *hash;
3290eee8ded1SSteven Rostedt (VMware) 	struct list_head *next;
32914aeb6967SSteven Rostedt 	struct hlist_node *hnd = NULL;
32928fc0c701SSteven Rostedt 	struct hlist_head *hhd;
3293eee8ded1SSteven Rostedt (VMware) 	int size;
32948fc0c701SSteven Rostedt 
32958fc0c701SSteven Rostedt 	(*pos)++;
329698c4fd04SSteven Rostedt 	iter->pos = *pos;
32978fc0c701SSteven Rostedt 
329804ec7bb6SSteven Rostedt (VMware) 	if (!tr)
32998fc0c701SSteven Rostedt 		return NULL;
33008fc0c701SSteven Rostedt 
330104ec7bb6SSteven Rostedt (VMware) 	func_probes = &tr->func_probes;
330204ec7bb6SSteven Rostedt (VMware) 	if (list_empty(func_probes))
33038fc0c701SSteven Rostedt 		return NULL;
33048fc0c701SSteven Rostedt 
3305eee8ded1SSteven Rostedt (VMware) 	if (!iter->probe) {
330604ec7bb6SSteven Rostedt (VMware) 		next = func_probes->next;
33077b60f3d8SSteven Rostedt (VMware) 		iter->probe = list_entry(next, struct ftrace_func_probe, list);
3308eee8ded1SSteven Rostedt (VMware) 	}
3309eee8ded1SSteven Rostedt (VMware) 
3310eee8ded1SSteven Rostedt (VMware) 	if (iter->probe_entry)
3311eee8ded1SSteven Rostedt (VMware) 		hnd = &iter->probe_entry->hlist;
3312eee8ded1SSteven Rostedt (VMware) 
3313eee8ded1SSteven Rostedt (VMware) 	hash = iter->probe->ops.func_hash->filter_hash;
33147bd46644SNaveen N. Rao 
3315372e0d01SSteven Rostedt (VMware) 	/*
3316372e0d01SSteven Rostedt (VMware) 	 * A probe being registered may temporarily have an empty hash
3317372e0d01SSteven Rostedt (VMware) 	 * and it's at the end of the func_probes list.
3318372e0d01SSteven Rostedt (VMware) 	 */
3319372e0d01SSteven Rostedt (VMware) 	if (!hash || hash == EMPTY_HASH)
33207bd46644SNaveen N. Rao 		return NULL;
33217bd46644SNaveen N. Rao 
3322eee8ded1SSteven Rostedt (VMware) 	size = 1 << hash->size_bits;
3323eee8ded1SSteven Rostedt (VMware) 
3324eee8ded1SSteven Rostedt (VMware)  retry:
3325eee8ded1SSteven Rostedt (VMware) 	if (iter->pidx >= size) {
332604ec7bb6SSteven Rostedt (VMware) 		if (iter->probe->list.next == func_probes)
3327eee8ded1SSteven Rostedt (VMware) 			return NULL;
3328eee8ded1SSteven Rostedt (VMware) 		next = iter->probe->list.next;
33297b60f3d8SSteven Rostedt (VMware) 		iter->probe = list_entry(next, struct ftrace_func_probe, list);
3330eee8ded1SSteven Rostedt (VMware) 		hash = iter->probe->ops.func_hash->filter_hash;
3331eee8ded1SSteven Rostedt (VMware) 		size = 1 << hash->size_bits;
3332eee8ded1SSteven Rostedt (VMware) 		iter->pidx = 0;
3333eee8ded1SSteven Rostedt (VMware) 	}
3334eee8ded1SSteven Rostedt (VMware) 
3335eee8ded1SSteven Rostedt (VMware) 	hhd = &hash->buckets[iter->pidx];
33368fc0c701SSteven Rostedt 
33378fc0c701SSteven Rostedt 	if (hlist_empty(hhd)) {
3338eee8ded1SSteven Rostedt (VMware) 		iter->pidx++;
33398fc0c701SSteven Rostedt 		hnd = NULL;
33408fc0c701SSteven Rostedt 		goto retry;
33418fc0c701SSteven Rostedt 	}
33428fc0c701SSteven Rostedt 
33438fc0c701SSteven Rostedt 	if (!hnd)
33448fc0c701SSteven Rostedt 		hnd = hhd->first;
33458fc0c701SSteven Rostedt 	else {
33468fc0c701SSteven Rostedt 		hnd = hnd->next;
33478fc0c701SSteven Rostedt 		if (!hnd) {
3348eee8ded1SSteven Rostedt (VMware) 			iter->pidx++;
33498fc0c701SSteven Rostedt 			goto retry;
33508fc0c701SSteven Rostedt 		}
33518fc0c701SSteven Rostedt 	}
33528fc0c701SSteven Rostedt 
33534aeb6967SSteven Rostedt 	if (WARN_ON_ONCE(!hnd))
33544aeb6967SSteven Rostedt 		return NULL;
33554aeb6967SSteven Rostedt 
3356eee8ded1SSteven Rostedt (VMware) 	iter->probe_entry = hlist_entry(hnd, struct ftrace_func_entry, hlist);
33574aeb6967SSteven Rostedt 
33584aeb6967SSteven Rostedt 	return iter;
33598fc0c701SSteven Rostedt }
33608fc0c701SSteven Rostedt 
3361eee8ded1SSteven Rostedt (VMware) static void *t_probe_start(struct seq_file *m, loff_t *pos)
33628fc0c701SSteven Rostedt {
33638fc0c701SSteven Rostedt 	struct ftrace_iterator *iter = m->private;
33648fc0c701SSteven Rostedt 	void *p = NULL;
3365d82d6244SLi Zefan 	loff_t l;
3366d82d6244SLi Zefan 
3367eee8ded1SSteven Rostedt (VMware) 	if (!(iter->flags & FTRACE_ITER_DO_PROBES))
336869a3083cSSteven Rostedt 		return NULL;
336969a3083cSSteven Rostedt 
33705985ea8bSSteven Rostedt (VMware) 	if (iter->mod_pos > *pos)
33712bccfffdSSteven Rostedt 		return NULL;
33728fc0c701SSteven Rostedt 
3373eee8ded1SSteven Rostedt (VMware) 	iter->probe = NULL;
3374eee8ded1SSteven Rostedt (VMware) 	iter->probe_entry = NULL;
3375eee8ded1SSteven Rostedt (VMware) 	iter->pidx = 0;
33765985ea8bSSteven Rostedt (VMware) 	for (l = 0; l <= (*pos - iter->mod_pos); ) {
3377eee8ded1SSteven Rostedt (VMware) 		p = t_probe_next(m, &l);
3378d82d6244SLi Zefan 		if (!p)
3379d82d6244SLi Zefan 			break;
3380d82d6244SLi Zefan 	}
33814aeb6967SSteven Rostedt 	if (!p)
33824aeb6967SSteven Rostedt 		return NULL;
33834aeb6967SSteven Rostedt 
338498c4fd04SSteven Rostedt 	/* Only set this if we have an item */
3385eee8ded1SSteven Rostedt (VMware) 	iter->flags |= FTRACE_ITER_PROBE;
338698c4fd04SSteven Rostedt 
33874aeb6967SSteven Rostedt 	return iter;
33888fc0c701SSteven Rostedt }
33898fc0c701SSteven Rostedt 
33904aeb6967SSteven Rostedt static int
3391eee8ded1SSteven Rostedt (VMware) t_probe_show(struct seq_file *m, struct ftrace_iterator *iter)
33928fc0c701SSteven Rostedt {
3393eee8ded1SSteven Rostedt (VMware) 	struct ftrace_func_entry *probe_entry;
33947b60f3d8SSteven Rostedt (VMware) 	struct ftrace_probe_ops *probe_ops;
33957b60f3d8SSteven Rostedt (VMware) 	struct ftrace_func_probe *probe;
33968fc0c701SSteven Rostedt 
3397eee8ded1SSteven Rostedt (VMware) 	probe = iter->probe;
3398eee8ded1SSteven Rostedt (VMware) 	probe_entry = iter->probe_entry;
3399eee8ded1SSteven Rostedt (VMware) 
3400eee8ded1SSteven Rostedt (VMware) 	if (WARN_ON_ONCE(!probe || !probe_entry))
34014aeb6967SSteven Rostedt 		return -EIO;
34028fc0c701SSteven Rostedt 
34037b60f3d8SSteven Rostedt (VMware) 	probe_ops = probe->probe_ops;
3404809dcf29SSteven Rostedt 
34057b60f3d8SSteven Rostedt (VMware) 	if (probe_ops->print)
34066e444319SSteven Rostedt (VMware) 		return probe_ops->print(m, probe_entry->ip, probe_ops, probe->data);
34078fc0c701SSteven Rostedt 
34087b60f3d8SSteven Rostedt (VMware) 	seq_printf(m, "%ps:%ps\n", (void *)probe_entry->ip,
34097b60f3d8SSteven Rostedt (VMware) 		   (void *)probe_ops->func);
34108fc0c701SSteven Rostedt 
34118fc0c701SSteven Rostedt 	return 0;
34128fc0c701SSteven Rostedt }
34138fc0c701SSteven Rostedt 
34148fc0c701SSteven Rostedt static void *
34155985ea8bSSteven Rostedt (VMware) t_mod_next(struct seq_file *m, loff_t *pos)
34165985ea8bSSteven Rostedt (VMware) {
34175985ea8bSSteven Rostedt (VMware) 	struct ftrace_iterator *iter = m->private;
34185985ea8bSSteven Rostedt (VMware) 	struct trace_array *tr = iter->tr;
34195985ea8bSSteven Rostedt (VMware) 
34205985ea8bSSteven Rostedt (VMware) 	(*pos)++;
34215985ea8bSSteven Rostedt (VMware) 	iter->pos = *pos;
34225985ea8bSSteven Rostedt (VMware) 
34235985ea8bSSteven Rostedt (VMware) 	iter->mod_list = iter->mod_list->next;
34245985ea8bSSteven Rostedt (VMware) 
34255985ea8bSSteven Rostedt (VMware) 	if (iter->mod_list == &tr->mod_trace ||
34265985ea8bSSteven Rostedt (VMware) 	    iter->mod_list == &tr->mod_notrace) {
34275985ea8bSSteven Rostedt (VMware) 		iter->flags &= ~FTRACE_ITER_MOD;
34285985ea8bSSteven Rostedt (VMware) 		return NULL;
34295985ea8bSSteven Rostedt (VMware) 	}
34305985ea8bSSteven Rostedt (VMware) 
34315985ea8bSSteven Rostedt (VMware) 	iter->mod_pos = *pos;
34325985ea8bSSteven Rostedt (VMware) 
34335985ea8bSSteven Rostedt (VMware) 	return iter;
34345985ea8bSSteven Rostedt (VMware) }
34355985ea8bSSteven Rostedt (VMware) 
34365985ea8bSSteven Rostedt (VMware) static void *t_mod_start(struct seq_file *m, loff_t *pos)
34375985ea8bSSteven Rostedt (VMware) {
34385985ea8bSSteven Rostedt (VMware) 	struct ftrace_iterator *iter = m->private;
34395985ea8bSSteven Rostedt (VMware) 	void *p = NULL;
34405985ea8bSSteven Rostedt (VMware) 	loff_t l;
34415985ea8bSSteven Rostedt (VMware) 
34425985ea8bSSteven Rostedt (VMware) 	if (iter->func_pos > *pos)
34435985ea8bSSteven Rostedt (VMware) 		return NULL;
34445985ea8bSSteven Rostedt (VMware) 
34455985ea8bSSteven Rostedt (VMware) 	iter->mod_pos = iter->func_pos;
34465985ea8bSSteven Rostedt (VMware) 
34475985ea8bSSteven Rostedt (VMware) 	/* probes are only available if tr is set */
34485985ea8bSSteven Rostedt (VMware) 	if (!iter->tr)
34495985ea8bSSteven Rostedt (VMware) 		return NULL;
34505985ea8bSSteven Rostedt (VMware) 
34515985ea8bSSteven Rostedt (VMware) 	for (l = 0; l <= (*pos - iter->func_pos); ) {
34525985ea8bSSteven Rostedt (VMware) 		p = t_mod_next(m, &l);
34535985ea8bSSteven Rostedt (VMware) 		if (!p)
34545985ea8bSSteven Rostedt (VMware) 			break;
34555985ea8bSSteven Rostedt (VMware) 	}
34565985ea8bSSteven Rostedt (VMware) 	if (!p) {
34575985ea8bSSteven Rostedt (VMware) 		iter->flags &= ~FTRACE_ITER_MOD;
34585985ea8bSSteven Rostedt (VMware) 		return t_probe_start(m, pos);
34595985ea8bSSteven Rostedt (VMware) 	}
34605985ea8bSSteven Rostedt (VMware) 
34615985ea8bSSteven Rostedt (VMware) 	/* Only set this if we have an item */
34625985ea8bSSteven Rostedt (VMware) 	iter->flags |= FTRACE_ITER_MOD;
34635985ea8bSSteven Rostedt (VMware) 
34645985ea8bSSteven Rostedt (VMware) 	return iter;
34655985ea8bSSteven Rostedt (VMware) }
34665985ea8bSSteven Rostedt (VMware) 
34675985ea8bSSteven Rostedt (VMware) static int
34685985ea8bSSteven Rostedt (VMware) t_mod_show(struct seq_file *m, struct ftrace_iterator *iter)
34695985ea8bSSteven Rostedt (VMware) {
34705985ea8bSSteven Rostedt (VMware) 	struct ftrace_mod_load *ftrace_mod;
34715985ea8bSSteven Rostedt (VMware) 	struct trace_array *tr = iter->tr;
34725985ea8bSSteven Rostedt (VMware) 
34735985ea8bSSteven Rostedt (VMware) 	if (WARN_ON_ONCE(!iter->mod_list) ||
34745985ea8bSSteven Rostedt (VMware) 			 iter->mod_list == &tr->mod_trace ||
34755985ea8bSSteven Rostedt (VMware) 			 iter->mod_list == &tr->mod_notrace)
34765985ea8bSSteven Rostedt (VMware) 		return -EIO;
34775985ea8bSSteven Rostedt (VMware) 
34785985ea8bSSteven Rostedt (VMware) 	ftrace_mod = list_entry(iter->mod_list, struct ftrace_mod_load, list);
34795985ea8bSSteven Rostedt (VMware) 
34805985ea8bSSteven Rostedt (VMware) 	if (ftrace_mod->func)
34815985ea8bSSteven Rostedt (VMware) 		seq_printf(m, "%s", ftrace_mod->func);
34825985ea8bSSteven Rostedt (VMware) 	else
34835985ea8bSSteven Rostedt (VMware) 		seq_putc(m, '*');
34845985ea8bSSteven Rostedt (VMware) 
34855985ea8bSSteven Rostedt (VMware) 	seq_printf(m, ":mod:%s\n", ftrace_mod->module);
34865985ea8bSSteven Rostedt (VMware) 
34875985ea8bSSteven Rostedt (VMware) 	return 0;
34885985ea8bSSteven Rostedt (VMware) }
34895985ea8bSSteven Rostedt (VMware) 
34905985ea8bSSteven Rostedt (VMware) static void *
34915bd84629SSteven Rostedt (VMware) t_func_next(struct seq_file *m, loff_t *pos)
34925072c59fSSteven Rostedt {
34935072c59fSSteven Rostedt 	struct ftrace_iterator *iter = m->private;
34945072c59fSSteven Rostedt 	struct dyn_ftrace *rec = NULL;
34955072c59fSSteven Rostedt 
34965072c59fSSteven Rostedt 	(*pos)++;
34970c75a3edSSteven Rostedt 
34985072c59fSSteven Rostedt  retry:
34995072c59fSSteven Rostedt 	if (iter->idx >= iter->pg->index) {
35005072c59fSSteven Rostedt 		if (iter->pg->next) {
35015072c59fSSteven Rostedt 			iter->pg = iter->pg->next;
35025072c59fSSteven Rostedt 			iter->idx = 0;
35035072c59fSSteven Rostedt 			goto retry;
35045072c59fSSteven Rostedt 		}
35055072c59fSSteven Rostedt 	} else {
35065072c59fSSteven Rostedt 		rec = &iter->pg->records[iter->idx++];
3507c20489daSSteven Rostedt (VMware) 		if (((iter->flags & (FTRACE_ITER_FILTER | FTRACE_ITER_NOTRACE)) &&
3508c20489daSSteven Rostedt (VMware) 		     !ftrace_lookup_ip(iter->hash, rec->ip)) ||
3509647bcd03SSteven Rostedt 
3510647bcd03SSteven Rostedt 		    ((iter->flags & FTRACE_ITER_ENABLED) &&
351123ea9c4dSSteven Rostedt (Red Hat) 		     !(rec->flags & FTRACE_FL_ENABLED))) {
3512647bcd03SSteven Rostedt 
35135072c59fSSteven Rostedt 			rec = NULL;
35145072c59fSSteven Rostedt 			goto retry;
35155072c59fSSteven Rostedt 		}
35165072c59fSSteven Rostedt 	}
35175072c59fSSteven Rostedt 
35184aeb6967SSteven Rostedt 	if (!rec)
35195bd84629SSteven Rostedt (VMware) 		return NULL;
35204aeb6967SSteven Rostedt 
35215bd84629SSteven Rostedt (VMware) 	iter->pos = iter->func_pos = *pos;
35224aeb6967SSteven Rostedt 	iter->func = rec;
35234aeb6967SSteven Rostedt 
35244aeb6967SSteven Rostedt 	return iter;
35255072c59fSSteven Rostedt }
35265072c59fSSteven Rostedt 
35275bd84629SSteven Rostedt (VMware) static void *
35285bd84629SSteven Rostedt (VMware) t_next(struct seq_file *m, void *v, loff_t *pos)
35295bd84629SSteven Rostedt (VMware) {
35305bd84629SSteven Rostedt (VMware) 	struct ftrace_iterator *iter = m->private;
35315985ea8bSSteven Rostedt (VMware) 	loff_t l = *pos; /* t_probe_start() must use original pos */
35325bd84629SSteven Rostedt (VMware) 	void *ret;
35335bd84629SSteven Rostedt (VMware) 
35345bd84629SSteven Rostedt (VMware) 	if (unlikely(ftrace_disabled))
35355bd84629SSteven Rostedt (VMware) 		return NULL;
35365bd84629SSteven Rostedt (VMware) 
3537eee8ded1SSteven Rostedt (VMware) 	if (iter->flags & FTRACE_ITER_PROBE)
3538eee8ded1SSteven Rostedt (VMware) 		return t_probe_next(m, pos);
35395bd84629SSteven Rostedt (VMware) 
35405985ea8bSSteven Rostedt (VMware) 	if (iter->flags & FTRACE_ITER_MOD)
35415985ea8bSSteven Rostedt (VMware) 		return t_mod_next(m, pos);
35425985ea8bSSteven Rostedt (VMware) 
35435bd84629SSteven Rostedt (VMware) 	if (iter->flags & FTRACE_ITER_PRINTALL) {
3544eee8ded1SSteven Rostedt (VMware) 		/* next must increment pos, and t_probe_start does not */
35455bd84629SSteven Rostedt (VMware) 		(*pos)++;
35465985ea8bSSteven Rostedt (VMware) 		return t_mod_start(m, &l);
35475bd84629SSteven Rostedt (VMware) 	}
35485bd84629SSteven Rostedt (VMware) 
35495bd84629SSteven Rostedt (VMware) 	ret = t_func_next(m, pos);
35505bd84629SSteven Rostedt (VMware) 
35515bd84629SSteven Rostedt (VMware) 	if (!ret)
35525985ea8bSSteven Rostedt (VMware) 		return t_mod_start(m, &l);
35535bd84629SSteven Rostedt (VMware) 
35545bd84629SSteven Rostedt (VMware) 	return ret;
35555bd84629SSteven Rostedt (VMware) }
35565bd84629SSteven Rostedt (VMware) 
355798c4fd04SSteven Rostedt static void reset_iter_read(struct ftrace_iterator *iter)
355898c4fd04SSteven Rostedt {
355998c4fd04SSteven Rostedt 	iter->pos = 0;
356098c4fd04SSteven Rostedt 	iter->func_pos = 0;
35615985ea8bSSteven Rostedt (VMware) 	iter->flags &= ~(FTRACE_ITER_PRINTALL | FTRACE_ITER_PROBE | FTRACE_ITER_MOD);
35625072c59fSSteven Rostedt }
35635072c59fSSteven Rostedt 
35645072c59fSSteven Rostedt static void *t_start(struct seq_file *m, loff_t *pos)
35655072c59fSSteven Rostedt {
35665072c59fSSteven Rostedt 	struct ftrace_iterator *iter = m->private;
35675072c59fSSteven Rostedt 	void *p = NULL;
3568694ce0a5SLi Zefan 	loff_t l;
35695072c59fSSteven Rostedt 
35708fc0c701SSteven Rostedt 	mutex_lock(&ftrace_lock);
357145a4a237SSteven Rostedt 
357245a4a237SSteven Rostedt 	if (unlikely(ftrace_disabled))
357345a4a237SSteven Rostedt 		return NULL;
357445a4a237SSteven Rostedt 
35750c75a3edSSteven Rostedt 	/*
357698c4fd04SSteven Rostedt 	 * If an lseek was done, then reset and start from beginning.
357798c4fd04SSteven Rostedt 	 */
357898c4fd04SSteven Rostedt 	if (*pos < iter->pos)
357998c4fd04SSteven Rostedt 		reset_iter_read(iter);
358098c4fd04SSteven Rostedt 
358198c4fd04SSteven Rostedt 	/*
35820c75a3edSSteven Rostedt 	 * For set_ftrace_filter reading, if we have the filter
35830c75a3edSSteven Rostedt 	 * off, we can short cut and just print out that all
35840c75a3edSSteven Rostedt 	 * functions are enabled.
35850c75a3edSSteven Rostedt 	 */
3586c20489daSSteven Rostedt (VMware) 	if ((iter->flags & (FTRACE_ITER_FILTER | FTRACE_ITER_NOTRACE)) &&
3587c20489daSSteven Rostedt (VMware) 	    ftrace_hash_empty(iter->hash)) {
358843ff926aSSteven Rostedt (VMware) 		iter->func_pos = 1; /* Account for the message */
35890c75a3edSSteven Rostedt 		if (*pos > 0)
35905985ea8bSSteven Rostedt (VMware) 			return t_mod_start(m, pos);
35910c75a3edSSteven Rostedt 		iter->flags |= FTRACE_ITER_PRINTALL;
3592df091625SChris Wright 		/* reset in case of seek/pread */
3593eee8ded1SSteven Rostedt (VMware) 		iter->flags &= ~FTRACE_ITER_PROBE;
35940c75a3edSSteven Rostedt 		return iter;
35950c75a3edSSteven Rostedt 	}
35960c75a3edSSteven Rostedt 
35975985ea8bSSteven Rostedt (VMware) 	if (iter->flags & FTRACE_ITER_MOD)
35985985ea8bSSteven Rostedt (VMware) 		return t_mod_start(m, pos);
35998fc0c701SSteven Rostedt 
360098c4fd04SSteven Rostedt 	/*
360198c4fd04SSteven Rostedt 	 * Unfortunately, we need to restart at ftrace_pages_start
360298c4fd04SSteven Rostedt 	 * every time we let go of the ftrace_mutex. This is because
360398c4fd04SSteven Rostedt 	 * those pointers can change without the lock.
360498c4fd04SSteven Rostedt 	 */
3605694ce0a5SLi Zefan 	iter->pg = ftrace_pages_start;
3606694ce0a5SLi Zefan 	iter->idx = 0;
3607694ce0a5SLi Zefan 	for (l = 0; l <= *pos; ) {
36085bd84629SSteven Rostedt (VMware) 		p = t_func_next(m, &l);
3609694ce0a5SLi Zefan 		if (!p)
3610694ce0a5SLi Zefan 			break;
361150cdaf08SLiming Wang 	}
36125821e1b7Swalimis 
361369a3083cSSteven Rostedt 	if (!p)
36145985ea8bSSteven Rostedt (VMware) 		return t_mod_start(m, pos);
36158fc0c701SSteven Rostedt 
36164aeb6967SSteven Rostedt 	return iter;
36175072c59fSSteven Rostedt }
36185072c59fSSteven Rostedt 
36195072c59fSSteven Rostedt static void t_stop(struct seq_file *m, void *p)
36205072c59fSSteven Rostedt {
36218fc0c701SSteven Rostedt 	mutex_unlock(&ftrace_lock);
36225072c59fSSteven Rostedt }
36235072c59fSSteven Rostedt 
362415d5b02cSSteven Rostedt (Red Hat) void * __weak
362515d5b02cSSteven Rostedt (Red Hat) arch_ftrace_trampoline_func(struct ftrace_ops *ops, struct dyn_ftrace *rec)
362615d5b02cSSteven Rostedt (Red Hat) {
362715d5b02cSSteven Rostedt (Red Hat) 	return NULL;
362815d5b02cSSteven Rostedt (Red Hat) }
362915d5b02cSSteven Rostedt (Red Hat) 
363015d5b02cSSteven Rostedt (Red Hat) static void add_trampoline_func(struct seq_file *m, struct ftrace_ops *ops,
363115d5b02cSSteven Rostedt (Red Hat) 				struct dyn_ftrace *rec)
363215d5b02cSSteven Rostedt (Red Hat) {
363315d5b02cSSteven Rostedt (Red Hat) 	void *ptr;
363415d5b02cSSteven Rostedt (Red Hat) 
363515d5b02cSSteven Rostedt (Red Hat) 	ptr = arch_ftrace_trampoline_func(ops, rec);
363615d5b02cSSteven Rostedt (Red Hat) 	if (ptr)
363715d5b02cSSteven Rostedt (Red Hat) 		seq_printf(m, " ->%pS", ptr);
363815d5b02cSSteven Rostedt (Red Hat) }
363915d5b02cSSteven Rostedt (Red Hat) 
3640b39181f7SSteven Rostedt (Google) #ifdef FTRACE_MCOUNT_MAX_OFFSET
3641b39181f7SSteven Rostedt (Google) /*
3642b39181f7SSteven Rostedt (Google)  * Weak functions can still have an mcount/fentry that is saved in
3643b39181f7SSteven Rostedt (Google)  * the __mcount_loc section. These can be detected by having a
3644b39181f7SSteven Rostedt (Google)  * symbol offset of greater than FTRACE_MCOUNT_MAX_OFFSET, as the
3645b39181f7SSteven Rostedt (Google)  * symbol found by kallsyms is not the function that the mcount/fentry
3646b39181f7SSteven Rostedt (Google)  * is part of. The offset is much greater in these cases.
3647b39181f7SSteven Rostedt (Google)  *
3648b39181f7SSteven Rostedt (Google)  * Test the record to make sure that the ip points to a valid kallsyms
3649b39181f7SSteven Rostedt (Google)  * and if not, mark it disabled.
3650b39181f7SSteven Rostedt (Google)  */
3651b39181f7SSteven Rostedt (Google) static int test_for_valid_rec(struct dyn_ftrace *rec)
3652b39181f7SSteven Rostedt (Google) {
3653b39181f7SSteven Rostedt (Google) 	char str[KSYM_SYMBOL_LEN];
3654b39181f7SSteven Rostedt (Google) 	unsigned long offset;
3655b39181f7SSteven Rostedt (Google) 	const char *ret;
3656b39181f7SSteven Rostedt (Google) 
3657b39181f7SSteven Rostedt (Google) 	ret = kallsyms_lookup(rec->ip, NULL, &offset, NULL, str);
3658b39181f7SSteven Rostedt (Google) 
3659b39181f7SSteven Rostedt (Google) 	/* Weak functions can cause invalid addresses */
3660b39181f7SSteven Rostedt (Google) 	if (!ret || offset > FTRACE_MCOUNT_MAX_OFFSET) {
3661b39181f7SSteven Rostedt (Google) 		rec->flags |= FTRACE_FL_DISABLED;
3662b39181f7SSteven Rostedt (Google) 		return 0;
3663b39181f7SSteven Rostedt (Google) 	}
3664b39181f7SSteven Rostedt (Google) 	return 1;
3665b39181f7SSteven Rostedt (Google) }
3666b39181f7SSteven Rostedt (Google) 
3667b39181f7SSteven Rostedt (Google) static struct workqueue_struct *ftrace_check_wq __initdata;
3668b39181f7SSteven Rostedt (Google) static struct work_struct ftrace_check_work __initdata;
3669b39181f7SSteven Rostedt (Google) 
3670b39181f7SSteven Rostedt (Google) /*
3671b39181f7SSteven Rostedt (Google)  * Scan all the mcount/fentry entries to make sure they are valid.
3672b39181f7SSteven Rostedt (Google)  */
3673b39181f7SSteven Rostedt (Google) static __init void ftrace_check_work_func(struct work_struct *work)
3674b39181f7SSteven Rostedt (Google) {
3675b39181f7SSteven Rostedt (Google) 	struct ftrace_page *pg;
3676b39181f7SSteven Rostedt (Google) 	struct dyn_ftrace *rec;
3677b39181f7SSteven Rostedt (Google) 
3678b39181f7SSteven Rostedt (Google) 	mutex_lock(&ftrace_lock);
3679b39181f7SSteven Rostedt (Google) 	do_for_each_ftrace_rec(pg, rec) {
3680b39181f7SSteven Rostedt (Google) 		test_for_valid_rec(rec);
3681b39181f7SSteven Rostedt (Google) 	} while_for_each_ftrace_rec();
3682b39181f7SSteven Rostedt (Google) 	mutex_unlock(&ftrace_lock);
3683b39181f7SSteven Rostedt (Google) }
3684b39181f7SSteven Rostedt (Google) 
3685b39181f7SSteven Rostedt (Google) static int __init ftrace_check_for_weak_functions(void)
3686b39181f7SSteven Rostedt (Google) {
3687b39181f7SSteven Rostedt (Google) 	INIT_WORK(&ftrace_check_work, ftrace_check_work_func);
3688b39181f7SSteven Rostedt (Google) 
3689b39181f7SSteven Rostedt (Google) 	ftrace_check_wq = alloc_workqueue("ftrace_check_wq", WQ_UNBOUND, 0);
3690b39181f7SSteven Rostedt (Google) 
3691b39181f7SSteven Rostedt (Google) 	queue_work(ftrace_check_wq, &ftrace_check_work);
3692b39181f7SSteven Rostedt (Google) 	return 0;
3693b39181f7SSteven Rostedt (Google) }
3694b39181f7SSteven Rostedt (Google) 
3695b39181f7SSteven Rostedt (Google) static int __init ftrace_check_sync(void)
3696b39181f7SSteven Rostedt (Google) {
3697b39181f7SSteven Rostedt (Google) 	/* Make sure the ftrace_check updates are finished */
3698b39181f7SSteven Rostedt (Google) 	if (ftrace_check_wq)
3699b39181f7SSteven Rostedt (Google) 		destroy_workqueue(ftrace_check_wq);
3700b39181f7SSteven Rostedt (Google) 	return 0;
3701b39181f7SSteven Rostedt (Google) }
3702b39181f7SSteven Rostedt (Google) 
3703b39181f7SSteven Rostedt (Google) late_initcall_sync(ftrace_check_sync);
3704b39181f7SSteven Rostedt (Google) subsys_initcall(ftrace_check_for_weak_functions);
3705b39181f7SSteven Rostedt (Google) 
3706b39181f7SSteven Rostedt (Google) static int print_rec(struct seq_file *m, unsigned long ip)
3707b39181f7SSteven Rostedt (Google) {
3708b39181f7SSteven Rostedt (Google) 	unsigned long offset;
3709b39181f7SSteven Rostedt (Google) 	char str[KSYM_SYMBOL_LEN];
3710b39181f7SSteven Rostedt (Google) 	char *modname;
3711b39181f7SSteven Rostedt (Google) 	const char *ret;
3712b39181f7SSteven Rostedt (Google) 
3713b39181f7SSteven Rostedt (Google) 	ret = kallsyms_lookup(ip, NULL, &offset, &modname, str);
3714b39181f7SSteven Rostedt (Google) 	/* Weak functions can cause invalid addresses */
3715b39181f7SSteven Rostedt (Google) 	if (!ret || offset > FTRACE_MCOUNT_MAX_OFFSET) {
3716b39181f7SSteven Rostedt (Google) 		snprintf(str, KSYM_SYMBOL_LEN, "%s_%ld",
3717b39181f7SSteven Rostedt (Google) 			 FTRACE_INVALID_FUNCTION, offset);
3718b39181f7SSteven Rostedt (Google) 		ret = NULL;
3719b39181f7SSteven Rostedt (Google) 	}
3720b39181f7SSteven Rostedt (Google) 
3721b39181f7SSteven Rostedt (Google) 	seq_puts(m, str);
3722b39181f7SSteven Rostedt (Google) 	if (modname)
3723b39181f7SSteven Rostedt (Google) 		seq_printf(m, " [%s]", modname);
3724b39181f7SSteven Rostedt (Google) 	return ret == NULL ? -1 : 0;
3725b39181f7SSteven Rostedt (Google) }
3726b39181f7SSteven Rostedt (Google) #else
3727b39181f7SSteven Rostedt (Google) static inline int test_for_valid_rec(struct dyn_ftrace *rec)
3728b39181f7SSteven Rostedt (Google) {
3729b39181f7SSteven Rostedt (Google) 	return 1;
3730b39181f7SSteven Rostedt (Google) }
3731b39181f7SSteven Rostedt (Google) 
3732b39181f7SSteven Rostedt (Google) static inline int print_rec(struct seq_file *m, unsigned long ip)
3733b39181f7SSteven Rostedt (Google) {
3734b39181f7SSteven Rostedt (Google) 	seq_printf(m, "%ps", (void *)ip);
3735b39181f7SSteven Rostedt (Google) 	return 0;
3736b39181f7SSteven Rostedt (Google) }
3737b39181f7SSteven Rostedt (Google) #endif
3738b39181f7SSteven Rostedt (Google) 
37395072c59fSSteven Rostedt static int t_show(struct seq_file *m, void *v)
37405072c59fSSteven Rostedt {
37410c75a3edSSteven Rostedt 	struct ftrace_iterator *iter = m->private;
37424aeb6967SSteven Rostedt 	struct dyn_ftrace *rec;
37435072c59fSSteven Rostedt 
3744eee8ded1SSteven Rostedt (VMware) 	if (iter->flags & FTRACE_ITER_PROBE)
3745eee8ded1SSteven Rostedt (VMware) 		return t_probe_show(m, iter);
37468fc0c701SSteven Rostedt 
37475985ea8bSSteven Rostedt (VMware) 	if (iter->flags & FTRACE_ITER_MOD)
37485985ea8bSSteven Rostedt (VMware) 		return t_mod_show(m, iter);
37495985ea8bSSteven Rostedt (VMware) 
37500c75a3edSSteven Rostedt 	if (iter->flags & FTRACE_ITER_PRINTALL) {
37518c006cf7SNamhyung Kim 		if (iter->flags & FTRACE_ITER_NOTRACE)
3752fa6f0cc7SRasmus Villemoes 			seq_puts(m, "#### no functions disabled ####\n");
37538c006cf7SNamhyung Kim 		else
3754fa6f0cc7SRasmus Villemoes 			seq_puts(m, "#### all functions enabled ####\n");
37550c75a3edSSteven Rostedt 		return 0;
37560c75a3edSSteven Rostedt 	}
37570c75a3edSSteven Rostedt 
37584aeb6967SSteven Rostedt 	rec = iter->func;
37594aeb6967SSteven Rostedt 
37605072c59fSSteven Rostedt 	if (!rec)
37615072c59fSSteven Rostedt 		return 0;
37625072c59fSSteven Rostedt 
3763b39181f7SSteven Rostedt (Google) 	if (print_rec(m, rec->ip)) {
3764b39181f7SSteven Rostedt (Google) 		/* This should only happen when a rec is disabled */
3765b39181f7SSteven Rostedt (Google) 		WARN_ON_ONCE(!(rec->flags & FTRACE_FL_DISABLED));
3766b39181f7SSteven Rostedt (Google) 		seq_putc(m, '\n');
3767b39181f7SSteven Rostedt (Google) 		return 0;
3768b39181f7SSteven Rostedt (Google) 	}
3769b39181f7SSteven Rostedt (Google) 
37709674b2faSSteven Rostedt (Red Hat) 	if (iter->flags & FTRACE_ITER_ENABLED) {
3771030f4e1cSSteven Rostedt (Red Hat) 		struct ftrace_ops *ops;
377215d5b02cSSteven Rostedt (Red Hat) 
3773763e34e7SSteven Rostedt (VMware) 		seq_printf(m, " (%ld)%s%s%s",
37740376bde1SSteven Rostedt (Red Hat) 			   ftrace_rec_count(rec),
3775f8b8be8aSMasami Hiramatsu 			   rec->flags & FTRACE_FL_REGS ? " R" : "  ",
3776763e34e7SSteven Rostedt (VMware) 			   rec->flags & FTRACE_FL_IPMODIFY ? " I" : "  ",
3777763e34e7SSteven Rostedt (VMware) 			   rec->flags & FTRACE_FL_DIRECT ? " D" : "  ");
37789674b2faSSteven Rostedt (Red Hat) 		if (rec->flags & FTRACE_FL_TRAMP_EN) {
37795fecaa04SSteven Rostedt (Red Hat) 			ops = ftrace_find_tramp_ops_any(rec);
378039daa7b9SSteven Rostedt (Red Hat) 			if (ops) {
378139daa7b9SSteven Rostedt (Red Hat) 				do {
378239daa7b9SSteven Rostedt (Red Hat) 					seq_printf(m, "\ttramp: %pS (%pS)",
378339daa7b9SSteven Rostedt (Red Hat) 						   (void *)ops->trampoline,
378439daa7b9SSteven Rostedt (Red Hat) 						   (void *)ops->func);
3785030f4e1cSSteven Rostedt (Red Hat) 					add_trampoline_func(m, ops, rec);
378639daa7b9SSteven Rostedt (Red Hat) 					ops = ftrace_find_tramp_ops_next(rec, ops);
378739daa7b9SSteven Rostedt (Red Hat) 				} while (ops);
378839daa7b9SSteven Rostedt (Red Hat) 			} else
3789fa6f0cc7SRasmus Villemoes 				seq_puts(m, "\ttramp: ERROR!");
3790030f4e1cSSteven Rostedt (Red Hat) 		} else {
3791030f4e1cSSteven Rostedt (Red Hat) 			add_trampoline_func(m, NULL, rec);
37929674b2faSSteven Rostedt (Red Hat) 		}
3793763e34e7SSteven Rostedt (VMware) 		if (rec->flags & FTRACE_FL_DIRECT) {
3794763e34e7SSteven Rostedt (VMware) 			unsigned long direct;
3795763e34e7SSteven Rostedt (VMware) 
3796ff205766SAlexei Starovoitov 			direct = ftrace_find_rec_direct(rec->ip);
3797763e34e7SSteven Rostedt (VMware) 			if (direct)
3798763e34e7SSteven Rostedt (VMware) 				seq_printf(m, "\n\tdirect-->%pS", (void *)direct);
3799763e34e7SSteven Rostedt (VMware) 		}
38009674b2faSSteven Rostedt (Red Hat) 	}
38019674b2faSSteven Rostedt (Red Hat) 
3802fa6f0cc7SRasmus Villemoes 	seq_putc(m, '\n');
38035072c59fSSteven Rostedt 
38045072c59fSSteven Rostedt 	return 0;
38055072c59fSSteven Rostedt }
38065072c59fSSteven Rostedt 
380788e9d34cSJames Morris static const struct seq_operations show_ftrace_seq_ops = {
38085072c59fSSteven Rostedt 	.start = t_start,
38095072c59fSSteven Rostedt 	.next = t_next,
38105072c59fSSteven Rostedt 	.stop = t_stop,
38115072c59fSSteven Rostedt 	.show = t_show,
38125072c59fSSteven Rostedt };
38135072c59fSSteven Rostedt 
3814e309b41dSIngo Molnar static int
38155072c59fSSteven Rostedt ftrace_avail_open(struct inode *inode, struct file *file)
38165072c59fSSteven Rostedt {
38175072c59fSSteven Rostedt 	struct ftrace_iterator *iter;
381817911ff3SSteven Rostedt (VMware) 	int ret;
381917911ff3SSteven Rostedt (VMware) 
382017911ff3SSteven Rostedt (VMware) 	ret = security_locked_down(LOCKDOWN_TRACEFS);
382117911ff3SSteven Rostedt (VMware) 	if (ret)
382217911ff3SSteven Rostedt (VMware) 		return ret;
38235072c59fSSteven Rostedt 
38244eebcc81SSteven Rostedt 	if (unlikely(ftrace_disabled))
38254eebcc81SSteven Rostedt 		return -ENODEV;
38264eebcc81SSteven Rostedt 
382750e18b94SJiri Olsa 	iter = __seq_open_private(file, &show_ftrace_seq_ops, sizeof(*iter));
3828c1bc5919SSteven Rostedt (VMware) 	if (!iter)
3829c1bc5919SSteven Rostedt (VMware) 		return -ENOMEM;
3830c1bc5919SSteven Rostedt (VMware) 
38315072c59fSSteven Rostedt 	iter->pg = ftrace_pages_start;
3832fc13cb0cSSteven Rostedt 	iter->ops = &global_ops;
38335072c59fSSteven Rostedt 
3834c1bc5919SSteven Rostedt (VMware) 	return 0;
38355072c59fSSteven Rostedt }
38365072c59fSSteven Rostedt 
3837647bcd03SSteven Rostedt static int
3838647bcd03SSteven Rostedt ftrace_enabled_open(struct inode *inode, struct file *file)
3839647bcd03SSteven Rostedt {
3840647bcd03SSteven Rostedt 	struct ftrace_iterator *iter;
3841647bcd03SSteven Rostedt 
384217911ff3SSteven Rostedt (VMware) 	/*
384317911ff3SSteven Rostedt (VMware) 	 * This shows us what functions are currently being
384417911ff3SSteven Rostedt (VMware) 	 * traced and by what. Not sure if we want lockdown
384517911ff3SSteven Rostedt (VMware) 	 * to hide such critical information for an admin.
384617911ff3SSteven Rostedt (VMware) 	 * Although, perhaps it can show information we don't
384717911ff3SSteven Rostedt (VMware) 	 * want people to see, but if something is tracing
384817911ff3SSteven Rostedt (VMware) 	 * something, we probably want to know about it.
384917911ff3SSteven Rostedt (VMware) 	 */
385017911ff3SSteven Rostedt (VMware) 
385150e18b94SJiri Olsa 	iter = __seq_open_private(file, &show_ftrace_seq_ops, sizeof(*iter));
3852c1bc5919SSteven Rostedt (VMware) 	if (!iter)
3853c1bc5919SSteven Rostedt (VMware) 		return -ENOMEM;
3854c1bc5919SSteven Rostedt (VMware) 
3855647bcd03SSteven Rostedt 	iter->pg = ftrace_pages_start;
3856647bcd03SSteven Rostedt 	iter->flags = FTRACE_ITER_ENABLED;
3857fc13cb0cSSteven Rostedt 	iter->ops = &global_ops;
3858647bcd03SSteven Rostedt 
3859c1bc5919SSteven Rostedt (VMware) 	return 0;
3860647bcd03SSteven Rostedt }
3861647bcd03SSteven Rostedt 
3862fc13cb0cSSteven Rostedt /**
3863fc13cb0cSSteven Rostedt  * ftrace_regex_open - initialize function tracer filter files
3864fc13cb0cSSteven Rostedt  * @ops: The ftrace_ops that hold the hash filters
3865fc13cb0cSSteven Rostedt  * @flag: The type of filter to process
3866fc13cb0cSSteven Rostedt  * @inode: The inode, usually passed in to your open routine
3867fc13cb0cSSteven Rostedt  * @file: The file, usually passed in to your open routine
3868fc13cb0cSSteven Rostedt  *
3869fc13cb0cSSteven Rostedt  * ftrace_regex_open() initializes the filter files for the
3870fc13cb0cSSteven Rostedt  * @ops. Depending on @flag it may process the filter hash or
3871fc13cb0cSSteven Rostedt  * the notrace hash of @ops. With this called from the open
3872fc13cb0cSSteven Rostedt  * routine, you can use ftrace_filter_write() for the write
3873fc13cb0cSSteven Rostedt  * routine if @flag has FTRACE_ITER_FILTER set, or
3874fc13cb0cSSteven Rostedt  * ftrace_notrace_write() if @flag has FTRACE_ITER_NOTRACE set.
3875098c879eSSteven Rostedt (Red Hat)  * tracing_lseek() should be used as the lseek routine, and
3876fc13cb0cSSteven Rostedt  * release must call ftrace_regex_release().
3877fc13cb0cSSteven Rostedt  */
3878fc13cb0cSSteven Rostedt int
3879f45948e8SSteven Rostedt ftrace_regex_open(struct ftrace_ops *ops, int flag,
38801cf41dd7SSteven Rostedt 		  struct inode *inode, struct file *file)
38815072c59fSSteven Rostedt {
38825072c59fSSteven Rostedt 	struct ftrace_iterator *iter;
3883f45948e8SSteven Rostedt 	struct ftrace_hash *hash;
3884673feb9dSSteven Rostedt (VMware) 	struct list_head *mod_head;
3885673feb9dSSteven Rostedt (VMware) 	struct trace_array *tr = ops->private;
38869ef16693SSteven Rostedt (VMware) 	int ret = -ENOMEM;
38875072c59fSSteven Rostedt 
3888f04f24fbSMasami Hiramatsu 	ftrace_ops_init(ops);
3889f04f24fbSMasami Hiramatsu 
38904eebcc81SSteven Rostedt 	if (unlikely(ftrace_disabled))
38914eebcc81SSteven Rostedt 		return -ENODEV;
38924eebcc81SSteven Rostedt 
38938530dec6SSteven Rostedt (VMware) 	if (tracing_check_open_get_tr(tr))
38949ef16693SSteven Rostedt (VMware) 		return -ENODEV;
38959ef16693SSteven Rostedt (VMware) 
38965072c59fSSteven Rostedt 	iter = kzalloc(sizeof(*iter), GFP_KERNEL);
38975072c59fSSteven Rostedt 	if (!iter)
38989ef16693SSteven Rostedt (VMware) 		goto out;
38995072c59fSSteven Rostedt 
39009ef16693SSteven Rostedt (VMware) 	if (trace_parser_get_init(&iter->parser, FTRACE_BUFF_MAX))
39019ef16693SSteven Rostedt (VMware) 		goto out;
3902689fd8b6S[email protected] 
39033f2367baSMasami Hiramatsu 	iter->ops = ops;
39043f2367baSMasami Hiramatsu 	iter->flags = flag;
39055985ea8bSSteven Rostedt (VMware) 	iter->tr = tr;
39063f2367baSMasami Hiramatsu 
390733b7f99cSSteven Rostedt (Red Hat) 	mutex_lock(&ops->func_hash->regex_lock);
39083f2367baSMasami Hiramatsu 
3909673feb9dSSteven Rostedt (VMware) 	if (flag & FTRACE_ITER_NOTRACE) {
391033b7f99cSSteven Rostedt (Red Hat) 		hash = ops->func_hash->notrace_hash;
39115985ea8bSSteven Rostedt (VMware) 		mod_head = tr ? &tr->mod_notrace : NULL;
3912673feb9dSSteven Rostedt (VMware) 	} else {
391333b7f99cSSteven Rostedt (Red Hat) 		hash = ops->func_hash->filter_hash;
39145985ea8bSSteven Rostedt (VMware) 		mod_head = tr ? &tr->mod_trace : NULL;
3915673feb9dSSteven Rostedt (VMware) 	}
3916f45948e8SSteven Rostedt 
39175985ea8bSSteven Rostedt (VMware) 	iter->mod_list = mod_head;
39185985ea8bSSteven Rostedt (VMware) 
391933dc9b12SSteven Rostedt 	if (file->f_mode & FMODE_WRITE) {
3920ef2fbe16SNamhyung Kim 		const int size_bits = FTRACE_HASH_DEFAULT_BITS;
3921ef2fbe16SNamhyung Kim 
3922673feb9dSSteven Rostedt (VMware) 		if (file->f_flags & O_TRUNC) {
3923ef2fbe16SNamhyung Kim 			iter->hash = alloc_ftrace_hash(size_bits);
3924673feb9dSSteven Rostedt (VMware) 			clear_ftrace_mod_list(mod_head);
3925673feb9dSSteven Rostedt (VMware) 	        } else {
3926ef2fbe16SNamhyung Kim 			iter->hash = alloc_and_copy_ftrace_hash(size_bits, hash);
3927673feb9dSSteven Rostedt (VMware) 		}
3928ef2fbe16SNamhyung Kim 
392933dc9b12SSteven Rostedt 		if (!iter->hash) {
393033dc9b12SSteven Rostedt 			trace_parser_put(&iter->parser);
39313f2367baSMasami Hiramatsu 			goto out_unlock;
393233dc9b12SSteven Rostedt 		}
3933c20489daSSteven Rostedt (VMware) 	} else
3934c20489daSSteven Rostedt (VMware) 		iter->hash = hash;
39351cf41dd7SSteven Rostedt 
39369ef16693SSteven Rostedt (VMware) 	ret = 0;
39379ef16693SSteven Rostedt (VMware) 
39385072c59fSSteven Rostedt 	if (file->f_mode & FMODE_READ) {
39395072c59fSSteven Rostedt 		iter->pg = ftrace_pages_start;
39405072c59fSSteven Rostedt 
39415072c59fSSteven Rostedt 		ret = seq_open(file, &show_ftrace_seq_ops);
39425072c59fSSteven Rostedt 		if (!ret) {
39435072c59fSSteven Rostedt 			struct seq_file *m = file->private_data;
39445072c59fSSteven Rostedt 			m->private = iter;
394579fe249cSLi Zefan 		} else {
394633dc9b12SSteven Rostedt 			/* Failed */
394733dc9b12SSteven Rostedt 			free_ftrace_hash(iter->hash);
394879fe249cSLi Zefan 			trace_parser_put(&iter->parser);
394979fe249cSLi Zefan 		}
39505072c59fSSteven Rostedt 	} else
39515072c59fSSteven Rostedt 		file->private_data = iter;
39523f2367baSMasami Hiramatsu 
39533f2367baSMasami Hiramatsu  out_unlock:
395433b7f99cSSteven Rostedt (Red Hat) 	mutex_unlock(&ops->func_hash->regex_lock);
39555072c59fSSteven Rostedt 
39569ef16693SSteven Rostedt (VMware)  out:
39579ef16693SSteven Rostedt (VMware) 	if (ret) {
39589ef16693SSteven Rostedt (VMware) 		kfree(iter);
39599ef16693SSteven Rostedt (VMware) 		if (tr)
39609ef16693SSteven Rostedt (VMware) 			trace_array_put(tr);
39619ef16693SSteven Rostedt (VMware) 	}
39629ef16693SSteven Rostedt (VMware) 
39635072c59fSSteven Rostedt 	return ret;
39645072c59fSSteven Rostedt }
39655072c59fSSteven Rostedt 
396641c52c0dSSteven Rostedt static int
396741c52c0dSSteven Rostedt ftrace_filter_open(struct inode *inode, struct file *file)
396841c52c0dSSteven Rostedt {
3969e3b3e2e8SSteven Rostedt (Red Hat) 	struct ftrace_ops *ops = inode->i_private;
3970e3b3e2e8SSteven Rostedt (Red Hat) 
397117911ff3SSteven Rostedt (VMware) 	/* Checks for tracefs lockdown */
3972e3b3e2e8SSteven Rostedt (Red Hat) 	return ftrace_regex_open(ops,
3973eee8ded1SSteven Rostedt (VMware) 			FTRACE_ITER_FILTER | FTRACE_ITER_DO_PROBES,
39741cf41dd7SSteven Rostedt 			inode, file);
397541c52c0dSSteven Rostedt }
397641c52c0dSSteven Rostedt 
397741c52c0dSSteven Rostedt static int
397841c52c0dSSteven Rostedt ftrace_notrace_open(struct inode *inode, struct file *file)
397941c52c0dSSteven Rostedt {
3980e3b3e2e8SSteven Rostedt (Red Hat) 	struct ftrace_ops *ops = inode->i_private;
3981e3b3e2e8SSteven Rostedt (Red Hat) 
398217911ff3SSteven Rostedt (VMware) 	/* Checks for tracefs lockdown */
3983e3b3e2e8SSteven Rostedt (Red Hat) 	return ftrace_regex_open(ops, FTRACE_ITER_NOTRACE,
39841cf41dd7SSteven Rostedt 				 inode, file);
398541c52c0dSSteven Rostedt }
398641c52c0dSSteven Rostedt 
39873ba00929SDmitry Safonov /* Type for quick search ftrace basic regexes (globs) from filter_parse_regex */
39883ba00929SDmitry Safonov struct ftrace_glob {
39893ba00929SDmitry Safonov 	char *search;
39903ba00929SDmitry Safonov 	unsigned len;
39913ba00929SDmitry Safonov 	int type;
39923ba00929SDmitry Safonov };
39933ba00929SDmitry Safonov 
39947132e2d6SThiago Jung Bauermann /*
39957132e2d6SThiago Jung Bauermann  * If symbols in an architecture don't correspond exactly to the user-visible
39967132e2d6SThiago Jung Bauermann  * name of what they represent, it is possible to define this function to
39977132e2d6SThiago Jung Bauermann  * perform the necessary adjustments.
39987132e2d6SThiago Jung Bauermann */
39997132e2d6SThiago Jung Bauermann char * __weak arch_ftrace_match_adjust(char *str, const char *search)
40007132e2d6SThiago Jung Bauermann {
40017132e2d6SThiago Jung Bauermann 	return str;
40027132e2d6SThiago Jung Bauermann }
40037132e2d6SThiago Jung Bauermann 
40043ba00929SDmitry Safonov static int ftrace_match(char *str, struct ftrace_glob *g)
40059f4801e3SSteven Rostedt {
40069f4801e3SSteven Rostedt 	int matched = 0;
4007751e9983SLi Zefan 	int slen;
40089f4801e3SSteven Rostedt 
40097132e2d6SThiago Jung Bauermann 	str = arch_ftrace_match_adjust(str, g->search);
40107132e2d6SThiago Jung Bauermann 
40113ba00929SDmitry Safonov 	switch (g->type) {
40129f4801e3SSteven Rostedt 	case MATCH_FULL:
40133ba00929SDmitry Safonov 		if (strcmp(str, g->search) == 0)
40149f4801e3SSteven Rostedt 			matched = 1;
40159f4801e3SSteven Rostedt 		break;
40169f4801e3SSteven Rostedt 	case MATCH_FRONT_ONLY:
40173ba00929SDmitry Safonov 		if (strncmp(str, g->search, g->len) == 0)
40189f4801e3SSteven Rostedt 			matched = 1;
40199f4801e3SSteven Rostedt 		break;
40209f4801e3SSteven Rostedt 	case MATCH_MIDDLE_ONLY:
40213ba00929SDmitry Safonov 		if (strstr(str, g->search))
40229f4801e3SSteven Rostedt 			matched = 1;
40239f4801e3SSteven Rostedt 		break;
40249f4801e3SSteven Rostedt 	case MATCH_END_ONLY:
4025751e9983SLi Zefan 		slen = strlen(str);
40263ba00929SDmitry Safonov 		if (slen >= g->len &&
40273ba00929SDmitry Safonov 		    memcmp(str + slen - g->len, g->search, g->len) == 0)
40289f4801e3SSteven Rostedt 			matched = 1;
40299f4801e3SSteven Rostedt 		break;
403060f1d5e3SMasami Hiramatsu 	case MATCH_GLOB:
403160f1d5e3SMasami Hiramatsu 		if (glob_match(g->search, str))
403260f1d5e3SMasami Hiramatsu 			matched = 1;
403360f1d5e3SMasami Hiramatsu 		break;
40349f4801e3SSteven Rostedt 	}
40359f4801e3SSteven Rostedt 
40369f4801e3SSteven Rostedt 	return matched;
40379f4801e3SSteven Rostedt }
40389f4801e3SSteven Rostedt 
4039b448c4e3SSteven Rostedt static int
4040f0a3b154SDmitry Safonov enter_record(struct ftrace_hash *hash, struct dyn_ftrace *rec, int clear_filter)
404164e7c440SSteven Rostedt {
4042b448c4e3SSteven Rostedt 	struct ftrace_func_entry *entry;
4043b448c4e3SSteven Rostedt 	int ret = 0;
4044b448c4e3SSteven Rostedt 
40451cf41dd7SSteven Rostedt 	entry = ftrace_lookup_ip(hash, rec->ip);
4046f0a3b154SDmitry Safonov 	if (clear_filter) {
4047b448c4e3SSteven Rostedt 		/* Do nothing if it doesn't exist */
4048b448c4e3SSteven Rostedt 		if (!entry)
4049b448c4e3SSteven Rostedt 			return 0;
4050b448c4e3SSteven Rostedt 
405133dc9b12SSteven Rostedt 		free_hash_entry(hash, entry);
4052b448c4e3SSteven Rostedt 	} else {
4053b448c4e3SSteven Rostedt 		/* Do nothing if it exists */
4054b448c4e3SSteven Rostedt 		if (entry)
4055b448c4e3SSteven Rostedt 			return 0;
4056b448c4e3SSteven Rostedt 
4057b448c4e3SSteven Rostedt 		ret = add_hash_entry(hash, rec->ip);
4058b448c4e3SSteven Rostedt 	}
4059b448c4e3SSteven Rostedt 	return ret;
4060996e87beSSteven Rostedt }
4061996e87beSSteven Rostedt 
406264e7c440SSteven Rostedt static int
4063f79b3f33SSteven Rostedt (VMware) add_rec_by_index(struct ftrace_hash *hash, struct ftrace_glob *func_g,
4064f79b3f33SSteven Rostedt (VMware) 		 int clear_filter)
4065f79b3f33SSteven Rostedt (VMware) {
4066f79b3f33SSteven Rostedt (VMware) 	long index = simple_strtoul(func_g->search, NULL, 0);
4067f79b3f33SSteven Rostedt (VMware) 	struct ftrace_page *pg;
4068f79b3f33SSteven Rostedt (VMware) 	struct dyn_ftrace *rec;
4069f79b3f33SSteven Rostedt (VMware) 
4070f79b3f33SSteven Rostedt (VMware) 	/* The index starts at 1 */
4071f79b3f33SSteven Rostedt (VMware) 	if (--index < 0)
4072f79b3f33SSteven Rostedt (VMware) 		return 0;
4073f79b3f33SSteven Rostedt (VMware) 
4074f79b3f33SSteven Rostedt (VMware) 	do_for_each_ftrace_rec(pg, rec) {
4075f79b3f33SSteven Rostedt (VMware) 		if (pg->index <= index) {
4076f79b3f33SSteven Rostedt (VMware) 			index -= pg->index;
4077f79b3f33SSteven Rostedt (VMware) 			/* this is a double loop, break goes to the next page */
4078f79b3f33SSteven Rostedt (VMware) 			break;
4079f79b3f33SSteven Rostedt (VMware) 		}
4080f79b3f33SSteven Rostedt (VMware) 		rec = &pg->records[index];
4081f79b3f33SSteven Rostedt (VMware) 		enter_record(hash, rec, clear_filter);
4082f79b3f33SSteven Rostedt (VMware) 		return 1;
4083f79b3f33SSteven Rostedt (VMware) 	} while_for_each_ftrace_rec();
4084f79b3f33SSteven Rostedt (VMware) 	return 0;
4085f79b3f33SSteven Rostedt (VMware) }
4086f79b3f33SSteven Rostedt (VMware) 
4087b39181f7SSteven Rostedt (Google) #ifdef FTRACE_MCOUNT_MAX_OFFSET
4088b39181f7SSteven Rostedt (Google) static int lookup_ip(unsigned long ip, char **modname, char *str)
4089b39181f7SSteven Rostedt (Google) {
4090b39181f7SSteven Rostedt (Google) 	unsigned long offset;
4091b39181f7SSteven Rostedt (Google) 
4092b39181f7SSteven Rostedt (Google) 	kallsyms_lookup(ip, NULL, &offset, modname, str);
4093b39181f7SSteven Rostedt (Google) 	if (offset > FTRACE_MCOUNT_MAX_OFFSET)
4094b39181f7SSteven Rostedt (Google) 		return -1;
4095b39181f7SSteven Rostedt (Google) 	return 0;
4096b39181f7SSteven Rostedt (Google) }
4097b39181f7SSteven Rostedt (Google) #else
4098b39181f7SSteven Rostedt (Google) static int lookup_ip(unsigned long ip, char **modname, char *str)
4099b39181f7SSteven Rostedt (Google) {
4100b39181f7SSteven Rostedt (Google) 	kallsyms_lookup(ip, NULL, NULL, modname, str);
4101b39181f7SSteven Rostedt (Google) 	return 0;
4102b39181f7SSteven Rostedt (Google) }
4103b39181f7SSteven Rostedt (Google) #endif
4104b39181f7SSteven Rostedt (Google) 
4105f79b3f33SSteven Rostedt (VMware) static int
41060b507e1eSDmitry Safonov ftrace_match_record(struct dyn_ftrace *rec, struct ftrace_glob *func_g,
41070b507e1eSDmitry Safonov 		struct ftrace_glob *mod_g, int exclude_mod)
410864e7c440SSteven Rostedt {
410964e7c440SSteven Rostedt 	char str[KSYM_SYMBOL_LEN];
4110b9df92d2SSteven Rostedt 	char *modname;
411164e7c440SSteven Rostedt 
4112b39181f7SSteven Rostedt (Google) 	if (lookup_ip(rec->ip, &modname, str)) {
4113b39181f7SSteven Rostedt (Google) 		/* This should only happen when a rec is disabled */
4114b39181f7SSteven Rostedt (Google) 		WARN_ON_ONCE(system_state == SYSTEM_RUNNING &&
4115b39181f7SSteven Rostedt (Google) 			     !(rec->flags & FTRACE_FL_DISABLED));
4116b39181f7SSteven Rostedt (Google) 		return 0;
4117b39181f7SSteven Rostedt (Google) 	}
4118b9df92d2SSteven Rostedt 
41190b507e1eSDmitry Safonov 	if (mod_g) {
41200b507e1eSDmitry Safonov 		int mod_matches = (modname) ? ftrace_match(modname, mod_g) : 0;
41210b507e1eSDmitry Safonov 
41220b507e1eSDmitry Safonov 		/* blank module name to match all modules */
41230b507e1eSDmitry Safonov 		if (!mod_g->len) {
41240b507e1eSDmitry Safonov 			/* blank module globbing: modname xor exclude_mod */
412577c0eddeSSteven Rostedt (VMware) 			if (!exclude_mod != !modname)
41260b507e1eSDmitry Safonov 				goto func_match;
41270b507e1eSDmitry Safonov 			return 0;
41280b507e1eSDmitry Safonov 		}
41290b507e1eSDmitry Safonov 
413077c0eddeSSteven Rostedt (VMware) 		/*
413177c0eddeSSteven Rostedt (VMware) 		 * exclude_mod is set to trace everything but the given
413277c0eddeSSteven Rostedt (VMware) 		 * module. If it is set and the module matches, then
413377c0eddeSSteven Rostedt (VMware) 		 * return 0. If it is not set, and the module doesn't match
413477c0eddeSSteven Rostedt (VMware) 		 * also return 0. Otherwise, check the function to see if
413577c0eddeSSteven Rostedt (VMware) 		 * that matches.
413677c0eddeSSteven Rostedt (VMware) 		 */
413777c0eddeSSteven Rostedt (VMware) 		if (!mod_matches == !exclude_mod)
41380b507e1eSDmitry Safonov 			return 0;
41390b507e1eSDmitry Safonov func_match:
4140b9df92d2SSteven Rostedt 		/* blank search means to match all funcs in the mod */
41413ba00929SDmitry Safonov 		if (!func_g->len)
4142b9df92d2SSteven Rostedt 			return 1;
4143b9df92d2SSteven Rostedt 	}
4144b9df92d2SSteven Rostedt 
41453ba00929SDmitry Safonov 	return ftrace_match(str, func_g);
414664e7c440SSteven Rostedt }
414764e7c440SSteven Rostedt 
41481cf41dd7SSteven Rostedt static int
41493ba00929SDmitry Safonov match_records(struct ftrace_hash *hash, char *func, int len, char *mod)
41509f4801e3SSteven Rostedt {
41519f4801e3SSteven Rostedt 	struct ftrace_page *pg;
41529f4801e3SSteven Rostedt 	struct dyn_ftrace *rec;
41533ba00929SDmitry Safonov 	struct ftrace_glob func_g = { .type = MATCH_FULL };
41540b507e1eSDmitry Safonov 	struct ftrace_glob mod_g = { .type = MATCH_FULL };
41550b507e1eSDmitry Safonov 	struct ftrace_glob *mod_match = (mod) ? &mod_g : NULL;
41560b507e1eSDmitry Safonov 	int exclude_mod = 0;
4157311d16daSLi Zefan 	int found = 0;
4158b448c4e3SSteven Rostedt 	int ret;
41592e028c4fSDan Carpenter 	int clear_filter = 0;
41609f4801e3SSteven Rostedt 
41610b507e1eSDmitry Safonov 	if (func) {
41623ba00929SDmitry Safonov 		func_g.type = filter_parse_regex(func, len, &func_g.search,
41633ba00929SDmitry Safonov 						 &clear_filter);
41643ba00929SDmitry Safonov 		func_g.len = strlen(func_g.search);
4165b9df92d2SSteven Rostedt 	}
4166b9df92d2SSteven Rostedt 
41670b507e1eSDmitry Safonov 	if (mod) {
41680b507e1eSDmitry Safonov 		mod_g.type = filter_parse_regex(mod, strlen(mod),
41690b507e1eSDmitry Safonov 				&mod_g.search, &exclude_mod);
41700b507e1eSDmitry Safonov 		mod_g.len = strlen(mod_g.search);
4171b9df92d2SSteven Rostedt 	}
4172b9df92d2SSteven Rostedt 
417352baf119SSteven Rostedt 	mutex_lock(&ftrace_lock);
4174b9df92d2SSteven Rostedt 
4175b9df92d2SSteven Rostedt 	if (unlikely(ftrace_disabled))
4176b9df92d2SSteven Rostedt 		goto out_unlock;
4177b9df92d2SSteven Rostedt 
4178f79b3f33SSteven Rostedt (VMware) 	if (func_g.type == MATCH_INDEX) {
4179f79b3f33SSteven Rostedt (VMware) 		found = add_rec_by_index(hash, &func_g, clear_filter);
4180f79b3f33SSteven Rostedt (VMware) 		goto out_unlock;
4181f79b3f33SSteven Rostedt (VMware) 	}
4182f79b3f33SSteven Rostedt (VMware) 
4183265c831cSSteven Rostedt 	do_for_each_ftrace_rec(pg, rec) {
4184546fece4SSteven Rostedt (Red Hat) 
4185546fece4SSteven Rostedt (Red Hat) 		if (rec->flags & FTRACE_FL_DISABLED)
4186546fece4SSteven Rostedt (Red Hat) 			continue;
4187546fece4SSteven Rostedt (Red Hat) 
41880b507e1eSDmitry Safonov 		if (ftrace_match_record(rec, &func_g, mod_match, exclude_mod)) {
4189f0a3b154SDmitry Safonov 			ret = enter_record(hash, rec, clear_filter);
4190b448c4e3SSteven Rostedt 			if (ret < 0) {
4191b448c4e3SSteven Rostedt 				found = ret;
4192b448c4e3SSteven Rostedt 				goto out_unlock;
4193b448c4e3SSteven Rostedt 			}
4194311d16daSLi Zefan 			found = 1;
41955072c59fSSteven Rostedt 		}
4196265c831cSSteven Rostedt 	} while_for_each_ftrace_rec();
4197b9df92d2SSteven Rostedt  out_unlock:
419852baf119SSteven Rostedt 	mutex_unlock(&ftrace_lock);
4199311d16daSLi Zefan 
4200311d16daSLi Zefan 	return found;
42015072c59fSSteven Rostedt }
42025072c59fSSteven Rostedt 
420364e7c440SSteven Rostedt static int
42041cf41dd7SSteven Rostedt ftrace_match_records(struct ftrace_hash *hash, char *buff, int len)
420564e7c440SSteven Rostedt {
4206f0a3b154SDmitry Safonov 	return match_records(hash, buff, len, NULL);
420764e7c440SSteven Rostedt }
420864e7c440SSteven Rostedt 
4209e16b35ddSSteven Rostedt (VMware) static void ftrace_ops_update_code(struct ftrace_ops *ops,
4210e16b35ddSSteven Rostedt (VMware) 				   struct ftrace_ops_hash *old_hash)
4211e16b35ddSSteven Rostedt (VMware) {
4212e16b35ddSSteven Rostedt (VMware) 	struct ftrace_ops *op;
4213e16b35ddSSteven Rostedt (VMware) 
4214e16b35ddSSteven Rostedt (VMware) 	if (!ftrace_enabled)
4215e16b35ddSSteven Rostedt (VMware) 		return;
4216e16b35ddSSteven Rostedt (VMware) 
4217e16b35ddSSteven Rostedt (VMware) 	if (ops->flags & FTRACE_OPS_FL_ENABLED) {
4218e16b35ddSSteven Rostedt (VMware) 		ftrace_run_modify_code(ops, FTRACE_UPDATE_CALLS, old_hash);
4219e16b35ddSSteven Rostedt (VMware) 		return;
4220e16b35ddSSteven Rostedt (VMware) 	}
4221e16b35ddSSteven Rostedt (VMware) 
4222e16b35ddSSteven Rostedt (VMware) 	/*
4223e16b35ddSSteven Rostedt (VMware) 	 * If this is the shared global_ops filter, then we need to
4224e16b35ddSSteven Rostedt (VMware) 	 * check if there is another ops that shares it, is enabled.
4225e16b35ddSSteven Rostedt (VMware) 	 * If so, we still need to run the modify code.
4226e16b35ddSSteven Rostedt (VMware) 	 */
4227e16b35ddSSteven Rostedt (VMware) 	if (ops->func_hash != &global_ops.local_hash)
4228e16b35ddSSteven Rostedt (VMware) 		return;
4229e16b35ddSSteven Rostedt (VMware) 
4230e16b35ddSSteven Rostedt (VMware) 	do_for_each_ftrace_op(op, ftrace_ops_list) {
4231e16b35ddSSteven Rostedt (VMware) 		if (op->func_hash == &global_ops.local_hash &&
4232e16b35ddSSteven Rostedt (VMware) 		    op->flags & FTRACE_OPS_FL_ENABLED) {
4233e16b35ddSSteven Rostedt (VMware) 			ftrace_run_modify_code(op, FTRACE_UPDATE_CALLS, old_hash);
4234e16b35ddSSteven Rostedt (VMware) 			/* Only need to do this once */
4235e16b35ddSSteven Rostedt (VMware) 			return;
4236e16b35ddSSteven Rostedt (VMware) 		}
4237e16b35ddSSteven Rostedt (VMware) 	} while_for_each_ftrace_op(op);
4238e16b35ddSSteven Rostedt (VMware) }
4239e16b35ddSSteven Rostedt (VMware) 
4240e16b35ddSSteven Rostedt (VMware) static int ftrace_hash_move_and_update_ops(struct ftrace_ops *ops,
4241e16b35ddSSteven Rostedt (VMware) 					   struct ftrace_hash **orig_hash,
4242e16b35ddSSteven Rostedt (VMware) 					   struct ftrace_hash *hash,
4243e16b35ddSSteven Rostedt (VMware) 					   int enable)
4244e16b35ddSSteven Rostedt (VMware) {
4245e16b35ddSSteven Rostedt (VMware) 	struct ftrace_ops_hash old_hash_ops;
4246e16b35ddSSteven Rostedt (VMware) 	struct ftrace_hash *old_hash;
4247e16b35ddSSteven Rostedt (VMware) 	int ret;
4248e16b35ddSSteven Rostedt (VMware) 
4249e16b35ddSSteven Rostedt (VMware) 	old_hash = *orig_hash;
4250e16b35ddSSteven Rostedt (VMware) 	old_hash_ops.filter_hash = ops->func_hash->filter_hash;
4251e16b35ddSSteven Rostedt (VMware) 	old_hash_ops.notrace_hash = ops->func_hash->notrace_hash;
4252e16b35ddSSteven Rostedt (VMware) 	ret = ftrace_hash_move(ops, enable, orig_hash, hash);
4253e16b35ddSSteven Rostedt (VMware) 	if (!ret) {
4254e16b35ddSSteven Rostedt (VMware) 		ftrace_ops_update_code(ops, &old_hash_ops);
4255e16b35ddSSteven Rostedt (VMware) 		free_ftrace_hash_rcu(old_hash);
4256e16b35ddSSteven Rostedt (VMware) 	}
4257e16b35ddSSteven Rostedt (VMware) 	return ret;
4258e16b35ddSSteven Rostedt (VMware) }
425964e7c440SSteven Rostedt 
4260673feb9dSSteven Rostedt (VMware) static bool module_exists(const char *module)
4261673feb9dSSteven Rostedt (VMware) {
4262673feb9dSSteven Rostedt (VMware) 	/* All modules have the symbol __this_module */
42630f5e5a3aSRasmus Villemoes 	static const char this_mod[] = "__this_module";
4264419e9fe5SSalvatore Mesoraca 	char modname[MAX_PARAM_PREFIX_LEN + sizeof(this_mod) + 2];
4265673feb9dSSteven Rostedt (VMware) 	unsigned long val;
4266673feb9dSSteven Rostedt (VMware) 	int n;
4267673feb9dSSteven Rostedt (VMware) 
4268419e9fe5SSalvatore Mesoraca 	n = snprintf(modname, sizeof(modname), "%s:%s", module, this_mod);
4269673feb9dSSteven Rostedt (VMware) 
4270419e9fe5SSalvatore Mesoraca 	if (n > sizeof(modname) - 1)
4271673feb9dSSteven Rostedt (VMware) 		return false;
4272673feb9dSSteven Rostedt (VMware) 
4273673feb9dSSteven Rostedt (VMware) 	val = module_kallsyms_lookup_name(modname);
4274673feb9dSSteven Rostedt (VMware) 	return val != 0;
4275673feb9dSSteven Rostedt (VMware) }
4276673feb9dSSteven Rostedt (VMware) 
4277673feb9dSSteven Rostedt (VMware) static int cache_mod(struct trace_array *tr,
4278673feb9dSSteven Rostedt (VMware) 		     const char *func, char *module, int enable)
4279673feb9dSSteven Rostedt (VMware) {
4280673feb9dSSteven Rostedt (VMware) 	struct ftrace_mod_load *ftrace_mod, *n;
4281673feb9dSSteven Rostedt (VMware) 	struct list_head *head = enable ? &tr->mod_trace : &tr->mod_notrace;
4282673feb9dSSteven Rostedt (VMware) 	int ret;
4283673feb9dSSteven Rostedt (VMware) 
4284673feb9dSSteven Rostedt (VMware) 	mutex_lock(&ftrace_lock);
4285673feb9dSSteven Rostedt (VMware) 
4286673feb9dSSteven Rostedt (VMware) 	/* We do not cache inverse filters */
4287673feb9dSSteven Rostedt (VMware) 	if (func[0] == '!') {
4288673feb9dSSteven Rostedt (VMware) 		func++;
4289673feb9dSSteven Rostedt (VMware) 		ret = -EINVAL;
4290673feb9dSSteven Rostedt (VMware) 
4291673feb9dSSteven Rostedt (VMware) 		/* Look to remove this hash */
4292673feb9dSSteven Rostedt (VMware) 		list_for_each_entry_safe(ftrace_mod, n, head, list) {
4293673feb9dSSteven Rostedt (VMware) 			if (strcmp(ftrace_mod->module, module) != 0)
4294673feb9dSSteven Rostedt (VMware) 				continue;
4295673feb9dSSteven Rostedt (VMware) 
4296673feb9dSSteven Rostedt (VMware) 			/* no func matches all */
429744925dffSDan Carpenter 			if (strcmp(func, "*") == 0 ||
4298673feb9dSSteven Rostedt (VMware) 			    (ftrace_mod->func &&
4299673feb9dSSteven Rostedt (VMware) 			     strcmp(ftrace_mod->func, func) == 0)) {
4300673feb9dSSteven Rostedt (VMware) 				ret = 0;
4301673feb9dSSteven Rostedt (VMware) 				free_ftrace_mod(ftrace_mod);
4302673feb9dSSteven Rostedt (VMware) 				continue;
4303673feb9dSSteven Rostedt (VMware) 			}
4304673feb9dSSteven Rostedt (VMware) 		}
4305673feb9dSSteven Rostedt (VMware) 		goto out;
4306673feb9dSSteven Rostedt (VMware) 	}
4307673feb9dSSteven Rostedt (VMware) 
4308673feb9dSSteven Rostedt (VMware) 	ret = -EINVAL;
4309673feb9dSSteven Rostedt (VMware) 	/* We only care about modules that have not been loaded yet */
4310673feb9dSSteven Rostedt (VMware) 	if (module_exists(module))
4311673feb9dSSteven Rostedt (VMware) 		goto out;
4312673feb9dSSteven Rostedt (VMware) 
4313673feb9dSSteven Rostedt (VMware) 	/* Save this string off, and execute it when the module is loaded */
4314673feb9dSSteven Rostedt (VMware) 	ret = ftrace_add_mod(tr, func, module, enable);
4315673feb9dSSteven Rostedt (VMware)  out:
4316673feb9dSSteven Rostedt (VMware) 	mutex_unlock(&ftrace_lock);
4317673feb9dSSteven Rostedt (VMware) 
4318673feb9dSSteven Rostedt (VMware) 	return ret;
4319673feb9dSSteven Rostedt (VMware) }
4320673feb9dSSteven Rostedt (VMware) 
4321d7fbf8dfSSteven Rostedt (VMware) static int
4322d7fbf8dfSSteven Rostedt (VMware) ftrace_set_regex(struct ftrace_ops *ops, unsigned char *buf, int len,
4323d7fbf8dfSSteven Rostedt (VMware) 		 int reset, int enable);
4324d7fbf8dfSSteven Rostedt (VMware) 
432569449bbdSArnd Bergmann #ifdef CONFIG_MODULES
4326d7fbf8dfSSteven Rostedt (VMware) static void process_mod_list(struct list_head *head, struct ftrace_ops *ops,
4327d7fbf8dfSSteven Rostedt (VMware) 			     char *mod, bool enable)
4328d7fbf8dfSSteven Rostedt (VMware) {
4329d7fbf8dfSSteven Rostedt (VMware) 	struct ftrace_mod_load *ftrace_mod, *n;
4330d7fbf8dfSSteven Rostedt (VMware) 	struct ftrace_hash **orig_hash, *new_hash;
4331d7fbf8dfSSteven Rostedt (VMware) 	LIST_HEAD(process_mods);
4332d7fbf8dfSSteven Rostedt (VMware) 	char *func;
4333d7fbf8dfSSteven Rostedt (VMware) 
4334d7fbf8dfSSteven Rostedt (VMware) 	mutex_lock(&ops->func_hash->regex_lock);
4335d7fbf8dfSSteven Rostedt (VMware) 
4336d7fbf8dfSSteven Rostedt (VMware) 	if (enable)
4337d7fbf8dfSSteven Rostedt (VMware) 		orig_hash = &ops->func_hash->filter_hash;
4338d7fbf8dfSSteven Rostedt (VMware) 	else
4339d7fbf8dfSSteven Rostedt (VMware) 		orig_hash = &ops->func_hash->notrace_hash;
4340d7fbf8dfSSteven Rostedt (VMware) 
4341d7fbf8dfSSteven Rostedt (VMware) 	new_hash = alloc_and_copy_ftrace_hash(FTRACE_HASH_DEFAULT_BITS,
4342d7fbf8dfSSteven Rostedt (VMware) 					      *orig_hash);
4343d7fbf8dfSSteven Rostedt (VMware) 	if (!new_hash)
43443b58a3c7SSteven Rostedt (VMware) 		goto out; /* warn? */
4345d7fbf8dfSSteven Rostedt (VMware) 
4346d7fbf8dfSSteven Rostedt (VMware) 	mutex_lock(&ftrace_lock);
4347d7fbf8dfSSteven Rostedt (VMware) 
4348d7fbf8dfSSteven Rostedt (VMware) 	list_for_each_entry_safe(ftrace_mod, n, head, list) {
4349d7fbf8dfSSteven Rostedt (VMware) 
4350d7fbf8dfSSteven Rostedt (VMware) 		if (strcmp(ftrace_mod->module, mod) != 0)
4351d7fbf8dfSSteven Rostedt (VMware) 			continue;
4352d7fbf8dfSSteven Rostedt (VMware) 
4353d7fbf8dfSSteven Rostedt (VMware) 		if (ftrace_mod->func)
4354d7fbf8dfSSteven Rostedt (VMware) 			func = kstrdup(ftrace_mod->func, GFP_KERNEL);
4355d7fbf8dfSSteven Rostedt (VMware) 		else
4356d7fbf8dfSSteven Rostedt (VMware) 			func = kstrdup("*", GFP_KERNEL);
4357d7fbf8dfSSteven Rostedt (VMware) 
4358d7fbf8dfSSteven Rostedt (VMware) 		if (!func) /* warn? */
4359d7fbf8dfSSteven Rostedt (VMware) 			continue;
4360d7fbf8dfSSteven Rostedt (VMware) 
43613ecda644SBaokun Li 		list_move(&ftrace_mod->list, &process_mods);
4362d7fbf8dfSSteven Rostedt (VMware) 
4363d7fbf8dfSSteven Rostedt (VMware) 		/* Use the newly allocated func, as it may be "*" */
4364d7fbf8dfSSteven Rostedt (VMware) 		kfree(ftrace_mod->func);
4365d7fbf8dfSSteven Rostedt (VMware) 		ftrace_mod->func = func;
4366d7fbf8dfSSteven Rostedt (VMware) 	}
4367d7fbf8dfSSteven Rostedt (VMware) 
4368d7fbf8dfSSteven Rostedt (VMware) 	mutex_unlock(&ftrace_lock);
4369d7fbf8dfSSteven Rostedt (VMware) 
4370d7fbf8dfSSteven Rostedt (VMware) 	list_for_each_entry_safe(ftrace_mod, n, &process_mods, list) {
4371d7fbf8dfSSteven Rostedt (VMware) 
4372d7fbf8dfSSteven Rostedt (VMware) 		func = ftrace_mod->func;
4373d7fbf8dfSSteven Rostedt (VMware) 
4374d7fbf8dfSSteven Rostedt (VMware) 		/* Grabs ftrace_lock, which is why we have this extra step */
4375d7fbf8dfSSteven Rostedt (VMware) 		match_records(new_hash, func, strlen(func), mod);
4376d7fbf8dfSSteven Rostedt (VMware) 		free_ftrace_mod(ftrace_mod);
4377d7fbf8dfSSteven Rostedt (VMware) 	}
4378d7fbf8dfSSteven Rostedt (VMware) 
43798c08f0d5SSteven Rostedt (VMware) 	if (enable && list_empty(head))
43808c08f0d5SSteven Rostedt (VMware) 		new_hash->flags &= ~FTRACE_HASH_FL_MOD;
43818c08f0d5SSteven Rostedt (VMware) 
4382d7fbf8dfSSteven Rostedt (VMware) 	mutex_lock(&ftrace_lock);
4383d7fbf8dfSSteven Rostedt (VMware) 
4384045e269cSAlex Shi 	ftrace_hash_move_and_update_ops(ops, orig_hash,
4385d7fbf8dfSSteven Rostedt (VMware) 					      new_hash, enable);
4386d7fbf8dfSSteven Rostedt (VMware) 	mutex_unlock(&ftrace_lock);
4387d7fbf8dfSSteven Rostedt (VMware) 
43883b58a3c7SSteven Rostedt (VMware)  out:
4389d7fbf8dfSSteven Rostedt (VMware) 	mutex_unlock(&ops->func_hash->regex_lock);
4390d7fbf8dfSSteven Rostedt (VMware) 
4391d7fbf8dfSSteven Rostedt (VMware) 	free_ftrace_hash(new_hash);
4392d7fbf8dfSSteven Rostedt (VMware) }
4393d7fbf8dfSSteven Rostedt (VMware) 
4394d7fbf8dfSSteven Rostedt (VMware) static void process_cached_mods(const char *mod_name)
4395d7fbf8dfSSteven Rostedt (VMware) {
4396d7fbf8dfSSteven Rostedt (VMware) 	struct trace_array *tr;
4397d7fbf8dfSSteven Rostedt (VMware) 	char *mod;
4398d7fbf8dfSSteven Rostedt (VMware) 
4399d7fbf8dfSSteven Rostedt (VMware) 	mod = kstrdup(mod_name, GFP_KERNEL);
4400d7fbf8dfSSteven Rostedt (VMware) 	if (!mod)
4401d7fbf8dfSSteven Rostedt (VMware) 		return;
4402d7fbf8dfSSteven Rostedt (VMware) 
4403d7fbf8dfSSteven Rostedt (VMware) 	mutex_lock(&trace_types_lock);
4404d7fbf8dfSSteven Rostedt (VMware) 	list_for_each_entry(tr, &ftrace_trace_arrays, list) {
4405d7fbf8dfSSteven Rostedt (VMware) 		if (!list_empty(&tr->mod_trace))
4406d7fbf8dfSSteven Rostedt (VMware) 			process_mod_list(&tr->mod_trace, tr->ops, mod, true);
4407d7fbf8dfSSteven Rostedt (VMware) 		if (!list_empty(&tr->mod_notrace))
4408d7fbf8dfSSteven Rostedt (VMware) 			process_mod_list(&tr->mod_notrace, tr->ops, mod, false);
4409d7fbf8dfSSteven Rostedt (VMware) 	}
4410d7fbf8dfSSteven Rostedt (VMware) 	mutex_unlock(&trace_types_lock);
4411d7fbf8dfSSteven Rostedt (VMware) 
4412d7fbf8dfSSteven Rostedt (VMware) 	kfree(mod);
4413d7fbf8dfSSteven Rostedt (VMware) }
441469449bbdSArnd Bergmann #endif
4415d7fbf8dfSSteven Rostedt (VMware) 
4416f6180773SSteven Rostedt /*
4417f6180773SSteven Rostedt  * We register the module command as a template to show others how
4418f6180773SSteven Rostedt  * to register the a command as well.
4419f6180773SSteven Rostedt  */
4420f6180773SSteven Rostedt 
4421f6180773SSteven Rostedt static int
442204ec7bb6SSteven Rostedt (VMware) ftrace_mod_callback(struct trace_array *tr, struct ftrace_hash *hash,
4423673feb9dSSteven Rostedt (VMware) 		    char *func_orig, char *cmd, char *module, int enable)
4424f6180773SSteven Rostedt {
4425673feb9dSSteven Rostedt (VMware) 	char *func;
44265e3949f0SDmitry Safonov 	int ret;
4427f6180773SSteven Rostedt 
4428673feb9dSSteven Rostedt (VMware) 	/* match_records() modifies func, and we need the original */
4429673feb9dSSteven Rostedt (VMware) 	func = kstrdup(func_orig, GFP_KERNEL);
4430673feb9dSSteven Rostedt (VMware) 	if (!func)
4431673feb9dSSteven Rostedt (VMware) 		return -ENOMEM;
4432673feb9dSSteven Rostedt (VMware) 
4433f6180773SSteven Rostedt 	/*
4434f6180773SSteven Rostedt 	 * cmd == 'mod' because we only registered this func
4435f6180773SSteven Rostedt 	 * for the 'mod' ftrace_func_command.
4436f6180773SSteven Rostedt 	 * But if you register one func with multiple commands,
4437f6180773SSteven Rostedt 	 * you can tell which command was used by the cmd
4438f6180773SSteven Rostedt 	 * parameter.
4439f6180773SSteven Rostedt 	 */
4440f0a3b154SDmitry Safonov 	ret = match_records(hash, func, strlen(func), module);
4441673feb9dSSteven Rostedt (VMware) 	kfree(func);
4442673feb9dSSteven Rostedt (VMware) 
4443b448c4e3SSteven Rostedt 	if (!ret)
4444673feb9dSSteven Rostedt (VMware) 		return cache_mod(tr, func_orig, module, enable);
4445b448c4e3SSteven Rostedt 	if (ret < 0)
4446b448c4e3SSteven Rostedt 		return ret;
4447f6180773SSteven Rostedt 	return 0;
4448f6180773SSteven Rostedt }
4449f6180773SSteven Rostedt 
4450f6180773SSteven Rostedt static struct ftrace_func_command ftrace_mod_cmd = {
4451f6180773SSteven Rostedt 	.name			= "mod",
4452f6180773SSteven Rostedt 	.func			= ftrace_mod_callback,
4453f6180773SSteven Rostedt };
4454f6180773SSteven Rostedt 
4455f6180773SSteven Rostedt static int __init ftrace_mod_cmd_init(void)
4456f6180773SSteven Rostedt {
4457f6180773SSteven Rostedt 	return register_ftrace_command(&ftrace_mod_cmd);
4458f6180773SSteven Rostedt }
44596f415672SSteven Rostedt core_initcall(ftrace_mod_cmd_init);
4460f6180773SSteven Rostedt 
44612f5f6ad9SSteven Rostedt static void function_trace_probe_call(unsigned long ip, unsigned long parent_ip,
4462d19ad077SSteven Rostedt (VMware) 				      struct ftrace_ops *op, struct ftrace_regs *fregs)
446359df055fSSteven Rostedt {
4464eee8ded1SSteven Rostedt (VMware) 	struct ftrace_probe_ops *probe_ops;
44657b60f3d8SSteven Rostedt (VMware) 	struct ftrace_func_probe *probe;
446659df055fSSteven Rostedt 
44677b60f3d8SSteven Rostedt (VMware) 	probe = container_of(op, struct ftrace_func_probe, ops);
44687b60f3d8SSteven Rostedt (VMware) 	probe_ops = probe->probe_ops;
446959df055fSSteven Rostedt 
447059df055fSSteven Rostedt 	/*
447159df055fSSteven Rostedt 	 * Disable preemption for these calls to prevent a RCU grace
447259df055fSSteven Rostedt 	 * period. This syncs the hash iteration and freeing of items
447359df055fSSteven Rostedt 	 * on the hash. rcu_read_lock is too dangerous here.
447459df055fSSteven Rostedt 	 */
44755168ae50SSteven Rostedt 	preempt_disable_notrace();
44766e444319SSteven Rostedt (VMware) 	probe_ops->func(ip, parent_ip, probe->tr, probe_ops, probe->data);
44775168ae50SSteven Rostedt 	preempt_enable_notrace();
447859df055fSSteven Rostedt }
447959df055fSSteven Rostedt 
448041794f19SSteven Rostedt (VMware) struct ftrace_func_map {
448141794f19SSteven Rostedt (VMware) 	struct ftrace_func_entry	entry;
448241794f19SSteven Rostedt (VMware) 	void				*data;
448359df055fSSteven Rostedt };
448459df055fSSteven Rostedt 
448541794f19SSteven Rostedt (VMware) struct ftrace_func_mapper {
448641794f19SSteven Rostedt (VMware) 	struct ftrace_hash		hash;
448741794f19SSteven Rostedt (VMware) };
448859df055fSSteven Rostedt 
448941794f19SSteven Rostedt (VMware) /**
449041794f19SSteven Rostedt (VMware)  * allocate_ftrace_func_mapper - allocate a new ftrace_func_mapper
449141794f19SSteven Rostedt (VMware)  *
449241794f19SSteven Rostedt (VMware)  * Returns a ftrace_func_mapper descriptor that can be used to map ips to data.
449341794f19SSteven Rostedt (VMware)  */
449441794f19SSteven Rostedt (VMware) struct ftrace_func_mapper *allocate_ftrace_func_mapper(void)
449559df055fSSteven Rostedt {
4496e1df4cb6SSteven Rostedt (Red Hat) 	struct ftrace_hash *hash;
449759df055fSSteven Rostedt 
449841794f19SSteven Rostedt (VMware) 	/*
449941794f19SSteven Rostedt (VMware) 	 * The mapper is simply a ftrace_hash, but since the entries
450041794f19SSteven Rostedt (VMware) 	 * in the hash are not ftrace_func_entry type, we define it
450141794f19SSteven Rostedt (VMware) 	 * as a separate structure.
450241794f19SSteven Rostedt (VMware) 	 */
450341794f19SSteven Rostedt (VMware) 	hash = alloc_ftrace_hash(FTRACE_HASH_DEFAULT_BITS);
450441794f19SSteven Rostedt (VMware) 	return (struct ftrace_func_mapper *)hash;
4505e1df4cb6SSteven Rostedt (Red Hat) }
4506e1df4cb6SSteven Rostedt (Red Hat) 
450741794f19SSteven Rostedt (VMware) /**
450841794f19SSteven Rostedt (VMware)  * ftrace_func_mapper_find_ip - Find some data mapped to an ip
450941794f19SSteven Rostedt (VMware)  * @mapper: The mapper that has the ip maps
451041794f19SSteven Rostedt (VMware)  * @ip: the instruction pointer to find the data for
451141794f19SSteven Rostedt (VMware)  *
451241794f19SSteven Rostedt (VMware)  * Returns the data mapped to @ip if found otherwise NULL. The return
451341794f19SSteven Rostedt (VMware)  * is actually the address of the mapper data pointer. The address is
451441794f19SSteven Rostedt (VMware)  * returned for use cases where the data is no bigger than a long, and
451541794f19SSteven Rostedt (VMware)  * the user can use the data pointer as its data instead of having to
451641794f19SSteven Rostedt (VMware)  * allocate more memory for the reference.
451741794f19SSteven Rostedt (VMware)  */
451841794f19SSteven Rostedt (VMware) void **ftrace_func_mapper_find_ip(struct ftrace_func_mapper *mapper,
451941794f19SSteven Rostedt (VMware) 				  unsigned long ip)
452041794f19SSteven Rostedt (VMware) {
452141794f19SSteven Rostedt (VMware) 	struct ftrace_func_entry *entry;
452241794f19SSteven Rostedt (VMware) 	struct ftrace_func_map *map;
452341794f19SSteven Rostedt (VMware) 
452441794f19SSteven Rostedt (VMware) 	entry = ftrace_lookup_ip(&mapper->hash, ip);
452541794f19SSteven Rostedt (VMware) 	if (!entry)
452641794f19SSteven Rostedt (VMware) 		return NULL;
452741794f19SSteven Rostedt (VMware) 
452841794f19SSteven Rostedt (VMware) 	map = (struct ftrace_func_map *)entry;
452941794f19SSteven Rostedt (VMware) 	return &map->data;
4530e1df4cb6SSteven Rostedt (Red Hat) }
453145a4a237SSteven Rostedt 
453241794f19SSteven Rostedt (VMware) /**
453341794f19SSteven Rostedt (VMware)  * ftrace_func_mapper_add_ip - Map some data to an ip
453441794f19SSteven Rostedt (VMware)  * @mapper: The mapper that has the ip maps
453541794f19SSteven Rostedt (VMware)  * @ip: The instruction pointer address to map @data to
453641794f19SSteven Rostedt (VMware)  * @data: The data to map to @ip
453741794f19SSteven Rostedt (VMware)  *
4538fdda88d3SQiujun Huang  * Returns 0 on success otherwise an error.
453941794f19SSteven Rostedt (VMware)  */
454041794f19SSteven Rostedt (VMware) int ftrace_func_mapper_add_ip(struct ftrace_func_mapper *mapper,
454141794f19SSteven Rostedt (VMware) 			      unsigned long ip, void *data)
454241794f19SSteven Rostedt (VMware) {
454341794f19SSteven Rostedt (VMware) 	struct ftrace_func_entry *entry;
454441794f19SSteven Rostedt (VMware) 	struct ftrace_func_map *map;
454541794f19SSteven Rostedt (VMware) 
454641794f19SSteven Rostedt (VMware) 	entry = ftrace_lookup_ip(&mapper->hash, ip);
454741794f19SSteven Rostedt (VMware) 	if (entry)
454841794f19SSteven Rostedt (VMware) 		return -EBUSY;
454941794f19SSteven Rostedt (VMware) 
455041794f19SSteven Rostedt (VMware) 	map = kmalloc(sizeof(*map), GFP_KERNEL);
455141794f19SSteven Rostedt (VMware) 	if (!map)
455241794f19SSteven Rostedt (VMware) 		return -ENOMEM;
455341794f19SSteven Rostedt (VMware) 
455441794f19SSteven Rostedt (VMware) 	map->entry.ip = ip;
455541794f19SSteven Rostedt (VMware) 	map->data = data;
455641794f19SSteven Rostedt (VMware) 
455741794f19SSteven Rostedt (VMware) 	__add_hash_entry(&mapper->hash, &map->entry);
455841794f19SSteven Rostedt (VMware) 
455941794f19SSteven Rostedt (VMware) 	return 0;
456041794f19SSteven Rostedt (VMware) }
456141794f19SSteven Rostedt (VMware) 
456241794f19SSteven Rostedt (VMware) /**
456341794f19SSteven Rostedt (VMware)  * ftrace_func_mapper_remove_ip - Remove an ip from the mapping
456441794f19SSteven Rostedt (VMware)  * @mapper: The mapper that has the ip maps
456541794f19SSteven Rostedt (VMware)  * @ip: The instruction pointer address to remove the data from
456641794f19SSteven Rostedt (VMware)  *
456741794f19SSteven Rostedt (VMware)  * Returns the data if it is found, otherwise NULL.
456841794f19SSteven Rostedt (VMware)  * Note, if the data pointer is used as the data itself, (see
456941794f19SSteven Rostedt (VMware)  * ftrace_func_mapper_find_ip(), then the return value may be meaningless,
457041794f19SSteven Rostedt (VMware)  * if the data pointer was set to zero.
457141794f19SSteven Rostedt (VMware)  */
457241794f19SSteven Rostedt (VMware) void *ftrace_func_mapper_remove_ip(struct ftrace_func_mapper *mapper,
457341794f19SSteven Rostedt (VMware) 				   unsigned long ip)
457441794f19SSteven Rostedt (VMware) {
457541794f19SSteven Rostedt (VMware) 	struct ftrace_func_entry *entry;
457641794f19SSteven Rostedt (VMware) 	struct ftrace_func_map *map;
457741794f19SSteven Rostedt (VMware) 	void *data;
457841794f19SSteven Rostedt (VMware) 
457941794f19SSteven Rostedt (VMware) 	entry = ftrace_lookup_ip(&mapper->hash, ip);
458041794f19SSteven Rostedt (VMware) 	if (!entry)
458141794f19SSteven Rostedt (VMware) 		return NULL;
458241794f19SSteven Rostedt (VMware) 
458341794f19SSteven Rostedt (VMware) 	map = (struct ftrace_func_map *)entry;
458441794f19SSteven Rostedt (VMware) 	data = map->data;
458541794f19SSteven Rostedt (VMware) 
458641794f19SSteven Rostedt (VMware) 	remove_hash_entry(&mapper->hash, entry);
458741794f19SSteven Rostedt (VMware) 	kfree(entry);
458841794f19SSteven Rostedt (VMware) 
458941794f19SSteven Rostedt (VMware) 	return data;
459041794f19SSteven Rostedt (VMware) }
459141794f19SSteven Rostedt (VMware) 
459241794f19SSteven Rostedt (VMware) /**
459341794f19SSteven Rostedt (VMware)  * free_ftrace_func_mapper - free a mapping of ips and data
459441794f19SSteven Rostedt (VMware)  * @mapper: The mapper that has the ip maps
459541794f19SSteven Rostedt (VMware)  * @free_func: A function to be called on each data item.
459641794f19SSteven Rostedt (VMware)  *
459741794f19SSteven Rostedt (VMware)  * This is used to free the function mapper. The @free_func is optional
459841794f19SSteven Rostedt (VMware)  * and can be used if the data needs to be freed as well.
459941794f19SSteven Rostedt (VMware)  */
460041794f19SSteven Rostedt (VMware) void free_ftrace_func_mapper(struct ftrace_func_mapper *mapper,
460141794f19SSteven Rostedt (VMware) 			     ftrace_mapper_func free_func)
460241794f19SSteven Rostedt (VMware) {
460341794f19SSteven Rostedt (VMware) 	struct ftrace_func_entry *entry;
460441794f19SSteven Rostedt (VMware) 	struct ftrace_func_map *map;
460541794f19SSteven Rostedt (VMware) 	struct hlist_head *hhd;
460604e03d9aSWei Li 	int size, i;
460704e03d9aSWei Li 
460804e03d9aSWei Li 	if (!mapper)
460904e03d9aSWei Li 		return;
461041794f19SSteven Rostedt (VMware) 
461141794f19SSteven Rostedt (VMware) 	if (free_func && mapper->hash.count) {
461204e03d9aSWei Li 		size = 1 << mapper->hash.size_bits;
461341794f19SSteven Rostedt (VMware) 		for (i = 0; i < size; i++) {
461441794f19SSteven Rostedt (VMware) 			hhd = &mapper->hash.buckets[i];
461541794f19SSteven Rostedt (VMware) 			hlist_for_each_entry(entry, hhd, hlist) {
461641794f19SSteven Rostedt (VMware) 				map = (struct ftrace_func_map *)entry;
461741794f19SSteven Rostedt (VMware) 				free_func(map);
461841794f19SSteven Rostedt (VMware) 			}
461941794f19SSteven Rostedt (VMware) 		}
462041794f19SSteven Rostedt (VMware) 	}
462141794f19SSteven Rostedt (VMware) 	free_ftrace_hash(&mapper->hash);
462241794f19SSteven Rostedt (VMware) }
462341794f19SSteven Rostedt (VMware) 
46247b60f3d8SSteven Rostedt (VMware) static void release_probe(struct ftrace_func_probe *probe)
46257b60f3d8SSteven Rostedt (VMware) {
46267b60f3d8SSteven Rostedt (VMware) 	struct ftrace_probe_ops *probe_ops;
46277b60f3d8SSteven Rostedt (VMware) 
46285ae0bf59SSteven Rostedt (Red Hat) 	mutex_lock(&ftrace_lock);
46295ae0bf59SSteven Rostedt (Red Hat) 
46307b60f3d8SSteven Rostedt (VMware) 	WARN_ON(probe->ref <= 0);
463159df055fSSteven Rostedt 
46327b60f3d8SSteven Rostedt (VMware) 	/* Subtract the ref that was used to protect this instance */
46337b60f3d8SSteven Rostedt (VMware) 	probe->ref--;
4634546fece4SSteven Rostedt (Red Hat) 
46357b60f3d8SSteven Rostedt (VMware) 	if (!probe->ref) {
46367b60f3d8SSteven Rostedt (VMware) 		probe_ops = probe->probe_ops;
46376e444319SSteven Rostedt (VMware) 		/*
46386e444319SSteven Rostedt (VMware) 		 * Sending zero as ip tells probe_ops to free
46396e444319SSteven Rostedt (VMware) 		 * the probe->data itself
46406e444319SSteven Rostedt (VMware) 		 */
46416e444319SSteven Rostedt (VMware) 		if (probe_ops->free)
46426e444319SSteven Rostedt (VMware) 			probe_ops->free(probe_ops, probe->tr, 0, probe->data);
46437b60f3d8SSteven Rostedt (VMware) 		list_del(&probe->list);
46447b60f3d8SSteven Rostedt (VMware) 		kfree(probe);
46457b60f3d8SSteven Rostedt (VMware) 	}
46467b60f3d8SSteven Rostedt (VMware) 	mutex_unlock(&ftrace_lock);
464759df055fSSteven Rostedt }
464859df055fSSteven Rostedt 
46497b60f3d8SSteven Rostedt (VMware) static void acquire_probe_locked(struct ftrace_func_probe *probe)
46507b60f3d8SSteven Rostedt (VMware) {
46517b60f3d8SSteven Rostedt (VMware) 	/*
46527b60f3d8SSteven Rostedt (VMware) 	 * Add one ref to keep it from being freed when releasing the
46537b60f3d8SSteven Rostedt (VMware) 	 * ftrace_lock mutex.
46547b60f3d8SSteven Rostedt (VMware) 	 */
46557b60f3d8SSteven Rostedt (VMware) 	probe->ref++;
46567b60f3d8SSteven Rostedt (VMware) }
465759df055fSSteven Rostedt 
465859df055fSSteven Rostedt int
465904ec7bb6SSteven Rostedt (VMware) register_ftrace_function_probe(char *glob, struct trace_array *tr,
46607b60f3d8SSteven Rostedt (VMware) 			       struct ftrace_probe_ops *probe_ops,
46617b60f3d8SSteven Rostedt (VMware) 			       void *data)
466259df055fSSteven Rostedt {
4663ba27d855SJakob Koschel 	struct ftrace_func_probe *probe = NULL, *iter;
46641ec3a81aSSteven Rostedt (VMware) 	struct ftrace_func_entry *entry;
46651ec3a81aSSteven Rostedt (VMware) 	struct ftrace_hash **orig_hash;
46661ec3a81aSSteven Rostedt (VMware) 	struct ftrace_hash *old_hash;
466759df055fSSteven Rostedt 	struct ftrace_hash *hash;
466859df055fSSteven Rostedt 	int count = 0;
46691ec3a81aSSteven Rostedt (VMware) 	int size;
467059df055fSSteven Rostedt 	int ret;
46711ec3a81aSSteven Rostedt (VMware) 	int i;
467259df055fSSteven Rostedt 
467304ec7bb6SSteven Rostedt (VMware) 	if (WARN_ON(!tr))
467404ec7bb6SSteven Rostedt (VMware) 		return -EINVAL;
467504ec7bb6SSteven Rostedt (VMware) 
46761ec3a81aSSteven Rostedt (VMware) 	/* We do not support '!' for function probes */
46771ec3a81aSSteven Rostedt (VMware) 	if (WARN_ON(glob[0] == '!'))
467859df055fSSteven Rostedt 		return -EINVAL;
467959df055fSSteven Rostedt 
46807b60f3d8SSteven Rostedt (VMware) 
46817b60f3d8SSteven Rostedt (VMware) 	mutex_lock(&ftrace_lock);
46827b60f3d8SSteven Rostedt (VMware) 	/* Check if the probe_ops is already registered */
4683ba27d855SJakob Koschel 	list_for_each_entry(iter, &tr->func_probes, list) {
4684ba27d855SJakob Koschel 		if (iter->probe_ops == probe_ops) {
4685ba27d855SJakob Koschel 			probe = iter;
46867b60f3d8SSteven Rostedt (VMware) 			break;
46877b60f3d8SSteven Rostedt (VMware) 		}
4688ba27d855SJakob Koschel 	}
4689ba27d855SJakob Koschel 	if (!probe) {
46907b60f3d8SSteven Rostedt (VMware) 		probe = kzalloc(sizeof(*probe), GFP_KERNEL);
46917b60f3d8SSteven Rostedt (VMware) 		if (!probe) {
46927b60f3d8SSteven Rostedt (VMware) 			mutex_unlock(&ftrace_lock);
46937b60f3d8SSteven Rostedt (VMware) 			return -ENOMEM;
46947b60f3d8SSteven Rostedt (VMware) 		}
46957b60f3d8SSteven Rostedt (VMware) 		probe->probe_ops = probe_ops;
46967b60f3d8SSteven Rostedt (VMware) 		probe->ops.func = function_trace_probe_call;
46977b60f3d8SSteven Rostedt (VMware) 		probe->tr = tr;
46987b60f3d8SSteven Rostedt (VMware) 		ftrace_ops_init(&probe->ops);
46997b60f3d8SSteven Rostedt (VMware) 		list_add(&probe->list, &tr->func_probes);
47001ec3a81aSSteven Rostedt (VMware) 	}
470159df055fSSteven Rostedt 
47027b60f3d8SSteven Rostedt (VMware) 	acquire_probe_locked(probe);
470359df055fSSteven Rostedt 
47047b60f3d8SSteven Rostedt (VMware) 	mutex_unlock(&ftrace_lock);
47057b60f3d8SSteven Rostedt (VMware) 
4706372e0d01SSteven Rostedt (VMware) 	/*
4707372e0d01SSteven Rostedt (VMware) 	 * Note, there's a small window here that the func_hash->filter_hash
4708fdda88d3SQiujun Huang 	 * may be NULL or empty. Need to be careful when reading the loop.
4709372e0d01SSteven Rostedt (VMware) 	 */
47107b60f3d8SSteven Rostedt (VMware) 	mutex_lock(&probe->ops.func_hash->regex_lock);
47117b60f3d8SSteven Rostedt (VMware) 
47127b60f3d8SSteven Rostedt (VMware) 	orig_hash = &probe->ops.func_hash->filter_hash;
47131ec3a81aSSteven Rostedt (VMware) 	old_hash = *orig_hash;
471459df055fSSteven Rostedt 	hash = alloc_and_copy_ftrace_hash(FTRACE_HASH_DEFAULT_BITS, old_hash);
47151ec3a81aSSteven Rostedt (VMware) 
47165b0022ddSNaveen N. Rao 	if (!hash) {
47175b0022ddSNaveen N. Rao 		ret = -ENOMEM;
47185b0022ddSNaveen N. Rao 		goto out;
47195b0022ddSNaveen N. Rao 	}
47205b0022ddSNaveen N. Rao 
47211ec3a81aSSteven Rostedt (VMware) 	ret = ftrace_match_records(hash, glob, strlen(glob));
47221ec3a81aSSteven Rostedt (VMware) 
47231ec3a81aSSteven Rostedt (VMware) 	/* Nothing found? */
47241ec3a81aSSteven Rostedt (VMware) 	if (!ret)
47251ec3a81aSSteven Rostedt (VMware) 		ret = -EINVAL;
47261ec3a81aSSteven Rostedt (VMware) 
47271ec3a81aSSteven Rostedt (VMware) 	if (ret < 0)
472859df055fSSteven Rostedt 		goto out;
472959df055fSSteven Rostedt 
47301ec3a81aSSteven Rostedt (VMware) 	size = 1 << hash->size_bits;
47311ec3a81aSSteven Rostedt (VMware) 	for (i = 0; i < size; i++) {
47321ec3a81aSSteven Rostedt (VMware) 		hlist_for_each_entry(entry, &hash->buckets[i], hlist) {
47331ec3a81aSSteven Rostedt (VMware) 			if (ftrace_lookup_ip(old_hash, entry->ip))
473459df055fSSteven Rostedt 				continue;
473559df055fSSteven Rostedt 			/*
473659df055fSSteven Rostedt 			 * The caller might want to do something special
473759df055fSSteven Rostedt 			 * for each function we find. We call the callback
473859df055fSSteven Rostedt 			 * to give the caller an opportunity to do so.
473959df055fSSteven Rostedt 			 */
47407b60f3d8SSteven Rostedt (VMware) 			if (probe_ops->init) {
47417b60f3d8SSteven Rostedt (VMware) 				ret = probe_ops->init(probe_ops, tr,
47426e444319SSteven Rostedt (VMware) 						      entry->ip, data,
47436e444319SSteven Rostedt (VMware) 						      &probe->data);
47446e444319SSteven Rostedt (VMware) 				if (ret < 0) {
47456e444319SSteven Rostedt (VMware) 					if (probe_ops->free && count)
47466e444319SSteven Rostedt (VMware) 						probe_ops->free(probe_ops, tr,
47476e444319SSteven Rostedt (VMware) 								0, probe->data);
47486e444319SSteven Rostedt (VMware) 					probe->data = NULL;
4749eee8ded1SSteven Rostedt (VMware) 					goto out;
47501ec3a81aSSteven Rostedt (VMware) 				}
47516e444319SSteven Rostedt (VMware) 			}
47521ec3a81aSSteven Rostedt (VMware) 			count++;
475359df055fSSteven Rostedt 		}
475459df055fSSteven Rostedt 	}
475559df055fSSteven Rostedt 
47561ec3a81aSSteven Rostedt (VMware) 	mutex_lock(&ftrace_lock);
47571ec3a81aSSteven Rostedt (VMware) 
47587b60f3d8SSteven Rostedt (VMware) 	if (!count) {
47597b60f3d8SSteven Rostedt (VMware) 		/* Nothing was added? */
47607b60f3d8SSteven Rostedt (VMware) 		ret = -EINVAL;
4761e1df4cb6SSteven Rostedt (Red Hat) 		goto out_unlock;
4762e1df4cb6SSteven Rostedt (Red Hat) 	}
4763e1df4cb6SSteven Rostedt (Red Hat) 
47647b60f3d8SSteven Rostedt (VMware) 	ret = ftrace_hash_move_and_update_ops(&probe->ops, orig_hash,
47651ec3a81aSSteven Rostedt (VMware) 					      hash, 1);
47661ec3a81aSSteven Rostedt (VMware) 	if (ret < 0)
47678d70725eSSteven Rostedt (VMware) 		goto err_unlock;
476859df055fSSteven Rostedt 
47697b60f3d8SSteven Rostedt (VMware) 	/* One ref for each new function traced */
47707b60f3d8SSteven Rostedt (VMware) 	probe->ref += count;
477159df055fSSteven Rostedt 
47727b60f3d8SSteven Rostedt (VMware) 	if (!(probe->ops.flags & FTRACE_OPS_FL_ENABLED))
47737b60f3d8SSteven Rostedt (VMware) 		ret = ftrace_startup(&probe->ops, 0);
4774e1df4cb6SSteven Rostedt (Red Hat) 
477559df055fSSteven Rostedt  out_unlock:
47765ae0bf59SSteven Rostedt (Red Hat) 	mutex_unlock(&ftrace_lock);
477759df055fSSteven Rostedt 
477859df055fSSteven Rostedt 	if (!ret)
47791ec3a81aSSteven Rostedt (VMware) 		ret = count;
47805ae0bf59SSteven Rostedt (Red Hat)  out:
47817b60f3d8SSteven Rostedt (VMware) 	mutex_unlock(&probe->ops.func_hash->regex_lock);
4782e1df4cb6SSteven Rostedt (Red Hat) 	free_ftrace_hash(hash);
478359df055fSSteven Rostedt 
47847b60f3d8SSteven Rostedt (VMware) 	release_probe(probe);
47857b60f3d8SSteven Rostedt (VMware) 
47861ec3a81aSSteven Rostedt (VMware) 	return ret;
47878d70725eSSteven Rostedt (VMware) 
47888d70725eSSteven Rostedt (VMware)  err_unlock:
47897b60f3d8SSteven Rostedt (VMware) 	if (!probe_ops->free || !count)
47908d70725eSSteven Rostedt (VMware) 		goto out_unlock;
47918d70725eSSteven Rostedt (VMware) 
47928d70725eSSteven Rostedt (VMware) 	/* Failed to do the move, need to call the free functions */
47938d70725eSSteven Rostedt (VMware) 	for (i = 0; i < size; i++) {
47948d70725eSSteven Rostedt (VMware) 		hlist_for_each_entry(entry, &hash->buckets[i], hlist) {
47958d70725eSSteven Rostedt (VMware) 			if (ftrace_lookup_ip(old_hash, entry->ip))
47968d70725eSSteven Rostedt (VMware) 				continue;
47976e444319SSteven Rostedt (VMware) 			probe_ops->free(probe_ops, tr, entry->ip, probe->data);
47988d70725eSSteven Rostedt (VMware) 		}
47998d70725eSSteven Rostedt (VMware) 	}
48008d70725eSSteven Rostedt (VMware) 	goto out_unlock;
480159df055fSSteven Rostedt }
480259df055fSSteven Rostedt 
4803d3d532d7SSteven Rostedt (VMware) int
48047b60f3d8SSteven Rostedt (VMware) unregister_ftrace_function_probe_func(char *glob, struct trace_array *tr,
48057b60f3d8SSteven Rostedt (VMware) 				      struct ftrace_probe_ops *probe_ops)
480659df055fSSteven Rostedt {
4807ba27d855SJakob Koschel 	struct ftrace_func_probe *probe = NULL, *iter;
480882cc4fc2SSteven Rostedt (VMware) 	struct ftrace_ops_hash old_hash_ops;
4809eee8ded1SSteven Rostedt (VMware) 	struct ftrace_func_entry *entry;
48103ba00929SDmitry Safonov 	struct ftrace_glob func_g;
48111ec3a81aSSteven Rostedt (VMware) 	struct ftrace_hash **orig_hash;
48121ec3a81aSSteven Rostedt (VMware) 	struct ftrace_hash *old_hash;
48131ec3a81aSSteven Rostedt (VMware) 	struct ftrace_hash *hash = NULL;
4814b67bfe0dSSasha Levin 	struct hlist_node *tmp;
4815eee8ded1SSteven Rostedt (VMware) 	struct hlist_head hhd;
481659df055fSSteven Rostedt 	char str[KSYM_SYMBOL_LEN];
48177b60f3d8SSteven Rostedt (VMware) 	int count = 0;
48187b60f3d8SSteven Rostedt (VMware) 	int i, ret = -ENODEV;
4819eee8ded1SSteven Rostedt (VMware) 	int size;
482059df055fSSteven Rostedt 
4821cbab567cSNaveen N. Rao 	if (!glob || !strlen(glob) || !strcmp(glob, "*"))
48223ba00929SDmitry Safonov 		func_g.search = NULL;
4823cbab567cSNaveen N. Rao 	else {
482459df055fSSteven Rostedt 		int not;
482559df055fSSteven Rostedt 
48263ba00929SDmitry Safonov 		func_g.type = filter_parse_regex(glob, strlen(glob),
48273ba00929SDmitry Safonov 						 &func_g.search, &not);
48283ba00929SDmitry Safonov 		func_g.len = strlen(func_g.search);
482959df055fSSteven Rostedt 
4830b6887d79SSteven Rostedt 		/* we do not support '!' for function probes */
483159df055fSSteven Rostedt 		if (WARN_ON(not))
4832d3d532d7SSteven Rostedt (VMware) 			return -EINVAL;
483359df055fSSteven Rostedt 	}
483459df055fSSteven Rostedt 
48357b60f3d8SSteven Rostedt (VMware) 	mutex_lock(&ftrace_lock);
48367b60f3d8SSteven Rostedt (VMware) 	/* Check if the probe_ops is already registered */
4837ba27d855SJakob Koschel 	list_for_each_entry(iter, &tr->func_probes, list) {
4838ba27d855SJakob Koschel 		if (iter->probe_ops == probe_ops) {
4839ba27d855SJakob Koschel 			probe = iter;
48407b60f3d8SSteven Rostedt (VMware) 			break;
48417b60f3d8SSteven Rostedt (VMware) 		}
4842ba27d855SJakob Koschel 	}
4843ba27d855SJakob Koschel 	if (!probe)
48447b60f3d8SSteven Rostedt (VMware) 		goto err_unlock_ftrace;
48451ec3a81aSSteven Rostedt (VMware) 
48461ec3a81aSSteven Rostedt (VMware) 	ret = -EINVAL;
48477b60f3d8SSteven Rostedt (VMware) 	if (!(probe->ops.flags & FTRACE_OPS_FL_INITIALIZED))
48487b60f3d8SSteven Rostedt (VMware) 		goto err_unlock_ftrace;
48497b60f3d8SSteven Rostedt (VMware) 
48507b60f3d8SSteven Rostedt (VMware) 	acquire_probe_locked(probe);
48517b60f3d8SSteven Rostedt (VMware) 
48527b60f3d8SSteven Rostedt (VMware) 	mutex_unlock(&ftrace_lock);
48537b60f3d8SSteven Rostedt (VMware) 
48547b60f3d8SSteven Rostedt (VMware) 	mutex_lock(&probe->ops.func_hash->regex_lock);
48557b60f3d8SSteven Rostedt (VMware) 
48567b60f3d8SSteven Rostedt (VMware) 	orig_hash = &probe->ops.func_hash->filter_hash;
48577b60f3d8SSteven Rostedt (VMware) 	old_hash = *orig_hash;
48587b60f3d8SSteven Rostedt (VMware) 
48591ec3a81aSSteven Rostedt (VMware) 	if (ftrace_hash_empty(old_hash))
48601ec3a81aSSteven Rostedt (VMware) 		goto out_unlock;
4861e1df4cb6SSteven Rostedt (Red Hat) 
486282cc4fc2SSteven Rostedt (VMware) 	old_hash_ops.filter_hash = old_hash;
486382cc4fc2SSteven Rostedt (VMware) 	/* Probes only have filters */
486482cc4fc2SSteven Rostedt (VMware) 	old_hash_ops.notrace_hash = NULL;
486582cc4fc2SSteven Rostedt (VMware) 
4866d3d532d7SSteven Rostedt (VMware) 	ret = -ENOMEM;
48671ec3a81aSSteven Rostedt (VMware) 	hash = alloc_and_copy_ftrace_hash(FTRACE_HASH_DEFAULT_BITS, old_hash);
4868e1df4cb6SSteven Rostedt (Red Hat) 	if (!hash)
4869e1df4cb6SSteven Rostedt (Red Hat) 		goto out_unlock;
4870e1df4cb6SSteven Rostedt (Red Hat) 
4871eee8ded1SSteven Rostedt (VMware) 	INIT_HLIST_HEAD(&hhd);
48727818b388SSteven Rostedt (Red Hat) 
4873eee8ded1SSteven Rostedt (VMware) 	size = 1 << hash->size_bits;
4874eee8ded1SSteven Rostedt (VMware) 	for (i = 0; i < size; i++) {
4875eee8ded1SSteven Rostedt (VMware) 		hlist_for_each_entry_safe(entry, tmp, &hash->buckets[i], hlist) {
487659df055fSSteven Rostedt 
48773ba00929SDmitry Safonov 			if (func_g.search) {
487859df055fSSteven Rostedt 				kallsyms_lookup(entry->ip, NULL, NULL,
487959df055fSSteven Rostedt 						NULL, str);
48803ba00929SDmitry Safonov 				if (!ftrace_match(str, &func_g))
488159df055fSSteven Rostedt 					continue;
488259df055fSSteven Rostedt 			}
48837b60f3d8SSteven Rostedt (VMware) 			count++;
4884eee8ded1SSteven Rostedt (VMware) 			remove_hash_entry(hash, entry);
4885eee8ded1SSteven Rostedt (VMware) 			hlist_add_head(&entry->hlist, &hhd);
488659df055fSSteven Rostedt 		}
488759df055fSSteven Rostedt 	}
4888d3d532d7SSteven Rostedt (VMware) 
4889d3d532d7SSteven Rostedt (VMware) 	/* Nothing found? */
48907b60f3d8SSteven Rostedt (VMware) 	if (!count) {
4891d3d532d7SSteven Rostedt (VMware) 		ret = -EINVAL;
4892d3d532d7SSteven Rostedt (VMware) 		goto out_unlock;
4893d3d532d7SSteven Rostedt (VMware) 	}
4894d3d532d7SSteven Rostedt (VMware) 
48953f2367baSMasami Hiramatsu 	mutex_lock(&ftrace_lock);
48961ec3a81aSSteven Rostedt (VMware) 
48977b60f3d8SSteven Rostedt (VMware) 	WARN_ON(probe->ref < count);
4898eee8ded1SSteven Rostedt (VMware) 
48997b60f3d8SSteven Rostedt (VMware) 	probe->ref -= count;
49001ec3a81aSSteven Rostedt (VMware) 
49017b60f3d8SSteven Rostedt (VMware) 	if (ftrace_hash_empty(hash))
49027b60f3d8SSteven Rostedt (VMware) 		ftrace_shutdown(&probe->ops, 0);
49037b60f3d8SSteven Rostedt (VMware) 
49047b60f3d8SSteven Rostedt (VMware) 	ret = ftrace_hash_move_and_update_ops(&probe->ops, orig_hash,
49051ec3a81aSSteven Rostedt (VMware) 					      hash, 1);
490682cc4fc2SSteven Rostedt (VMware) 
490782cc4fc2SSteven Rostedt (VMware) 	/* still need to update the function call sites */
49081ec3a81aSSteven Rostedt (VMware) 	if (ftrace_enabled && !ftrace_hash_empty(hash))
49097b60f3d8SSteven Rostedt (VMware) 		ftrace_run_modify_code(&probe->ops, FTRACE_UPDATE_CALLS,
491082cc4fc2SSteven Rostedt (VMware) 				       &old_hash_ops);
491174401729SPaul E. McKenney 	synchronize_rcu();
49123296fc4eSSteven Rostedt (Red Hat) 
4913eee8ded1SSteven Rostedt (VMware) 	hlist_for_each_entry_safe(entry, tmp, &hhd, hlist) {
4914eee8ded1SSteven Rostedt (VMware) 		hlist_del(&entry->hlist);
49157b60f3d8SSteven Rostedt (VMware) 		if (probe_ops->free)
49166e444319SSteven Rostedt (VMware) 			probe_ops->free(probe_ops, tr, entry->ip, probe->data);
4917eee8ded1SSteven Rostedt (VMware) 		kfree(entry);
49187818b388SSteven Rostedt (Red Hat) 	}
49193f2367baSMasami Hiramatsu 	mutex_unlock(&ftrace_lock);
49207818b388SSteven Rostedt (Red Hat) 
4921e1df4cb6SSteven Rostedt (Red Hat)  out_unlock:
49227b60f3d8SSteven Rostedt (VMware) 	mutex_unlock(&probe->ops.func_hash->regex_lock);
4923e1df4cb6SSteven Rostedt (Red Hat) 	free_ftrace_hash(hash);
492459df055fSSteven Rostedt 
49257b60f3d8SSteven Rostedt (VMware) 	release_probe(probe);
492659df055fSSteven Rostedt 
49277b60f3d8SSteven Rostedt (VMware) 	return ret;
492859df055fSSteven Rostedt 
49297b60f3d8SSteven Rostedt (VMware)  err_unlock_ftrace:
49307b60f3d8SSteven Rostedt (VMware) 	mutex_unlock(&ftrace_lock);
4931d3d532d7SSteven Rostedt (VMware) 	return ret;
493259df055fSSteven Rostedt }
493359df055fSSteven Rostedt 
4934a0e6369eSNaveen N. Rao void clear_ftrace_function_probes(struct trace_array *tr)
4935a0e6369eSNaveen N. Rao {
4936a0e6369eSNaveen N. Rao 	struct ftrace_func_probe *probe, *n;
4937a0e6369eSNaveen N. Rao 
4938a0e6369eSNaveen N. Rao 	list_for_each_entry_safe(probe, n, &tr->func_probes, list)
4939a0e6369eSNaveen N. Rao 		unregister_ftrace_function_probe_func(NULL, tr, probe->probe_ops);
4940a0e6369eSNaveen N. Rao }
4941a0e6369eSNaveen N. Rao 
4942f6180773SSteven Rostedt static LIST_HEAD(ftrace_commands);
4943f6180773SSteven Rostedt static DEFINE_MUTEX(ftrace_cmd_mutex);
4944f6180773SSteven Rostedt 
494538de93abSTom Zanussi /*
494638de93abSTom Zanussi  * Currently we only register ftrace commands from __init, so mark this
494738de93abSTom Zanussi  * __init too.
494838de93abSTom Zanussi  */
494938de93abSTom Zanussi __init int register_ftrace_command(struct ftrace_func_command *cmd)
4950f6180773SSteven Rostedt {
4951f6180773SSteven Rostedt 	struct ftrace_func_command *p;
4952f6180773SSteven Rostedt 	int ret = 0;
4953f6180773SSteven Rostedt 
4954f6180773SSteven Rostedt 	mutex_lock(&ftrace_cmd_mutex);
4955f6180773SSteven Rostedt 	list_for_each_entry(p, &ftrace_commands, list) {
4956f6180773SSteven Rostedt 		if (strcmp(cmd->name, p->name) == 0) {
4957f6180773SSteven Rostedt 			ret = -EBUSY;
4958f6180773SSteven Rostedt 			goto out_unlock;
4959f6180773SSteven Rostedt 		}
4960f6180773SSteven Rostedt 	}
4961f6180773SSteven Rostedt 	list_add(&cmd->list, &ftrace_commands);
4962f6180773SSteven Rostedt  out_unlock:
4963f6180773SSteven Rostedt 	mutex_unlock(&ftrace_cmd_mutex);
4964f6180773SSteven Rostedt 
4965f6180773SSteven Rostedt 	return ret;
4966f6180773SSteven Rostedt }
4967f6180773SSteven Rostedt 
496838de93abSTom Zanussi /*
496938de93abSTom Zanussi  * Currently we only unregister ftrace commands from __init, so mark
497038de93abSTom Zanussi  * this __init too.
497138de93abSTom Zanussi  */
497238de93abSTom Zanussi __init int unregister_ftrace_command(struct ftrace_func_command *cmd)
4973f6180773SSteven Rostedt {
4974f6180773SSteven Rostedt 	struct ftrace_func_command *p, *n;
4975f6180773SSteven Rostedt 	int ret = -ENODEV;
4976f6180773SSteven Rostedt 
4977f6180773SSteven Rostedt 	mutex_lock(&ftrace_cmd_mutex);
4978f6180773SSteven Rostedt 	list_for_each_entry_safe(p, n, &ftrace_commands, list) {
4979f6180773SSteven Rostedt 		if (strcmp(cmd->name, p->name) == 0) {
4980f6180773SSteven Rostedt 			ret = 0;
4981f6180773SSteven Rostedt 			list_del_init(&p->list);
4982f6180773SSteven Rostedt 			goto out_unlock;
4983f6180773SSteven Rostedt 		}
4984f6180773SSteven Rostedt 	}
4985f6180773SSteven Rostedt  out_unlock:
4986f6180773SSteven Rostedt 	mutex_unlock(&ftrace_cmd_mutex);
4987f6180773SSteven Rostedt 
4988f6180773SSteven Rostedt 	return ret;
4989f6180773SSteven Rostedt }
4990f6180773SSteven Rostedt 
499104ec7bb6SSteven Rostedt (VMware) static int ftrace_process_regex(struct ftrace_iterator *iter,
499233dc9b12SSteven Rostedt 				char *buff, int len, int enable)
499364e7c440SSteven Rostedt {
499404ec7bb6SSteven Rostedt (VMware) 	struct ftrace_hash *hash = iter->hash;
4995d2afd57aSSteven Rostedt (VMware) 	struct trace_array *tr = iter->ops->private;
4996f6180773SSteven Rostedt 	char *func, *command, *next = buff;
49976a24a244SSteven Rostedt 	struct ftrace_func_command *p;
49980aff1c0cSGuoWen Li 	int ret = -EINVAL;
499964e7c440SSteven Rostedt 
500064e7c440SSteven Rostedt 	func = strsep(&next, ":");
500164e7c440SSteven Rostedt 
500264e7c440SSteven Rostedt 	if (!next) {
50031cf41dd7SSteven Rostedt 		ret = ftrace_match_records(hash, func, len);
5004b448c4e3SSteven Rostedt 		if (!ret)
5005b448c4e3SSteven Rostedt 			ret = -EINVAL;
5006b448c4e3SSteven Rostedt 		if (ret < 0)
5007311d16daSLi Zefan 			return ret;
5008b448c4e3SSteven Rostedt 		return 0;
500964e7c440SSteven Rostedt 	}
501064e7c440SSteven Rostedt 
5011f6180773SSteven Rostedt 	/* command found */
501264e7c440SSteven Rostedt 
501364e7c440SSteven Rostedt 	command = strsep(&next, ":");
501464e7c440SSteven Rostedt 
5015f6180773SSteven Rostedt 	mutex_lock(&ftrace_cmd_mutex);
5016f6180773SSteven Rostedt 	list_for_each_entry(p, &ftrace_commands, list) {
5017f6180773SSteven Rostedt 		if (strcmp(p->name, command) == 0) {
501804ec7bb6SSteven Rostedt (VMware) 			ret = p->func(tr, hash, func, command, next, enable);
5019f6180773SSteven Rostedt 			goto out_unlock;
502064e7c440SSteven Rostedt 		}
5021f6180773SSteven Rostedt 	}
5022f6180773SSteven Rostedt  out_unlock:
5023f6180773SSteven Rostedt 	mutex_unlock(&ftrace_cmd_mutex);
502464e7c440SSteven Rostedt 
5025f6180773SSteven Rostedt 	return ret;
502664e7c440SSteven Rostedt }
502764e7c440SSteven Rostedt 
5028e309b41dSIngo Molnar static ssize_t
502941c52c0dSSteven Rostedt ftrace_regex_write(struct file *file, const char __user *ubuf,
503041c52c0dSSteven Rostedt 		   size_t cnt, loff_t *ppos, int enable)
50315072c59fSSteven Rostedt {
50325072c59fSSteven Rostedt 	struct ftrace_iterator *iter;
5033689fd8b6S[email protected] 	struct trace_parser *parser;
5034689fd8b6S[email protected] 	ssize_t ret, read;
50355072c59fSSteven Rostedt 
50364ba7978eSLi Zefan 	if (!cnt)
50375072c59fSSteven Rostedt 		return 0;
50385072c59fSSteven Rostedt 
50395072c59fSSteven Rostedt 	if (file->f_mode & FMODE_READ) {
50405072c59fSSteven Rostedt 		struct seq_file *m = file->private_data;
50415072c59fSSteven Rostedt 		iter = m->private;
50425072c59fSSteven Rostedt 	} else
50435072c59fSSteven Rostedt 		iter = file->private_data;
50445072c59fSSteven Rostedt 
5045f04f24fbSMasami Hiramatsu 	if (unlikely(ftrace_disabled))
50463f2367baSMasami Hiramatsu 		return -ENODEV;
50473f2367baSMasami Hiramatsu 
50483f2367baSMasami Hiramatsu 	/* iter->hash is a local copy, so we don't need regex_lock */
5049f04f24fbSMasami Hiramatsu 
5050689fd8b6S[email protected] 	parser = &iter->parser;
5051689fd8b6S[email protected] 	read = trace_get_user(parser, ubuf, cnt, ppos);
50525072c59fSSteven Rostedt 
50534ba7978eSLi Zefan 	if (read >= 0 && trace_parser_loaded(parser) &&
5054689fd8b6S[email protected] 	    !trace_parser_cont(parser)) {
505504ec7bb6SSteven Rostedt (VMware) 		ret = ftrace_process_regex(iter, parser->buffer,
5056689fd8b6S[email protected] 					   parser->idx, enable);
5057313254a9SLi Zefan 		trace_parser_clear(parser);
50587c088b51SSteven Rostedt (Red Hat) 		if (ret < 0)
50593f2367baSMasami Hiramatsu 			goto out;
50605072c59fSSteven Rostedt 	}
50615072c59fSSteven Rostedt 
50625072c59fSSteven Rostedt 	ret = read;
50633f2367baSMasami Hiramatsu  out:
50645072c59fSSteven Rostedt 	return ret;
50655072c59fSSteven Rostedt }
50665072c59fSSteven Rostedt 
5067fc13cb0cSSteven Rostedt ssize_t
506841c52c0dSSteven Rostedt ftrace_filter_write(struct file *file, const char __user *ubuf,
506941c52c0dSSteven Rostedt 		    size_t cnt, loff_t *ppos)
507041c52c0dSSteven Rostedt {
507141c52c0dSSteven Rostedt 	return ftrace_regex_write(file, ubuf, cnt, ppos, 1);
507241c52c0dSSteven Rostedt }
507341c52c0dSSteven Rostedt 
5074fc13cb0cSSteven Rostedt ssize_t
507541c52c0dSSteven Rostedt ftrace_notrace_write(struct file *file, const char __user *ubuf,
507641c52c0dSSteven Rostedt 		     size_t cnt, loff_t *ppos)
507741c52c0dSSteven Rostedt {
507841c52c0dSSteven Rostedt 	return ftrace_regex_write(file, ubuf, cnt, ppos, 0);
507941c52c0dSSteven Rostedt }
508041c52c0dSSteven Rostedt 
508133dc9b12SSteven Rostedt static int
50824f554e95SJiri Olsa __ftrace_match_addr(struct ftrace_hash *hash, unsigned long ip, int remove)
5083647664eaSMasami Hiramatsu {
5084647664eaSMasami Hiramatsu 	struct ftrace_func_entry *entry;
5085647664eaSMasami Hiramatsu 
5086aebfd125SPeter Zijlstra 	ip = ftrace_location(ip);
5087aebfd125SPeter Zijlstra 	if (!ip)
5088647664eaSMasami Hiramatsu 		return -EINVAL;
5089647664eaSMasami Hiramatsu 
5090647664eaSMasami Hiramatsu 	if (remove) {
5091647664eaSMasami Hiramatsu 		entry = ftrace_lookup_ip(hash, ip);
5092647664eaSMasami Hiramatsu 		if (!entry)
5093647664eaSMasami Hiramatsu 			return -ENOENT;
5094647664eaSMasami Hiramatsu 		free_hash_entry(hash, entry);
5095647664eaSMasami Hiramatsu 		return 0;
5096647664eaSMasami Hiramatsu 	}
5097647664eaSMasami Hiramatsu 
5098647664eaSMasami Hiramatsu 	return add_hash_entry(hash, ip);
5099647664eaSMasami Hiramatsu }
5100647664eaSMasami Hiramatsu 
5101647664eaSMasami Hiramatsu static int
51024f554e95SJiri Olsa ftrace_match_addr(struct ftrace_hash *hash, unsigned long *ips,
51034f554e95SJiri Olsa 		  unsigned int cnt, int remove)
51044f554e95SJiri Olsa {
51054f554e95SJiri Olsa 	unsigned int i;
51064f554e95SJiri Olsa 	int err;
51074f554e95SJiri Olsa 
51084f554e95SJiri Olsa 	for (i = 0; i < cnt; i++) {
51094f554e95SJiri Olsa 		err = __ftrace_match_addr(hash, ips[i], remove);
51104f554e95SJiri Olsa 		if (err) {
51114f554e95SJiri Olsa 			/*
51124f554e95SJiri Olsa 			 * This expects the @hash is a temporary hash and if this
51134f554e95SJiri Olsa 			 * fails the caller must free the @hash.
51144f554e95SJiri Olsa 			 */
51154f554e95SJiri Olsa 			return err;
51164f554e95SJiri Olsa 		}
51174f554e95SJiri Olsa 	}
51184f554e95SJiri Olsa 	return 0;
51194f554e95SJiri Olsa }
51204f554e95SJiri Olsa 
51214f554e95SJiri Olsa static int
5122647664eaSMasami Hiramatsu ftrace_set_hash(struct ftrace_ops *ops, unsigned char *buf, int len,
51234f554e95SJiri Olsa 		unsigned long *ips, unsigned int cnt,
51244f554e95SJiri Olsa 		int remove, int reset, int enable)
512541c52c0dSSteven Rostedt {
512633dc9b12SSteven Rostedt 	struct ftrace_hash **orig_hash;
5127f45948e8SSteven Rostedt 	struct ftrace_hash *hash;
512833dc9b12SSteven Rostedt 	int ret;
5129f45948e8SSteven Rostedt 
513041c52c0dSSteven Rostedt 	if (unlikely(ftrace_disabled))
513133dc9b12SSteven Rostedt 		return -ENODEV;
513241c52c0dSSteven Rostedt 
513333b7f99cSSteven Rostedt (Red Hat) 	mutex_lock(&ops->func_hash->regex_lock);
51343f2367baSMasami Hiramatsu 
5135f45948e8SSteven Rostedt 	if (enable)
513633b7f99cSSteven Rostedt (Red Hat) 		orig_hash = &ops->func_hash->filter_hash;
5137f45948e8SSteven Rostedt 	else
513833b7f99cSSteven Rostedt (Red Hat) 		orig_hash = &ops->func_hash->notrace_hash;
513933dc9b12SSteven Rostedt 
5140b972cc58SWang Nan 	if (reset)
5141b972cc58SWang Nan 		hash = alloc_ftrace_hash(FTRACE_HASH_DEFAULT_BITS);
5142b972cc58SWang Nan 	else
514333dc9b12SSteven Rostedt 		hash = alloc_and_copy_ftrace_hash(FTRACE_HASH_DEFAULT_BITS, *orig_hash);
5144b972cc58SWang Nan 
51453f2367baSMasami Hiramatsu 	if (!hash) {
51463f2367baSMasami Hiramatsu 		ret = -ENOMEM;
51473f2367baSMasami Hiramatsu 		goto out_regex_unlock;
51483f2367baSMasami Hiramatsu 	}
5149f45948e8SSteven Rostedt 
5150ac483c44SJiri Olsa 	if (buf && !ftrace_match_records(hash, buf, len)) {
5151ac483c44SJiri Olsa 		ret = -EINVAL;
5152ac483c44SJiri Olsa 		goto out_regex_unlock;
5153ac483c44SJiri Olsa 	}
51544f554e95SJiri Olsa 	if (ips) {
51554f554e95SJiri Olsa 		ret = ftrace_match_addr(hash, ips, cnt, remove);
5156647664eaSMasami Hiramatsu 		if (ret < 0)
5157647664eaSMasami Hiramatsu 			goto out_regex_unlock;
5158647664eaSMasami Hiramatsu 	}
515933dc9b12SSteven Rostedt 
516033dc9b12SSteven Rostedt 	mutex_lock(&ftrace_lock);
5161e16b35ddSSteven Rostedt (VMware) 	ret = ftrace_hash_move_and_update_ops(ops, orig_hash, hash, enable);
516233dc9b12SSteven Rostedt 	mutex_unlock(&ftrace_lock);
516333dc9b12SSteven Rostedt 
5164ac483c44SJiri Olsa  out_regex_unlock:
516533b7f99cSSteven Rostedt (Red Hat) 	mutex_unlock(&ops->func_hash->regex_lock);
516633dc9b12SSteven Rostedt 
516733dc9b12SSteven Rostedt 	free_ftrace_hash(hash);
516833dc9b12SSteven Rostedt 	return ret;
516941c52c0dSSteven Rostedt }
517041c52c0dSSteven Rostedt 
5171647664eaSMasami Hiramatsu static int
51724f554e95SJiri Olsa ftrace_set_addr(struct ftrace_ops *ops, unsigned long *ips, unsigned int cnt,
51734f554e95SJiri Olsa 		int remove, int reset, int enable)
5174647664eaSMasami Hiramatsu {
51754f554e95SJiri Olsa 	return ftrace_set_hash(ops, NULL, 0, ips, cnt, remove, reset, enable);
5176647664eaSMasami Hiramatsu }
5177647664eaSMasami Hiramatsu 
5178763e34e7SSteven Rostedt (VMware) #ifdef CONFIG_DYNAMIC_FTRACE_WITH_DIRECT_CALLS
5179013bf0daSSteven Rostedt (VMware) 
5180013bf0daSSteven Rostedt (VMware) struct ftrace_direct_func {
5181013bf0daSSteven Rostedt (VMware) 	struct list_head	next;
5182013bf0daSSteven Rostedt (VMware) 	unsigned long		addr;
5183013bf0daSSteven Rostedt (VMware) 	int			count;
5184013bf0daSSteven Rostedt (VMware) };
5185013bf0daSSteven Rostedt (VMware) 
5186013bf0daSSteven Rostedt (VMware) static LIST_HEAD(ftrace_direct_funcs);
5187013bf0daSSteven Rostedt (VMware) 
5188013bf0daSSteven Rostedt (VMware) /**
5189013bf0daSSteven Rostedt (VMware)  * ftrace_find_direct_func - test an address if it is a registered direct caller
5190013bf0daSSteven Rostedt (VMware)  * @addr: The address of a registered direct caller
5191013bf0daSSteven Rostedt (VMware)  *
5192013bf0daSSteven Rostedt (VMware)  * This searches to see if a ftrace direct caller has been registered
5193013bf0daSSteven Rostedt (VMware)  * at a specific address, and if so, it returns a descriptor for it.
5194013bf0daSSteven Rostedt (VMware)  *
5195013bf0daSSteven Rostedt (VMware)  * This can be used by architecture code to see if an address is
5196013bf0daSSteven Rostedt (VMware)  * a direct caller (trampoline) attached to a fentry/mcount location.
5197013bf0daSSteven Rostedt (VMware)  * This is useful for the function_graph tracer, as it may need to
5198013bf0daSSteven Rostedt (VMware)  * do adjustments if it traced a location that also has a direct
5199013bf0daSSteven Rostedt (VMware)  * trampoline attached to it.
5200013bf0daSSteven Rostedt (VMware)  */
5201013bf0daSSteven Rostedt (VMware) struct ftrace_direct_func *ftrace_find_direct_func(unsigned long addr)
5202013bf0daSSteven Rostedt (VMware) {
5203013bf0daSSteven Rostedt (VMware) 	struct ftrace_direct_func *entry;
5204013bf0daSSteven Rostedt (VMware) 	bool found = false;
5205013bf0daSSteven Rostedt (VMware) 
5206013bf0daSSteven Rostedt (VMware) 	/* May be called by fgraph trampoline (protected by rcu tasks) */
5207013bf0daSSteven Rostedt (VMware) 	list_for_each_entry_rcu(entry, &ftrace_direct_funcs, next) {
5208013bf0daSSteven Rostedt (VMware) 		if (entry->addr == addr) {
5209013bf0daSSteven Rostedt (VMware) 			found = true;
5210013bf0daSSteven Rostedt (VMware) 			break;
5211013bf0daSSteven Rostedt (VMware) 		}
5212013bf0daSSteven Rostedt (VMware) 	}
5213013bf0daSSteven Rostedt (VMware) 	if (found)
5214013bf0daSSteven Rostedt (VMware) 		return entry;
5215013bf0daSSteven Rostedt (VMware) 
5216013bf0daSSteven Rostedt (VMware) 	return NULL;
5217013bf0daSSteven Rostedt (VMware) }
5218013bf0daSSteven Rostedt (VMware) 
52198a141dd7SAlexei Starovoitov static struct ftrace_direct_func *ftrace_alloc_direct_func(unsigned long addr)
52208a141dd7SAlexei Starovoitov {
52218a141dd7SAlexei Starovoitov 	struct ftrace_direct_func *direct;
52228a141dd7SAlexei Starovoitov 
52238a141dd7SAlexei Starovoitov 	direct = kmalloc(sizeof(*direct), GFP_KERNEL);
52248a141dd7SAlexei Starovoitov 	if (!direct)
52258a141dd7SAlexei Starovoitov 		return NULL;
52268a141dd7SAlexei Starovoitov 	direct->addr = addr;
52278a141dd7SAlexei Starovoitov 	direct->count = 0;
52288a141dd7SAlexei Starovoitov 	list_add_rcu(&direct->next, &ftrace_direct_funcs);
52298a141dd7SAlexei Starovoitov 	ftrace_direct_func_count++;
52308a141dd7SAlexei Starovoitov 	return direct;
52318a141dd7SAlexei Starovoitov }
52328a141dd7SAlexei Starovoitov 
523353cd885bSSong Liu static int register_ftrace_function_nolock(struct ftrace_ops *ops);
523453cd885bSSong Liu 
5235763e34e7SSteven Rostedt (VMware) /**
5236763e34e7SSteven Rostedt (VMware)  * register_ftrace_direct - Call a custom trampoline directly
5237763e34e7SSteven Rostedt (VMware)  * @ip: The address of the nop at the beginning of a function
5238763e34e7SSteven Rostedt (VMware)  * @addr: The address of the trampoline to call at @ip
5239763e34e7SSteven Rostedt (VMware)  *
5240763e34e7SSteven Rostedt (VMware)  * This is used to connect a direct call from the nop location (@ip)
5241763e34e7SSteven Rostedt (VMware)  * at the start of ftrace traced functions. The location that it calls
5242763e34e7SSteven Rostedt (VMware)  * (@addr) must be able to handle a direct call, and save the parameters
5243763e34e7SSteven Rostedt (VMware)  * of the function being traced, and restore them (or inject new ones
5244763e34e7SSteven Rostedt (VMware)  * if needed), before returning.
5245763e34e7SSteven Rostedt (VMware)  *
5246763e34e7SSteven Rostedt (VMware)  * Returns:
5247763e34e7SSteven Rostedt (VMware)  *  0 on success
5248763e34e7SSteven Rostedt (VMware)  *  -EBUSY - Another direct function is already attached (there can be only one)
5249763e34e7SSteven Rostedt (VMware)  *  -ENODEV - @ip does not point to a ftrace nop location (or not supported)
5250763e34e7SSteven Rostedt (VMware)  *  -ENOMEM - There was an allocation failure.
5251763e34e7SSteven Rostedt (VMware)  */
5252763e34e7SSteven Rostedt (VMware) int register_ftrace_direct(unsigned long ip, unsigned long addr)
5253763e34e7SSteven Rostedt (VMware) {
5254013bf0daSSteven Rostedt (VMware) 	struct ftrace_direct_func *direct;
5255763e34e7SSteven Rostedt (VMware) 	struct ftrace_func_entry *entry;
5256763e34e7SSteven Rostedt (VMware) 	struct ftrace_hash *free_hash = NULL;
5257763e34e7SSteven Rostedt (VMware) 	struct dyn_ftrace *rec;
5258aebfd125SPeter Zijlstra 	int ret = -ENODEV;
5259763e34e7SSteven Rostedt (VMware) 
5260763e34e7SSteven Rostedt (VMware) 	mutex_lock(&direct_mutex);
5261763e34e7SSteven Rostedt (VMware) 
5262aebfd125SPeter Zijlstra 	ip = ftrace_location(ip);
5263aebfd125SPeter Zijlstra 	if (!ip)
5264aebfd125SPeter Zijlstra 		goto out_unlock;
5265aebfd125SPeter Zijlstra 
5266763e34e7SSteven Rostedt (VMware) 	/* See if there's a direct function at @ip already */
5267aebfd125SPeter Zijlstra 	ret = -EBUSY;
5268ff205766SAlexei Starovoitov 	if (ftrace_find_rec_direct(ip))
5269763e34e7SSteven Rostedt (VMware) 		goto out_unlock;
5270763e34e7SSteven Rostedt (VMware) 
5271763e34e7SSteven Rostedt (VMware) 	ret = -ENODEV;
5272763e34e7SSteven Rostedt (VMware) 	rec = lookup_rec(ip, ip);
5273763e34e7SSteven Rostedt (VMware) 	if (!rec)
5274763e34e7SSteven Rostedt (VMware) 		goto out_unlock;
5275763e34e7SSteven Rostedt (VMware) 
5276763e34e7SSteven Rostedt (VMware) 	/*
5277763e34e7SSteven Rostedt (VMware) 	 * Check if the rec says it has a direct call but we didn't
5278763e34e7SSteven Rostedt (VMware) 	 * find one earlier?
5279763e34e7SSteven Rostedt (VMware) 	 */
5280763e34e7SSteven Rostedt (VMware) 	if (WARN_ON(rec->flags & FTRACE_FL_DIRECT))
5281763e34e7SSteven Rostedt (VMware) 		goto out_unlock;
5282763e34e7SSteven Rostedt (VMware) 
5283763e34e7SSteven Rostedt (VMware) 	/* Make sure the ip points to the exact record */
5284406acdd3SSteven Rostedt (VMware) 	if (ip != rec->ip) {
5285763e34e7SSteven Rostedt (VMware) 		ip = rec->ip;
5286406acdd3SSteven Rostedt (VMware) 		/* Need to check this ip for a direct. */
5287ff205766SAlexei Starovoitov 		if (ftrace_find_rec_direct(ip))
5288406acdd3SSteven Rostedt (VMware) 			goto out_unlock;
5289406acdd3SSteven Rostedt (VMware) 	}
5290763e34e7SSteven Rostedt (VMware) 
5291763e34e7SSteven Rostedt (VMware) 	ret = -ENOMEM;
5292013bf0daSSteven Rostedt (VMware) 	direct = ftrace_find_direct_func(addr);
5293013bf0daSSteven Rostedt (VMware) 	if (!direct) {
52948a141dd7SAlexei Starovoitov 		direct = ftrace_alloc_direct_func(addr);
52951904a814SJiri Olsa 		if (!direct)
5296013bf0daSSteven Rostedt (VMware) 			goto out_unlock;
5297013bf0daSSteven Rostedt (VMware) 	}
5298013bf0daSSteven Rostedt (VMware) 
52991904a814SJiri Olsa 	entry = ftrace_add_rec_direct(ip, addr, &free_hash);
53001904a814SJiri Olsa 	if (!entry)
53011904a814SJiri Olsa 		goto out_unlock;
5302763e34e7SSteven Rostedt (VMware) 
5303763e34e7SSteven Rostedt (VMware) 	ret = ftrace_set_filter_ip(&direct_ops, ip, 0, 0);
5304763e34e7SSteven Rostedt (VMware) 
5305763e34e7SSteven Rostedt (VMware) 	if (!ret && !(direct_ops.flags & FTRACE_OPS_FL_ENABLED)) {
530653cd885bSSong Liu 		ret = register_ftrace_function_nolock(&direct_ops);
5307763e34e7SSteven Rostedt (VMware) 		if (ret)
5308763e34e7SSteven Rostedt (VMware) 			ftrace_set_filter_ip(&direct_ops, ip, 1, 0);
5309763e34e7SSteven Rostedt (VMware) 	}
5310763e34e7SSteven Rostedt (VMware) 
5311013bf0daSSteven Rostedt (VMware) 	if (ret) {
53127d54c15cSSong Liu 		remove_hash_entry(direct_functions, entry);
5313763e34e7SSteven Rostedt (VMware) 		kfree(entry);
5314013bf0daSSteven Rostedt (VMware) 		if (!direct->count) {
5315013bf0daSSteven Rostedt (VMware) 			list_del_rcu(&direct->next);
5316013bf0daSSteven Rostedt (VMware) 			synchronize_rcu_tasks();
5317013bf0daSSteven Rostedt (VMware) 			kfree(direct);
5318013bf0daSSteven Rostedt (VMware) 			if (free_hash)
5319013bf0daSSteven Rostedt (VMware) 				free_ftrace_hash(free_hash);
5320013bf0daSSteven Rostedt (VMware) 			free_hash = NULL;
5321a3ad1a7eSSteven Rostedt (VMware) 			ftrace_direct_func_count--;
5322013bf0daSSteven Rostedt (VMware) 		}
5323013bf0daSSteven Rostedt (VMware) 	} else {
5324013bf0daSSteven Rostedt (VMware) 		direct->count++;
5325013bf0daSSteven Rostedt (VMware) 	}
5326763e34e7SSteven Rostedt (VMware)  out_unlock:
5327763e34e7SSteven Rostedt (VMware) 	mutex_unlock(&direct_mutex);
5328763e34e7SSteven Rostedt (VMware) 
5329763e34e7SSteven Rostedt (VMware) 	if (free_hash) {
5330763e34e7SSteven Rostedt (VMware) 		synchronize_rcu_tasks();
5331763e34e7SSteven Rostedt (VMware) 		free_ftrace_hash(free_hash);
5332763e34e7SSteven Rostedt (VMware) 	}
5333763e34e7SSteven Rostedt (VMware) 
5334763e34e7SSteven Rostedt (VMware) 	return ret;
5335763e34e7SSteven Rostedt (VMware) }
5336763e34e7SSteven Rostedt (VMware) EXPORT_SYMBOL_GPL(register_ftrace_direct);
5337763e34e7SSteven Rostedt (VMware) 
5338ea806eb3SSteven Rostedt (VMware) static struct ftrace_func_entry *find_direct_entry(unsigned long *ip,
5339ea806eb3SSteven Rostedt (VMware) 						   struct dyn_ftrace **recp)
5340763e34e7SSteven Rostedt (VMware) {
5341763e34e7SSteven Rostedt (VMware) 	struct ftrace_func_entry *entry;
5342763e34e7SSteven Rostedt (VMware) 	struct dyn_ftrace *rec;
5343763e34e7SSteven Rostedt (VMware) 
5344128161f4SSteven Rostedt (VMware) 	rec = lookup_rec(*ip, *ip);
5345128161f4SSteven Rostedt (VMware) 	if (!rec)
5346128161f4SSteven Rostedt (VMware) 		return NULL;
5347763e34e7SSteven Rostedt (VMware) 
5348763e34e7SSteven Rostedt (VMware) 	entry = __ftrace_lookup_ip(direct_functions, rec->ip);
5349763e34e7SSteven Rostedt (VMware) 	if (!entry) {
5350763e34e7SSteven Rostedt (VMware) 		WARN_ON(rec->flags & FTRACE_FL_DIRECT);
5351128161f4SSteven Rostedt (VMware) 		return NULL;
5352763e34e7SSteven Rostedt (VMware) 	}
5353763e34e7SSteven Rostedt (VMware) 
5354763e34e7SSteven Rostedt (VMware) 	WARN_ON(!(rec->flags & FTRACE_FL_DIRECT));
5355128161f4SSteven Rostedt (VMware) 
5356128161f4SSteven Rostedt (VMware) 	/* Passed in ip just needs to be on the call site */
5357128161f4SSteven Rostedt (VMware) 	*ip = rec->ip;
5358128161f4SSteven Rostedt (VMware) 
5359ea806eb3SSteven Rostedt (VMware) 	if (recp)
5360ea806eb3SSteven Rostedt (VMware) 		*recp = rec;
5361ea806eb3SSteven Rostedt (VMware) 
5362128161f4SSteven Rostedt (VMware) 	return entry;
5363763e34e7SSteven Rostedt (VMware) }
5364763e34e7SSteven Rostedt (VMware) 
5365128161f4SSteven Rostedt (VMware) int unregister_ftrace_direct(unsigned long ip, unsigned long addr)
5366128161f4SSteven Rostedt (VMware) {
5367128161f4SSteven Rostedt (VMware) 	struct ftrace_direct_func *direct;
5368128161f4SSteven Rostedt (VMware) 	struct ftrace_func_entry *entry;
53697d5b7cadSJiri Olsa 	struct ftrace_hash *hash;
5370128161f4SSteven Rostedt (VMware) 	int ret = -ENODEV;
5371128161f4SSteven Rostedt (VMware) 
5372128161f4SSteven Rostedt (VMware) 	mutex_lock(&direct_mutex);
5373128161f4SSteven Rostedt (VMware) 
5374aebfd125SPeter Zijlstra 	ip = ftrace_location(ip);
5375aebfd125SPeter Zijlstra 	if (!ip)
5376aebfd125SPeter Zijlstra 		goto out_unlock;
5377aebfd125SPeter Zijlstra 
5378ea806eb3SSteven Rostedt (VMware) 	entry = find_direct_entry(&ip, NULL);
5379128161f4SSteven Rostedt (VMware) 	if (!entry)
5380128161f4SSteven Rostedt (VMware) 		goto out_unlock;
5381128161f4SSteven Rostedt (VMware) 
53827d5b7cadSJiri Olsa 	hash = direct_ops.func_hash->filter_hash;
53837d5b7cadSJiri Olsa 	if (hash->count == 1)
5384763e34e7SSteven Rostedt (VMware) 		unregister_ftrace_function(&direct_ops);
5385763e34e7SSteven Rostedt (VMware) 
5386763e34e7SSteven Rostedt (VMware) 	ret = ftrace_set_filter_ip(&direct_ops, ip, 1, 0);
5387763e34e7SSteven Rostedt (VMware) 
5388763e34e7SSteven Rostedt (VMware) 	WARN_ON(ret);
5389763e34e7SSteven Rostedt (VMware) 
5390763e34e7SSteven Rostedt (VMware) 	remove_hash_entry(direct_functions, entry);
5391763e34e7SSteven Rostedt (VMware) 
5392013bf0daSSteven Rostedt (VMware) 	direct = ftrace_find_direct_func(addr);
5393013bf0daSSteven Rostedt (VMware) 	if (!WARN_ON(!direct)) {
5394013bf0daSSteven Rostedt (VMware) 		/* This is the good path (see the ! before WARN) */
5395013bf0daSSteven Rostedt (VMware) 		direct->count--;
5396013bf0daSSteven Rostedt (VMware) 		WARN_ON(direct->count < 0);
5397013bf0daSSteven Rostedt (VMware) 		if (!direct->count) {
5398013bf0daSSteven Rostedt (VMware) 			list_del_rcu(&direct->next);
5399013bf0daSSteven Rostedt (VMware) 			synchronize_rcu_tasks();
5400013bf0daSSteven Rostedt (VMware) 			kfree(direct);
5401353da879SSteven Rostedt (VMware) 			kfree(entry);
5402a3ad1a7eSSteven Rostedt (VMware) 			ftrace_direct_func_count--;
5403013bf0daSSteven Rostedt (VMware) 		}
5404013bf0daSSteven Rostedt (VMware) 	}
5405763e34e7SSteven Rostedt (VMware)  out_unlock:
5406763e34e7SSteven Rostedt (VMware) 	mutex_unlock(&direct_mutex);
5407763e34e7SSteven Rostedt (VMware) 
5408763e34e7SSteven Rostedt (VMware) 	return ret;
5409763e34e7SSteven Rostedt (VMware) }
5410763e34e7SSteven Rostedt (VMware) EXPORT_SYMBOL_GPL(unregister_ftrace_direct);
54110567d680SSteven Rostedt (VMware) 
54120567d680SSteven Rostedt (VMware) static struct ftrace_ops stub_ops = {
54130567d680SSteven Rostedt (VMware) 	.func		= ftrace_stub,
54140567d680SSteven Rostedt (VMware) };
54150567d680SSteven Rostedt (VMware) 
54160567d680SSteven Rostedt (VMware) /**
5417ea806eb3SSteven Rostedt (VMware)  * ftrace_modify_direct_caller - modify ftrace nop directly
5418ea806eb3SSteven Rostedt (VMware)  * @entry: The ftrace hash entry of the direct helper for @rec
5419ea806eb3SSteven Rostedt (VMware)  * @rec: The record representing the function site to patch
5420ea806eb3SSteven Rostedt (VMware)  * @old_addr: The location that the site at @rec->ip currently calls
5421ea806eb3SSteven Rostedt (VMware)  * @new_addr: The location that the site at @rec->ip should call
5422ea806eb3SSteven Rostedt (VMware)  *
5423ea806eb3SSteven Rostedt (VMware)  * An architecture may overwrite this function to optimize the
5424ea806eb3SSteven Rostedt (VMware)  * changing of the direct callback on an ftrace nop location.
5425ea806eb3SSteven Rostedt (VMware)  * This is called with the ftrace_lock mutex held, and no other
5426ea806eb3SSteven Rostedt (VMware)  * ftrace callbacks are on the associated record (@rec). Thus,
5427ea806eb3SSteven Rostedt (VMware)  * it is safe to modify the ftrace record, where it should be
5428ea806eb3SSteven Rostedt (VMware)  * currently calling @old_addr directly, to call @new_addr.
5429ea806eb3SSteven Rostedt (VMware)  *
5430ea806eb3SSteven Rostedt (VMware)  * Safety checks should be made to make sure that the code at
5431ea806eb3SSteven Rostedt (VMware)  * @rec->ip is currently calling @old_addr. And this must
5432ea806eb3SSteven Rostedt (VMware)  * also update entry->direct to @new_addr.
5433ea806eb3SSteven Rostedt (VMware)  */
5434ea806eb3SSteven Rostedt (VMware) int __weak ftrace_modify_direct_caller(struct ftrace_func_entry *entry,
5435ea806eb3SSteven Rostedt (VMware) 				       struct dyn_ftrace *rec,
5436ea806eb3SSteven Rostedt (VMware) 				       unsigned long old_addr,
5437ea806eb3SSteven Rostedt (VMware) 				       unsigned long new_addr)
5438ea806eb3SSteven Rostedt (VMware) {
5439ea806eb3SSteven Rostedt (VMware) 	unsigned long ip = rec->ip;
5440ea806eb3SSteven Rostedt (VMware) 	int ret;
5441ea806eb3SSteven Rostedt (VMware) 
5442ea806eb3SSteven Rostedt (VMware) 	/*
5443ea806eb3SSteven Rostedt (VMware) 	 * The ftrace_lock was used to determine if the record
5444ea806eb3SSteven Rostedt (VMware) 	 * had more than one registered user to it. If it did,
5445ea806eb3SSteven Rostedt (VMware) 	 * we needed to prevent that from changing to do the quick
5446ea806eb3SSteven Rostedt (VMware) 	 * switch. But if it did not (only a direct caller was attached)
5447ea806eb3SSteven Rostedt (VMware) 	 * then this function is called. But this function can deal
5448ea806eb3SSteven Rostedt (VMware) 	 * with attached callers to the rec that we care about, and
5449ea806eb3SSteven Rostedt (VMware) 	 * since this function uses standard ftrace calls that take
5450ea806eb3SSteven Rostedt (VMware) 	 * the ftrace_lock mutex, we need to release it.
5451ea806eb3SSteven Rostedt (VMware) 	 */
5452ea806eb3SSteven Rostedt (VMware) 	mutex_unlock(&ftrace_lock);
5453ea806eb3SSteven Rostedt (VMware) 
5454ea806eb3SSteven Rostedt (VMware) 	/*
5455ea806eb3SSteven Rostedt (VMware) 	 * By setting a stub function at the same address, we force
5456ea806eb3SSteven Rostedt (VMware) 	 * the code to call the iterator and the direct_ops helper.
5457ea806eb3SSteven Rostedt (VMware) 	 * This means that @ip does not call the direct call, and
5458ea806eb3SSteven Rostedt (VMware) 	 * we can simply modify it.
5459ea806eb3SSteven Rostedt (VMware) 	 */
5460ea806eb3SSteven Rostedt (VMware) 	ret = ftrace_set_filter_ip(&stub_ops, ip, 0, 0);
5461ea806eb3SSteven Rostedt (VMware) 	if (ret)
5462ea806eb3SSteven Rostedt (VMware) 		goto out_lock;
5463ea806eb3SSteven Rostedt (VMware) 
5464ea806eb3SSteven Rostedt (VMware) 	ret = register_ftrace_function(&stub_ops);
5465ea806eb3SSteven Rostedt (VMware) 	if (ret) {
5466ea806eb3SSteven Rostedt (VMware) 		ftrace_set_filter_ip(&stub_ops, ip, 1, 0);
5467ea806eb3SSteven Rostedt (VMware) 		goto out_lock;
5468ea806eb3SSteven Rostedt (VMware) 	}
5469ea806eb3SSteven Rostedt (VMware) 
5470ea806eb3SSteven Rostedt (VMware) 	entry->direct = new_addr;
5471ea806eb3SSteven Rostedt (VMware) 
5472ea806eb3SSteven Rostedt (VMware) 	/*
5473ea806eb3SSteven Rostedt (VMware) 	 * By removing the stub, we put back the direct call, calling
5474ea806eb3SSteven Rostedt (VMware) 	 * the @new_addr.
5475ea806eb3SSteven Rostedt (VMware) 	 */
5476ea806eb3SSteven Rostedt (VMware) 	unregister_ftrace_function(&stub_ops);
5477ea806eb3SSteven Rostedt (VMware) 	ftrace_set_filter_ip(&stub_ops, ip, 1, 0);
5478ea806eb3SSteven Rostedt (VMware) 
5479ea806eb3SSteven Rostedt (VMware)  out_lock:
5480ea806eb3SSteven Rostedt (VMware) 	mutex_lock(&ftrace_lock);
5481ea806eb3SSteven Rostedt (VMware) 
5482ea806eb3SSteven Rostedt (VMware) 	return ret;
5483ea806eb3SSteven Rostedt (VMware) }
5484ea806eb3SSteven Rostedt (VMware) 
5485ea806eb3SSteven Rostedt (VMware) /**
54860567d680SSteven Rostedt (VMware)  * modify_ftrace_direct - Modify an existing direct call to call something else
54870567d680SSteven Rostedt (VMware)  * @ip: The instruction pointer to modify
54880567d680SSteven Rostedt (VMware)  * @old_addr: The address that the current @ip calls directly
54890567d680SSteven Rostedt (VMware)  * @new_addr: The address that the @ip should call
54900567d680SSteven Rostedt (VMware)  *
54910567d680SSteven Rostedt (VMware)  * This modifies a ftrace direct caller at an instruction pointer without
54920567d680SSteven Rostedt (VMware)  * having to disable it first. The direct call will switch over to the
54930567d680SSteven Rostedt (VMware)  * @new_addr without missing anything.
54940567d680SSteven Rostedt (VMware)  *
54950567d680SSteven Rostedt (VMware)  * Returns: zero on success. Non zero on error, which includes:
54960567d680SSteven Rostedt (VMware)  *  -ENODEV : the @ip given has no direct caller attached
54970567d680SSteven Rostedt (VMware)  *  -EINVAL : the @old_addr does not match the current direct caller
54980567d680SSteven Rostedt (VMware)  */
54990567d680SSteven Rostedt (VMware) int modify_ftrace_direct(unsigned long ip,
55000567d680SSteven Rostedt (VMware) 			 unsigned long old_addr, unsigned long new_addr)
55010567d680SSteven Rostedt (VMware) {
55028a141dd7SAlexei Starovoitov 	struct ftrace_direct_func *direct, *new_direct = NULL;
55030567d680SSteven Rostedt (VMware) 	struct ftrace_func_entry *entry;
5504ea806eb3SSteven Rostedt (VMware) 	struct dyn_ftrace *rec;
55050567d680SSteven Rostedt (VMware) 	int ret = -ENODEV;
55060567d680SSteven Rostedt (VMware) 
55070567d680SSteven Rostedt (VMware) 	mutex_lock(&direct_mutex);
55080567d680SSteven Rostedt (VMware) 
5509ea806eb3SSteven Rostedt (VMware) 	mutex_lock(&ftrace_lock);
5510aebfd125SPeter Zijlstra 
5511aebfd125SPeter Zijlstra 	ip = ftrace_location(ip);
5512aebfd125SPeter Zijlstra 	if (!ip)
5513aebfd125SPeter Zijlstra 		goto out_unlock;
5514aebfd125SPeter Zijlstra 
5515ea806eb3SSteven Rostedt (VMware) 	entry = find_direct_entry(&ip, &rec);
55160567d680SSteven Rostedt (VMware) 	if (!entry)
55170567d680SSteven Rostedt (VMware) 		goto out_unlock;
55180567d680SSteven Rostedt (VMware) 
55190567d680SSteven Rostedt (VMware) 	ret = -EINVAL;
55200567d680SSteven Rostedt (VMware) 	if (entry->direct != old_addr)
55210567d680SSteven Rostedt (VMware) 		goto out_unlock;
55220567d680SSteven Rostedt (VMware) 
55238a141dd7SAlexei Starovoitov 	direct = ftrace_find_direct_func(old_addr);
55248a141dd7SAlexei Starovoitov 	if (WARN_ON(!direct))
55258a141dd7SAlexei Starovoitov 		goto out_unlock;
55268a141dd7SAlexei Starovoitov 	if (direct->count > 1) {
55278a141dd7SAlexei Starovoitov 		ret = -ENOMEM;
55288a141dd7SAlexei Starovoitov 		new_direct = ftrace_alloc_direct_func(new_addr);
55298a141dd7SAlexei Starovoitov 		if (!new_direct)
55308a141dd7SAlexei Starovoitov 			goto out_unlock;
55318a141dd7SAlexei Starovoitov 		direct->count--;
55328a141dd7SAlexei Starovoitov 		new_direct->count++;
55338a141dd7SAlexei Starovoitov 	} else {
55348a141dd7SAlexei Starovoitov 		direct->addr = new_addr;
55358a141dd7SAlexei Starovoitov 	}
55368a141dd7SAlexei Starovoitov 
55370567d680SSteven Rostedt (VMware) 	/*
5538ea806eb3SSteven Rostedt (VMware) 	 * If there's no other ftrace callback on the rec->ip location,
5539ea806eb3SSteven Rostedt (VMware) 	 * then it can be changed directly by the architecture.
5540ea806eb3SSteven Rostedt (VMware) 	 * If there is another caller, then we just need to change the
5541ea806eb3SSteven Rostedt (VMware) 	 * direct caller helper to point to @new_addr.
55420567d680SSteven Rostedt (VMware) 	 */
5543ea806eb3SSteven Rostedt (VMware) 	if (ftrace_rec_count(rec) == 1) {
5544ea806eb3SSteven Rostedt (VMware) 		ret = ftrace_modify_direct_caller(entry, rec, old_addr, new_addr);
5545ea806eb3SSteven Rostedt (VMware) 	} else {
5546ea806eb3SSteven Rostedt (VMware) 		entry->direct = new_addr;
5547ea806eb3SSteven Rostedt (VMware) 		ret = 0;
55480567d680SSteven Rostedt (VMware) 	}
55490567d680SSteven Rostedt (VMware) 
55508a141dd7SAlexei Starovoitov 	if (unlikely(ret && new_direct)) {
55518a141dd7SAlexei Starovoitov 		direct->count++;
55528a141dd7SAlexei Starovoitov 		list_del_rcu(&new_direct->next);
55538a141dd7SAlexei Starovoitov 		synchronize_rcu_tasks();
55548a141dd7SAlexei Starovoitov 		kfree(new_direct);
55558a141dd7SAlexei Starovoitov 		ftrace_direct_func_count--;
55568a141dd7SAlexei Starovoitov 	}
55578a141dd7SAlexei Starovoitov 
55580567d680SSteven Rostedt (VMware)  out_unlock:
5559ea806eb3SSteven Rostedt (VMware) 	mutex_unlock(&ftrace_lock);
55600567d680SSteven Rostedt (VMware) 	mutex_unlock(&direct_mutex);
55610567d680SSteven Rostedt (VMware) 	return ret;
55620567d680SSteven Rostedt (VMware) }
55630567d680SSteven Rostedt (VMware) EXPORT_SYMBOL_GPL(modify_ftrace_direct);
5564f64dd462SJiri Olsa 
556553cd885bSSong Liu #define MULTI_FLAGS (FTRACE_OPS_FL_DIRECT | FTRACE_OPS_FL_SAVE_REGS)
5566f64dd462SJiri Olsa 
5567f64dd462SJiri Olsa static int check_direct_multi(struct ftrace_ops *ops)
5568f64dd462SJiri Olsa {
5569f64dd462SJiri Olsa 	if (!(ops->flags & FTRACE_OPS_FL_INITIALIZED))
5570f64dd462SJiri Olsa 		return -EINVAL;
5571f64dd462SJiri Olsa 	if ((ops->flags & MULTI_FLAGS) != MULTI_FLAGS)
5572f64dd462SJiri Olsa 		return -EINVAL;
5573f64dd462SJiri Olsa 	return 0;
5574f64dd462SJiri Olsa }
5575f64dd462SJiri Olsa 
5576f64dd462SJiri Olsa static void remove_direct_functions_hash(struct ftrace_hash *hash, unsigned long addr)
5577f64dd462SJiri Olsa {
5578f64dd462SJiri Olsa 	struct ftrace_func_entry *entry, *del;
5579f64dd462SJiri Olsa 	int size, i;
5580f64dd462SJiri Olsa 
5581f64dd462SJiri Olsa 	size = 1 << hash->size_bits;
5582f64dd462SJiri Olsa 	for (i = 0; i < size; i++) {
5583f64dd462SJiri Olsa 		hlist_for_each_entry(entry, &hash->buckets[i], hlist) {
5584f64dd462SJiri Olsa 			del = __ftrace_lookup_ip(direct_functions, entry->ip);
5585f64dd462SJiri Olsa 			if (del && del->direct == addr) {
5586f64dd462SJiri Olsa 				remove_hash_entry(direct_functions, del);
5587f64dd462SJiri Olsa 				kfree(del);
5588f64dd462SJiri Olsa 			}
5589f64dd462SJiri Olsa 		}
5590f64dd462SJiri Olsa 	}
5591f64dd462SJiri Olsa }
5592f64dd462SJiri Olsa 
5593f64dd462SJiri Olsa /**
5594f64dd462SJiri Olsa  * register_ftrace_direct_multi - Call a custom trampoline directly
5595f64dd462SJiri Olsa  * for multiple functions registered in @ops
5596f64dd462SJiri Olsa  * @ops: The address of the struct ftrace_ops object
5597f64dd462SJiri Olsa  * @addr: The address of the trampoline to call at @ops functions
5598f64dd462SJiri Olsa  *
5599f64dd462SJiri Olsa  * This is used to connect a direct calls to @addr from the nop locations
5600f64dd462SJiri Olsa  * of the functions registered in @ops (with by ftrace_set_filter_ip
5601f64dd462SJiri Olsa  * function).
5602f64dd462SJiri Olsa  *
5603f64dd462SJiri Olsa  * The location that it calls (@addr) must be able to handle a direct call,
5604f64dd462SJiri Olsa  * and save the parameters of the function being traced, and restore them
5605f64dd462SJiri Olsa  * (or inject new ones if needed), before returning.
5606f64dd462SJiri Olsa  *
5607f64dd462SJiri Olsa  * Returns:
5608f64dd462SJiri Olsa  *  0 on success
5609f64dd462SJiri Olsa  *  -EINVAL  - The @ops object was already registered with this call or
5610f64dd462SJiri Olsa  *             when there are no functions in @ops object.
5611f64dd462SJiri Olsa  *  -EBUSY   - Another direct function is already attached (there can be only one)
5612f64dd462SJiri Olsa  *  -ENODEV  - @ip does not point to a ftrace nop location (or not supported)
5613f64dd462SJiri Olsa  *  -ENOMEM  - There was an allocation failure.
5614f64dd462SJiri Olsa  */
5615f64dd462SJiri Olsa int register_ftrace_direct_multi(struct ftrace_ops *ops, unsigned long addr)
5616f64dd462SJiri Olsa {
5617f64dd462SJiri Olsa 	struct ftrace_hash *hash, *free_hash = NULL;
5618f64dd462SJiri Olsa 	struct ftrace_func_entry *entry, *new;
5619f64dd462SJiri Olsa 	int err = -EBUSY, size, i;
5620f64dd462SJiri Olsa 
5621f64dd462SJiri Olsa 	if (ops->func || ops->trampoline)
5622f64dd462SJiri Olsa 		return -EINVAL;
5623f64dd462SJiri Olsa 	if (!(ops->flags & FTRACE_OPS_FL_INITIALIZED))
5624f64dd462SJiri Olsa 		return -EINVAL;
5625f64dd462SJiri Olsa 	if (ops->flags & FTRACE_OPS_FL_ENABLED)
5626f64dd462SJiri Olsa 		return -EINVAL;
5627f64dd462SJiri Olsa 
5628f64dd462SJiri Olsa 	hash = ops->func_hash->filter_hash;
5629f64dd462SJiri Olsa 	if (ftrace_hash_empty(hash))
5630f64dd462SJiri Olsa 		return -EINVAL;
5631f64dd462SJiri Olsa 
5632f64dd462SJiri Olsa 	mutex_lock(&direct_mutex);
5633f64dd462SJiri Olsa 
5634f64dd462SJiri Olsa 	/* Make sure requested entries are not already registered.. */
5635f64dd462SJiri Olsa 	size = 1 << hash->size_bits;
5636f64dd462SJiri Olsa 	for (i = 0; i < size; i++) {
5637f64dd462SJiri Olsa 		hlist_for_each_entry(entry, &hash->buckets[i], hlist) {
5638f64dd462SJiri Olsa 			if (ftrace_find_rec_direct(entry->ip))
5639f64dd462SJiri Olsa 				goto out_unlock;
5640f64dd462SJiri Olsa 		}
5641f64dd462SJiri Olsa 	}
5642f64dd462SJiri Olsa 
5643f64dd462SJiri Olsa 	/* ... and insert them to direct_functions hash. */
5644f64dd462SJiri Olsa 	err = -ENOMEM;
5645f64dd462SJiri Olsa 	for (i = 0; i < size; i++) {
5646f64dd462SJiri Olsa 		hlist_for_each_entry(entry, &hash->buckets[i], hlist) {
5647f64dd462SJiri Olsa 			new = ftrace_add_rec_direct(entry->ip, addr, &free_hash);
5648f64dd462SJiri Olsa 			if (!new)
5649f64dd462SJiri Olsa 				goto out_remove;
5650f64dd462SJiri Olsa 			entry->direct = addr;
5651f64dd462SJiri Olsa 		}
5652f64dd462SJiri Olsa 	}
5653f64dd462SJiri Olsa 
5654f64dd462SJiri Olsa 	ops->func = call_direct_funcs;
5655f64dd462SJiri Olsa 	ops->flags = MULTI_FLAGS;
5656f64dd462SJiri Olsa 	ops->trampoline = FTRACE_REGS_ADDR;
5657f64dd462SJiri Olsa 
565853cd885bSSong Liu 	err = register_ftrace_function_nolock(ops);
5659f64dd462SJiri Olsa 
5660f64dd462SJiri Olsa  out_remove:
5661f64dd462SJiri Olsa 	if (err)
5662f64dd462SJiri Olsa 		remove_direct_functions_hash(hash, addr);
5663f64dd462SJiri Olsa 
5664f64dd462SJiri Olsa  out_unlock:
5665f64dd462SJiri Olsa 	mutex_unlock(&direct_mutex);
5666f64dd462SJiri Olsa 
5667f64dd462SJiri Olsa 	if (free_hash) {
5668f64dd462SJiri Olsa 		synchronize_rcu_tasks();
5669f64dd462SJiri Olsa 		free_ftrace_hash(free_hash);
5670f64dd462SJiri Olsa 	}
5671f64dd462SJiri Olsa 	return err;
5672f64dd462SJiri Olsa }
5673f64dd462SJiri Olsa EXPORT_SYMBOL_GPL(register_ftrace_direct_multi);
5674f64dd462SJiri Olsa 
5675f64dd462SJiri Olsa /**
5676f64dd462SJiri Olsa  * unregister_ftrace_direct_multi - Remove calls to custom trampoline
5677f64dd462SJiri Olsa  * previously registered by register_ftrace_direct_multi for @ops object.
5678f64dd462SJiri Olsa  * @ops: The address of the struct ftrace_ops object
5679f64dd462SJiri Olsa  *
5680f64dd462SJiri Olsa  * This is used to remove a direct calls to @addr from the nop locations
5681f64dd462SJiri Olsa  * of the functions registered in @ops (with by ftrace_set_filter_ip
5682f64dd462SJiri Olsa  * function).
5683f64dd462SJiri Olsa  *
5684f64dd462SJiri Olsa  * Returns:
5685f64dd462SJiri Olsa  *  0 on success
5686f64dd462SJiri Olsa  *  -EINVAL - The @ops object was not properly registered.
5687f64dd462SJiri Olsa  */
5688f64dd462SJiri Olsa int unregister_ftrace_direct_multi(struct ftrace_ops *ops, unsigned long addr)
5689f64dd462SJiri Olsa {
5690f64dd462SJiri Olsa 	struct ftrace_hash *hash = ops->func_hash->filter_hash;
5691f64dd462SJiri Olsa 	int err;
5692f64dd462SJiri Olsa 
5693f64dd462SJiri Olsa 	if (check_direct_multi(ops))
5694f64dd462SJiri Olsa 		return -EINVAL;
5695f64dd462SJiri Olsa 	if (!(ops->flags & FTRACE_OPS_FL_ENABLED))
5696f64dd462SJiri Olsa 		return -EINVAL;
5697f64dd462SJiri Olsa 
5698f64dd462SJiri Olsa 	mutex_lock(&direct_mutex);
5699f64dd462SJiri Olsa 	err = unregister_ftrace_function(ops);
5700f64dd462SJiri Olsa 	remove_direct_functions_hash(hash, addr);
5701f64dd462SJiri Olsa 	mutex_unlock(&direct_mutex);
5702fea3ffa4SJiri Olsa 
5703fea3ffa4SJiri Olsa 	/* cleanup for possible another register call */
5704fea3ffa4SJiri Olsa 	ops->func = NULL;
5705fea3ffa4SJiri Olsa 	ops->trampoline = 0;
5706f64dd462SJiri Olsa 	return err;
5707f64dd462SJiri Olsa }
5708f64dd462SJiri Olsa EXPORT_SYMBOL_GPL(unregister_ftrace_direct_multi);
5709ccf5a89eSJiri Olsa 
5710f96f644aSSong Liu static int
5711f96f644aSSong Liu __modify_ftrace_direct_multi(struct ftrace_ops *ops, unsigned long addr)
5712ccf5a89eSJiri Olsa {
5713ed292718SSteven Rostedt (VMware) 	struct ftrace_hash *hash;
5714ccf5a89eSJiri Olsa 	struct ftrace_func_entry *entry, *iter;
5715ed292718SSteven Rostedt (VMware) 	static struct ftrace_ops tmp_ops = {
5716ed292718SSteven Rostedt (VMware) 		.func		= ftrace_stub,
5717ed292718SSteven Rostedt (VMware) 		.flags		= FTRACE_OPS_FL_STUB,
5718ed292718SSteven Rostedt (VMware) 	};
5719ccf5a89eSJiri Olsa 	int i, size;
5720ccf5a89eSJiri Olsa 	int err;
5721ccf5a89eSJiri Olsa 
5722f96f644aSSong Liu 	lockdep_assert_held_once(&direct_mutex);
5723ed292718SSteven Rostedt (VMware) 
5724ed292718SSteven Rostedt (VMware) 	/* Enable the tmp_ops to have the same functions as the direct ops */
5725ed292718SSteven Rostedt (VMware) 	ftrace_ops_init(&tmp_ops);
5726ed292718SSteven Rostedt (VMware) 	tmp_ops.func_hash = ops->func_hash;
5727ed292718SSteven Rostedt (VMware) 
572853cd885bSSong Liu 	err = register_ftrace_function_nolock(&tmp_ops);
5729ed292718SSteven Rostedt (VMware) 	if (err)
5730f96f644aSSong Liu 		return err;
5731ccf5a89eSJiri Olsa 
5732ccf5a89eSJiri Olsa 	/*
5733ed292718SSteven Rostedt (VMware) 	 * Now the ftrace_ops_list_func() is called to do the direct callers.
5734ed292718SSteven Rostedt (VMware) 	 * We can safely change the direct functions attached to each entry.
5735ccf5a89eSJiri Olsa 	 */
5736ed292718SSteven Rostedt (VMware) 	mutex_lock(&ftrace_lock);
5737ccf5a89eSJiri Olsa 
5738ed292718SSteven Rostedt (VMware) 	hash = ops->func_hash->filter_hash;
5739ccf5a89eSJiri Olsa 	size = 1 << hash->size_bits;
5740ccf5a89eSJiri Olsa 	for (i = 0; i < size; i++) {
5741ccf5a89eSJiri Olsa 		hlist_for_each_entry(iter, &hash->buckets[i], hlist) {
5742ccf5a89eSJiri Olsa 			entry = __ftrace_lookup_ip(direct_functions, iter->ip);
5743ccf5a89eSJiri Olsa 			if (!entry)
5744ccf5a89eSJiri Olsa 				continue;
5745ccf5a89eSJiri Olsa 			entry->direct = addr;
5746ccf5a89eSJiri Olsa 		}
5747ccf5a89eSJiri Olsa 	}
5748ccf5a89eSJiri Olsa 
57492e6e9058SJiri Olsa 	mutex_unlock(&ftrace_lock);
57502e6e9058SJiri Olsa 
5751ed292718SSteven Rostedt (VMware) 	/* Removing the tmp_ops will add the updated direct callers to the functions */
5752ed292718SSteven Rostedt (VMware) 	unregister_ftrace_function(&tmp_ops);
5753ccf5a89eSJiri Olsa 
5754f96f644aSSong Liu 	return err;
5755f96f644aSSong Liu }
5756f96f644aSSong Liu 
5757f96f644aSSong Liu /**
5758f96f644aSSong Liu  * modify_ftrace_direct_multi_nolock - Modify an existing direct 'multi' call
5759f96f644aSSong Liu  * to call something else
5760f96f644aSSong Liu  * @ops: The address of the struct ftrace_ops object
5761f96f644aSSong Liu  * @addr: The address of the new trampoline to call at @ops functions
5762f96f644aSSong Liu  *
5763f96f644aSSong Liu  * This is used to unregister currently registered direct caller and
5764f96f644aSSong Liu  * register new one @addr on functions registered in @ops object.
5765f96f644aSSong Liu  *
5766f96f644aSSong Liu  * Note there's window between ftrace_shutdown and ftrace_startup calls
5767f96f644aSSong Liu  * where there will be no callbacks called.
5768f96f644aSSong Liu  *
5769f96f644aSSong Liu  * Caller should already have direct_mutex locked, so we don't lock
5770f96f644aSSong Liu  * direct_mutex here.
5771f96f644aSSong Liu  *
5772f96f644aSSong Liu  * Returns: zero on success. Non zero on error, which includes:
5773f96f644aSSong Liu  *  -EINVAL - The @ops object was not properly registered.
5774f96f644aSSong Liu  */
5775f96f644aSSong Liu int modify_ftrace_direct_multi_nolock(struct ftrace_ops *ops, unsigned long addr)
5776f96f644aSSong Liu {
5777f96f644aSSong Liu 	if (check_direct_multi(ops))
5778f96f644aSSong Liu 		return -EINVAL;
5779f96f644aSSong Liu 	if (!(ops->flags & FTRACE_OPS_FL_ENABLED))
5780f96f644aSSong Liu 		return -EINVAL;
5781f96f644aSSong Liu 
5782f96f644aSSong Liu 	return __modify_ftrace_direct_multi(ops, addr);
5783f96f644aSSong Liu }
5784f96f644aSSong Liu EXPORT_SYMBOL_GPL(modify_ftrace_direct_multi_nolock);
5785f96f644aSSong Liu 
5786f96f644aSSong Liu /**
5787f96f644aSSong Liu  * modify_ftrace_direct_multi - Modify an existing direct 'multi' call
5788f96f644aSSong Liu  * to call something else
5789f96f644aSSong Liu  * @ops: The address of the struct ftrace_ops object
5790f96f644aSSong Liu  * @addr: The address of the new trampoline to call at @ops functions
5791f96f644aSSong Liu  *
5792f96f644aSSong Liu  * This is used to unregister currently registered direct caller and
5793f96f644aSSong Liu  * register new one @addr on functions registered in @ops object.
5794f96f644aSSong Liu  *
5795f96f644aSSong Liu  * Note there's window between ftrace_shutdown and ftrace_startup calls
5796f96f644aSSong Liu  * where there will be no callbacks called.
5797f96f644aSSong Liu  *
5798f96f644aSSong Liu  * Returns: zero on success. Non zero on error, which includes:
5799f96f644aSSong Liu  *  -EINVAL - The @ops object was not properly registered.
5800f96f644aSSong Liu  */
5801f96f644aSSong Liu int modify_ftrace_direct_multi(struct ftrace_ops *ops, unsigned long addr)
5802f96f644aSSong Liu {
5803f96f644aSSong Liu 	int err;
5804f96f644aSSong Liu 
5805f96f644aSSong Liu 	if (check_direct_multi(ops))
5806f96f644aSSong Liu 		return -EINVAL;
5807f96f644aSSong Liu 	if (!(ops->flags & FTRACE_OPS_FL_ENABLED))
5808f96f644aSSong Liu 		return -EINVAL;
5809f96f644aSSong Liu 
5810f96f644aSSong Liu 	mutex_lock(&direct_mutex);
5811f96f644aSSong Liu 	err = __modify_ftrace_direct_multi(ops, addr);
5812ccf5a89eSJiri Olsa 	mutex_unlock(&direct_mutex);
5813ccf5a89eSJiri Olsa 	return err;
5814ccf5a89eSJiri Olsa }
5815ccf5a89eSJiri Olsa EXPORT_SYMBOL_GPL(modify_ftrace_direct_multi);
5816763e34e7SSteven Rostedt (VMware) #endif /* CONFIG_DYNAMIC_FTRACE_WITH_DIRECT_CALLS */
5817763e34e7SSteven Rostedt (VMware) 
5818647664eaSMasami Hiramatsu /**
5819647664eaSMasami Hiramatsu  * ftrace_set_filter_ip - set a function to filter on in ftrace by address
5820647664eaSMasami Hiramatsu  * @ops - the ops to set the filter with
5821647664eaSMasami Hiramatsu  * @ip - the address to add to or remove from the filter.
5822647664eaSMasami Hiramatsu  * @remove - non zero to remove the ip from the filter
5823647664eaSMasami Hiramatsu  * @reset - non zero to reset all filters before applying this filter.
5824647664eaSMasami Hiramatsu  *
5825647664eaSMasami Hiramatsu  * Filters denote which functions should be enabled when tracing is enabled
5826f2cc020dSIngo Molnar  * If @ip is NULL, it fails to update filter.
5827647664eaSMasami Hiramatsu  */
5828647664eaSMasami Hiramatsu int ftrace_set_filter_ip(struct ftrace_ops *ops, unsigned long ip,
5829647664eaSMasami Hiramatsu 			 int remove, int reset)
5830647664eaSMasami Hiramatsu {
5831f04f24fbSMasami Hiramatsu 	ftrace_ops_init(ops);
58324f554e95SJiri Olsa 	return ftrace_set_addr(ops, &ip, 1, remove, reset, 1);
5833647664eaSMasami Hiramatsu }
5834647664eaSMasami Hiramatsu EXPORT_SYMBOL_GPL(ftrace_set_filter_ip);
5835647664eaSMasami Hiramatsu 
5836d032ae89SJoel Fernandes /**
58374f554e95SJiri Olsa  * ftrace_set_filter_ips - set functions to filter on in ftrace by addresses
58384f554e95SJiri Olsa  * @ops - the ops to set the filter with
58394f554e95SJiri Olsa  * @ips - the array of addresses to add to or remove from the filter.
58404f554e95SJiri Olsa  * @cnt - the number of addresses in @ips
58414f554e95SJiri Olsa  * @remove - non zero to remove ips from the filter
58424f554e95SJiri Olsa  * @reset - non zero to reset all filters before applying this filter.
58434f554e95SJiri Olsa  *
58444f554e95SJiri Olsa  * Filters denote which functions should be enabled when tracing is enabled
58454f554e95SJiri Olsa  * If @ips array or any ip specified within is NULL , it fails to update filter.
58464f554e95SJiri Olsa  */
58474f554e95SJiri Olsa int ftrace_set_filter_ips(struct ftrace_ops *ops, unsigned long *ips,
58484f554e95SJiri Olsa 			  unsigned int cnt, int remove, int reset)
58494f554e95SJiri Olsa {
58504f554e95SJiri Olsa 	ftrace_ops_init(ops);
58514f554e95SJiri Olsa 	return ftrace_set_addr(ops, ips, cnt, remove, reset, 1);
58524f554e95SJiri Olsa }
58534f554e95SJiri Olsa EXPORT_SYMBOL_GPL(ftrace_set_filter_ips);
58544f554e95SJiri Olsa 
58554f554e95SJiri Olsa /**
5856d032ae89SJoel Fernandes  * ftrace_ops_set_global_filter - setup ops to use global filters
5857d032ae89SJoel Fernandes  * @ops - the ops which will use the global filters
5858d032ae89SJoel Fernandes  *
5859d032ae89SJoel Fernandes  * ftrace users who need global function trace filtering should call this.
5860d032ae89SJoel Fernandes  * It can set the global filter only if ops were not initialized before.
5861d032ae89SJoel Fernandes  */
5862d032ae89SJoel Fernandes void ftrace_ops_set_global_filter(struct ftrace_ops *ops)
5863d032ae89SJoel Fernandes {
5864d032ae89SJoel Fernandes 	if (ops->flags & FTRACE_OPS_FL_INITIALIZED)
5865d032ae89SJoel Fernandes 		return;
5866d032ae89SJoel Fernandes 
5867d032ae89SJoel Fernandes 	ftrace_ops_init(ops);
5868d032ae89SJoel Fernandes 	ops->func_hash = &global_ops.local_hash;
5869d032ae89SJoel Fernandes }
5870d032ae89SJoel Fernandes EXPORT_SYMBOL_GPL(ftrace_ops_set_global_filter);
5871d032ae89SJoel Fernandes 
5872647664eaSMasami Hiramatsu static int
5873647664eaSMasami Hiramatsu ftrace_set_regex(struct ftrace_ops *ops, unsigned char *buf, int len,
5874647664eaSMasami Hiramatsu 		 int reset, int enable)
5875647664eaSMasami Hiramatsu {
58764f554e95SJiri Olsa 	return ftrace_set_hash(ops, buf, len, NULL, 0, 0, reset, enable);
5877647664eaSMasami Hiramatsu }
5878647664eaSMasami Hiramatsu 
587977a2b37dSSteven Rostedt /**
588077a2b37dSSteven Rostedt  * ftrace_set_filter - set a function to filter on in ftrace
5881936e074bSSteven Rostedt  * @ops - the ops to set the filter with
588277a2b37dSSteven Rostedt  * @buf - the string that holds the function filter text.
588377a2b37dSSteven Rostedt  * @len - the length of the string.
588477a2b37dSSteven Rostedt  * @reset - non zero to reset all filters before applying this filter.
588577a2b37dSSteven Rostedt  *
588677a2b37dSSteven Rostedt  * Filters denote which functions should be enabled when tracing is enabled.
588777a2b37dSSteven Rostedt  * If @buf is NULL and reset is set, all functions will be enabled for tracing.
588877a2b37dSSteven Rostedt  */
5889ac483c44SJiri Olsa int ftrace_set_filter(struct ftrace_ops *ops, unsigned char *buf,
5890936e074bSSteven Rostedt 		       int len, int reset)
589177a2b37dSSteven Rostedt {
5892f04f24fbSMasami Hiramatsu 	ftrace_ops_init(ops);
5893ac483c44SJiri Olsa 	return ftrace_set_regex(ops, buf, len, reset, 1);
589441c52c0dSSteven Rostedt }
5895936e074bSSteven Rostedt EXPORT_SYMBOL_GPL(ftrace_set_filter);
58964eebcc81SSteven Rostedt 
589741c52c0dSSteven Rostedt /**
589841c52c0dSSteven Rostedt  * ftrace_set_notrace - set a function to not trace in ftrace
5899936e074bSSteven Rostedt  * @ops - the ops to set the notrace filter with
590041c52c0dSSteven Rostedt  * @buf - the string that holds the function notrace text.
590141c52c0dSSteven Rostedt  * @len - the length of the string.
590241c52c0dSSteven Rostedt  * @reset - non zero to reset all filters before applying this filter.
590341c52c0dSSteven Rostedt  *
590441c52c0dSSteven Rostedt  * Notrace Filters denote which functions should not be enabled when tracing
590541c52c0dSSteven Rostedt  * is enabled. If @buf is NULL and reset is set, all functions will be enabled
590641c52c0dSSteven Rostedt  * for tracing.
590741c52c0dSSteven Rostedt  */
5908ac483c44SJiri Olsa int ftrace_set_notrace(struct ftrace_ops *ops, unsigned char *buf,
5909936e074bSSteven Rostedt 			int len, int reset)
5910936e074bSSteven Rostedt {
5911f04f24fbSMasami Hiramatsu 	ftrace_ops_init(ops);
5912ac483c44SJiri Olsa 	return ftrace_set_regex(ops, buf, len, reset, 0);
5913936e074bSSteven Rostedt }
5914936e074bSSteven Rostedt EXPORT_SYMBOL_GPL(ftrace_set_notrace);
5915936e074bSSteven Rostedt /**
59168d1b065dSJiaxing Wang  * ftrace_set_global_filter - set a function to filter on with global tracers
5917936e074bSSteven Rostedt  * @buf - the string that holds the function filter text.
5918936e074bSSteven Rostedt  * @len - the length of the string.
5919936e074bSSteven Rostedt  * @reset - non zero to reset all filters before applying this filter.
5920936e074bSSteven Rostedt  *
5921936e074bSSteven Rostedt  * Filters denote which functions should be enabled when tracing is enabled.
5922936e074bSSteven Rostedt  * If @buf is NULL and reset is set, all functions will be enabled for tracing.
5923936e074bSSteven Rostedt  */
5924936e074bSSteven Rostedt void ftrace_set_global_filter(unsigned char *buf, int len, int reset)
5925936e074bSSteven Rostedt {
5926936e074bSSteven Rostedt 	ftrace_set_regex(&global_ops, buf, len, reset, 1);
5927936e074bSSteven Rostedt }
5928936e074bSSteven Rostedt EXPORT_SYMBOL_GPL(ftrace_set_global_filter);
5929936e074bSSteven Rostedt 
5930936e074bSSteven Rostedt /**
59318d1b065dSJiaxing Wang  * ftrace_set_global_notrace - set a function to not trace with global tracers
5932936e074bSSteven Rostedt  * @buf - the string that holds the function notrace text.
5933936e074bSSteven Rostedt  * @len - the length of the string.
5934936e074bSSteven Rostedt  * @reset - non zero to reset all filters before applying this filter.
5935936e074bSSteven Rostedt  *
5936936e074bSSteven Rostedt  * Notrace Filters denote which functions should not be enabled when tracing
5937936e074bSSteven Rostedt  * is enabled. If @buf is NULL and reset is set, all functions will be enabled
5938936e074bSSteven Rostedt  * for tracing.
5939936e074bSSteven Rostedt  */
5940936e074bSSteven Rostedt void ftrace_set_global_notrace(unsigned char *buf, int len, int reset)
594141c52c0dSSteven Rostedt {
5942f45948e8SSteven Rostedt 	ftrace_set_regex(&global_ops, buf, len, reset, 0);
594377a2b37dSSteven Rostedt }
5944936e074bSSteven Rostedt EXPORT_SYMBOL_GPL(ftrace_set_global_notrace);
594577a2b37dSSteven Rostedt 
59462af15d6aSSteven Rostedt /*
59472af15d6aSSteven Rostedt  * command line interface to allow users to set filters on boot up.
59482af15d6aSSteven Rostedt  */
59492af15d6aSSteven Rostedt #define FTRACE_FILTER_SIZE		COMMAND_LINE_SIZE
59502af15d6aSSteven Rostedt static char ftrace_notrace_buf[FTRACE_FILTER_SIZE] __initdata;
59512af15d6aSSteven Rostedt static char ftrace_filter_buf[FTRACE_FILTER_SIZE] __initdata;
59522af15d6aSSteven Rostedt 
5953f1ed7c74SSteven Rostedt (Red Hat) /* Used by function selftest to not test if filter is set */
5954f1ed7c74SSteven Rostedt (Red Hat) bool ftrace_filter_param __initdata;
5955f1ed7c74SSteven Rostedt (Red Hat) 
59562af15d6aSSteven Rostedt static int __init set_ftrace_notrace(char *str)
59572af15d6aSSteven Rostedt {
5958f1ed7c74SSteven Rostedt (Red Hat) 	ftrace_filter_param = true;
595975761cc1SChen Gang 	strlcpy(ftrace_notrace_buf, str, FTRACE_FILTER_SIZE);
59602af15d6aSSteven Rostedt 	return 1;
59612af15d6aSSteven Rostedt }
59622af15d6aSSteven Rostedt __setup("ftrace_notrace=", set_ftrace_notrace);
59632af15d6aSSteven Rostedt 
59642af15d6aSSteven Rostedt static int __init set_ftrace_filter(char *str)
59652af15d6aSSteven Rostedt {
5966f1ed7c74SSteven Rostedt (Red Hat) 	ftrace_filter_param = true;
596775761cc1SChen Gang 	strlcpy(ftrace_filter_buf, str, FTRACE_FILTER_SIZE);
59682af15d6aSSteven Rostedt 	return 1;
59692af15d6aSSteven Rostedt }
59702af15d6aSSteven Rostedt __setup("ftrace_filter=", set_ftrace_filter);
59712af15d6aSSteven Rostedt 
5972369bc18fSStefan Assmann #ifdef CONFIG_FUNCTION_GRAPH_TRACER
5973f6060f46SLai Jiangshan static char ftrace_graph_buf[FTRACE_FILTER_SIZE] __initdata;
59740d7d9a16SNamhyung Kim static char ftrace_graph_notrace_buf[FTRACE_FILTER_SIZE] __initdata;
5975b9b0c831SNamhyung Kim static int ftrace_graph_set_hash(struct ftrace_hash *hash, char *buffer);
5976801c29fdSSteven Rostedt 
5977369bc18fSStefan Assmann static int __init set_graph_function(char *str)
5978369bc18fSStefan Assmann {
597906f43d66SFrederic Weisbecker 	strlcpy(ftrace_graph_buf, str, FTRACE_FILTER_SIZE);
5980369bc18fSStefan Assmann 	return 1;
5981369bc18fSStefan Assmann }
5982369bc18fSStefan Assmann __setup("ftrace_graph_filter=", set_graph_function);
5983369bc18fSStefan Assmann 
59840d7d9a16SNamhyung Kim static int __init set_graph_notrace_function(char *str)
59850d7d9a16SNamhyung Kim {
59860d7d9a16SNamhyung Kim 	strlcpy(ftrace_graph_notrace_buf, str, FTRACE_FILTER_SIZE);
59870d7d9a16SNamhyung Kim 	return 1;
59880d7d9a16SNamhyung Kim }
59890d7d9a16SNamhyung Kim __setup("ftrace_graph_notrace=", set_graph_notrace_function);
59900d7d9a16SNamhyung Kim 
599165a50c65STodd Brandt static int __init set_graph_max_depth_function(char *str)
599265a50c65STodd Brandt {
599365a50c65STodd Brandt 	if (!str)
599465a50c65STodd Brandt 		return 0;
599565a50c65STodd Brandt 	fgraph_max_depth = simple_strtoul(str, NULL, 0);
599665a50c65STodd Brandt 	return 1;
599765a50c65STodd Brandt }
599865a50c65STodd Brandt __setup("ftrace_graph_max_depth=", set_graph_max_depth_function);
599965a50c65STodd Brandt 
60000d7d9a16SNamhyung Kim static void __init set_ftrace_early_graph(char *buf, int enable)
6001369bc18fSStefan Assmann {
6002369bc18fSStefan Assmann 	int ret;
6003369bc18fSStefan Assmann 	char *func;
6004b9b0c831SNamhyung Kim 	struct ftrace_hash *hash;
60050d7d9a16SNamhyung Kim 
600692ad18ecSSteven Rostedt (VMware) 	hash = alloc_ftrace_hash(FTRACE_HASH_DEFAULT_BITS);
600724589e3aSSteven Rostedt (VMware) 	if (MEM_FAIL(!hash, "Failed to allocate hash\n"))
600892ad18ecSSteven Rostedt (VMware) 		return;
6009369bc18fSStefan Assmann 
6010369bc18fSStefan Assmann 	while (buf) {
6011369bc18fSStefan Assmann 		func = strsep(&buf, ",");
6012369bc18fSStefan Assmann 		/* we allow only one expression at a time */
6013b9b0c831SNamhyung Kim 		ret = ftrace_graph_set_hash(hash, func);
6014369bc18fSStefan Assmann 		if (ret)
6015369bc18fSStefan Assmann 			printk(KERN_DEBUG "ftrace: function %s not "
6016369bc18fSStefan Assmann 					  "traceable\n", func);
6017369bc18fSStefan Assmann 	}
601892ad18ecSSteven Rostedt (VMware) 
601992ad18ecSSteven Rostedt (VMware) 	if (enable)
602092ad18ecSSteven Rostedt (VMware) 		ftrace_graph_hash = hash;
602192ad18ecSSteven Rostedt (VMware) 	else
602292ad18ecSSteven Rostedt (VMware) 		ftrace_graph_notrace_hash = hash;
6023369bc18fSStefan Assmann }
6024369bc18fSStefan Assmann #endif /* CONFIG_FUNCTION_GRAPH_TRACER */
6025369bc18fSStefan Assmann 
60262a85a37fSSteven Rostedt void __init
60272a85a37fSSteven Rostedt ftrace_set_early_filter(struct ftrace_ops *ops, char *buf, int enable)
60282af15d6aSSteven Rostedt {
60292af15d6aSSteven Rostedt 	char *func;
60302af15d6aSSteven Rostedt 
6031f04f24fbSMasami Hiramatsu 	ftrace_ops_init(ops);
6032f04f24fbSMasami Hiramatsu 
60332af15d6aSSteven Rostedt 	while (buf) {
60342af15d6aSSteven Rostedt 		func = strsep(&buf, ",");
6035f45948e8SSteven Rostedt 		ftrace_set_regex(ops, func, strlen(func), 0, enable);
60362af15d6aSSteven Rostedt 	}
60372af15d6aSSteven Rostedt }
60382af15d6aSSteven Rostedt 
60392af15d6aSSteven Rostedt static void __init set_ftrace_early_filters(void)
60402af15d6aSSteven Rostedt {
60412af15d6aSSteven Rostedt 	if (ftrace_filter_buf[0])
60422a85a37fSSteven Rostedt 		ftrace_set_early_filter(&global_ops, ftrace_filter_buf, 1);
60432af15d6aSSteven Rostedt 	if (ftrace_notrace_buf[0])
60442a85a37fSSteven Rostedt 		ftrace_set_early_filter(&global_ops, ftrace_notrace_buf, 0);
6045369bc18fSStefan Assmann #ifdef CONFIG_FUNCTION_GRAPH_TRACER
6046369bc18fSStefan Assmann 	if (ftrace_graph_buf[0])
60470d7d9a16SNamhyung Kim 		set_ftrace_early_graph(ftrace_graph_buf, 1);
60480d7d9a16SNamhyung Kim 	if (ftrace_graph_notrace_buf[0])
60490d7d9a16SNamhyung Kim 		set_ftrace_early_graph(ftrace_graph_notrace_buf, 0);
6050369bc18fSStefan Assmann #endif /* CONFIG_FUNCTION_GRAPH_TRACER */
60512af15d6aSSteven Rostedt }
60522af15d6aSSteven Rostedt 
6053fc13cb0cSSteven Rostedt int ftrace_regex_release(struct inode *inode, struct file *file)
60545072c59fSSteven Rostedt {
60555072c59fSSteven Rostedt 	struct seq_file *m = (struct seq_file *)file->private_data;
60565072c59fSSteven Rostedt 	struct ftrace_iterator *iter;
605733dc9b12SSteven Rostedt 	struct ftrace_hash **orig_hash;
6058689fd8b6S[email protected] 	struct trace_parser *parser;
6059ed926f9bSSteven Rostedt 	int filter_hash;
60605072c59fSSteven Rostedt 
60615072c59fSSteven Rostedt 	if (file->f_mode & FMODE_READ) {
60625072c59fSSteven Rostedt 		iter = m->private;
60635072c59fSSteven Rostedt 		seq_release(inode, file);
60645072c59fSSteven Rostedt 	} else
60655072c59fSSteven Rostedt 		iter = file->private_data;
60665072c59fSSteven Rostedt 
6067689fd8b6S[email protected] 	parser = &iter->parser;
6068689fd8b6S[email protected] 	if (trace_parser_loaded(parser)) {
60698c9af478SSteven Rostedt (VMware) 		int enable = !(iter->flags & FTRACE_ITER_NOTRACE);
60708c9af478SSteven Rostedt (VMware) 
60718c9af478SSteven Rostedt (VMware) 		ftrace_process_regex(iter, parser->buffer,
60728c9af478SSteven Rostedt (VMware) 				     parser->idx, enable);
60735072c59fSSteven Rostedt 	}
60745072c59fSSteven Rostedt 
6075058e297dSSteven Rostedt 	trace_parser_put(parser);
6076058e297dSSteven Rostedt 
607733b7f99cSSteven Rostedt (Red Hat) 	mutex_lock(&iter->ops->func_hash->regex_lock);
60783f2367baSMasami Hiramatsu 
6079058e297dSSteven Rostedt 	if (file->f_mode & FMODE_WRITE) {
6080ed926f9bSSteven Rostedt 		filter_hash = !!(iter->flags & FTRACE_ITER_FILTER);
6081ed926f9bSSteven Rostedt 
60828c08f0d5SSteven Rostedt (VMware) 		if (filter_hash) {
608333b7f99cSSteven Rostedt (Red Hat) 			orig_hash = &iter->ops->func_hash->filter_hash;
6084*0ce0638eSZheng Yejian 			if (iter->tr) {
6085*0ce0638eSZheng Yejian 				if (list_empty(&iter->tr->mod_trace))
6086*0ce0638eSZheng Yejian 					iter->hash->flags &= ~FTRACE_HASH_FL_MOD;
6087*0ce0638eSZheng Yejian 				else
60888c08f0d5SSteven Rostedt (VMware) 					iter->hash->flags |= FTRACE_HASH_FL_MOD;
6089*0ce0638eSZheng Yejian 			}
60908c08f0d5SSteven Rostedt (VMware) 		} else
609133b7f99cSSteven Rostedt (Red Hat) 			orig_hash = &iter->ops->func_hash->notrace_hash;
609233dc9b12SSteven Rostedt 
6093e6ea44e9SSteven Rostedt 		mutex_lock(&ftrace_lock);
6094045e269cSAlex Shi 		ftrace_hash_move_and_update_ops(iter->ops, orig_hash,
6095e16b35ddSSteven Rostedt (VMware) 						      iter->hash, filter_hash);
6096e6ea44e9SSteven Rostedt 		mutex_unlock(&ftrace_lock);
6097c20489daSSteven Rostedt (VMware) 	} else {
6098c20489daSSteven Rostedt (VMware) 		/* For read only, the hash is the ops hash */
6099c20489daSSteven Rostedt (VMware) 		iter->hash = NULL;
6100058e297dSSteven Rostedt 	}
61013f2367baSMasami Hiramatsu 
610233b7f99cSSteven Rostedt (Red Hat) 	mutex_unlock(&iter->ops->func_hash->regex_lock);
610333dc9b12SSteven Rostedt 	free_ftrace_hash(iter->hash);
61049ef16693SSteven Rostedt (VMware) 	if (iter->tr)
61059ef16693SSteven Rostedt (VMware) 		trace_array_put(iter->tr);
610633dc9b12SSteven Rostedt 	kfree(iter);
6107689fd8b6S[email protected] 
61085072c59fSSteven Rostedt 	return 0;
61095072c59fSSteven Rostedt }
61105072c59fSSteven Rostedt 
61115e2336a0SSteven Rostedt static const struct file_operations ftrace_avail_fops = {
61125072c59fSSteven Rostedt 	.open = ftrace_avail_open,
61135072c59fSSteven Rostedt 	.read = seq_read,
61145072c59fSSteven Rostedt 	.llseek = seq_lseek,
61153be04b47SLi Zefan 	.release = seq_release_private,
61165072c59fSSteven Rostedt };
61175072c59fSSteven Rostedt 
6118647bcd03SSteven Rostedt static const struct file_operations ftrace_enabled_fops = {
6119647bcd03SSteven Rostedt 	.open = ftrace_enabled_open,
6120647bcd03SSteven Rostedt 	.read = seq_read,
6121647bcd03SSteven Rostedt 	.llseek = seq_lseek,
6122647bcd03SSteven Rostedt 	.release = seq_release_private,
6123647bcd03SSteven Rostedt };
6124647bcd03SSteven Rostedt 
61255e2336a0SSteven Rostedt static const struct file_operations ftrace_filter_fops = {
61265072c59fSSteven Rostedt 	.open = ftrace_filter_open,
6127850a80cfSLai Jiangshan 	.read = seq_read,
61285072c59fSSteven Rostedt 	.write = ftrace_filter_write,
6129098c879eSSteven Rostedt (Red Hat) 	.llseek = tracing_lseek,
61301cf41dd7SSteven Rostedt 	.release = ftrace_regex_release,
61315072c59fSSteven Rostedt };
61325072c59fSSteven Rostedt 
61335e2336a0SSteven Rostedt static const struct file_operations ftrace_notrace_fops = {
613441c52c0dSSteven Rostedt 	.open = ftrace_notrace_open,
6135850a80cfSLai Jiangshan 	.read = seq_read,
613641c52c0dSSteven Rostedt 	.write = ftrace_notrace_write,
6137098c879eSSteven Rostedt (Red Hat) 	.llseek = tracing_lseek,
61381cf41dd7SSteven Rostedt 	.release = ftrace_regex_release,
613941c52c0dSSteven Rostedt };
614041c52c0dSSteven Rostedt 
6141ea4e2bc4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
6142ea4e2bc4SSteven Rostedt 
6143ea4e2bc4SSteven Rostedt static DEFINE_MUTEX(graph_lock);
6144ea4e2bc4SSteven Rostedt 
614524a9729fSAmol Grover struct ftrace_hash __rcu *ftrace_graph_hash = EMPTY_HASH;
6146fd0e6852SAmol Grover struct ftrace_hash __rcu *ftrace_graph_notrace_hash = EMPTY_HASH;
6147b9b0c831SNamhyung Kim 
6148b9b0c831SNamhyung Kim enum graph_filter_type {
6149b9b0c831SNamhyung Kim 	GRAPH_FILTER_NOTRACE	= 0,
6150b9b0c831SNamhyung Kim 	GRAPH_FILTER_FUNCTION,
6151b9b0c831SNamhyung Kim };
6152ea4e2bc4SSteven Rostedt 
6153555fc781SSteven Rostedt (VMware) #define FTRACE_GRAPH_EMPTY	((void *)1)
6154555fc781SSteven Rostedt (VMware) 
6155faf982a6SNamhyung Kim struct ftrace_graph_data {
6156b9b0c831SNamhyung Kim 	struct ftrace_hash		*hash;
6157b9b0c831SNamhyung Kim 	struct ftrace_func_entry	*entry;
6158b9b0c831SNamhyung Kim 	int				idx;   /* for hash table iteration */
6159b9b0c831SNamhyung Kim 	enum graph_filter_type		type;
6160b9b0c831SNamhyung Kim 	struct ftrace_hash		*new_hash;
6161faf982a6SNamhyung Kim 	const struct seq_operations	*seq_ops;
6162e704eff3SSteven Rostedt (VMware) 	struct trace_parser		parser;
6163faf982a6SNamhyung Kim };
6164faf982a6SNamhyung Kim 
6165ea4e2bc4SSteven Rostedt static void *
616685951842SLi Zefan __g_next(struct seq_file *m, loff_t *pos)
6167ea4e2bc4SSteven Rostedt {
6168faf982a6SNamhyung Kim 	struct ftrace_graph_data *fgd = m->private;
6169b9b0c831SNamhyung Kim 	struct ftrace_func_entry *entry = fgd->entry;
6170b9b0c831SNamhyung Kim 	struct hlist_head *head;
6171b9b0c831SNamhyung Kim 	int i, idx = fgd->idx;
6172faf982a6SNamhyung Kim 
6173b9b0c831SNamhyung Kim 	if (*pos >= fgd->hash->count)
6174ea4e2bc4SSteven Rostedt 		return NULL;
6175b9b0c831SNamhyung Kim 
6176b9b0c831SNamhyung Kim 	if (entry) {
6177b9b0c831SNamhyung Kim 		hlist_for_each_entry_continue(entry, hlist) {
6178b9b0c831SNamhyung Kim 			fgd->entry = entry;
6179b9b0c831SNamhyung Kim 			return entry;
6180b9b0c831SNamhyung Kim 		}
6181b9b0c831SNamhyung Kim 
6182b9b0c831SNamhyung Kim 		idx++;
6183b9b0c831SNamhyung Kim 	}
6184b9b0c831SNamhyung Kim 
6185b9b0c831SNamhyung Kim 	for (i = idx; i < 1 << fgd->hash->size_bits; i++) {
6186b9b0c831SNamhyung Kim 		head = &fgd->hash->buckets[i];
6187b9b0c831SNamhyung Kim 		hlist_for_each_entry(entry, head, hlist) {
6188b9b0c831SNamhyung Kim 			fgd->entry = entry;
6189b9b0c831SNamhyung Kim 			fgd->idx = i;
6190b9b0c831SNamhyung Kim 			return entry;
6191b9b0c831SNamhyung Kim 		}
6192b9b0c831SNamhyung Kim 	}
6193b9b0c831SNamhyung Kim 	return NULL;
619485951842SLi Zefan }
6195ea4e2bc4SSteven Rostedt 
619685951842SLi Zefan static void *
619785951842SLi Zefan g_next(struct seq_file *m, void *v, loff_t *pos)
619885951842SLi Zefan {
619985951842SLi Zefan 	(*pos)++;
620085951842SLi Zefan 	return __g_next(m, pos);
6201ea4e2bc4SSteven Rostedt }
6202ea4e2bc4SSteven Rostedt 
6203ea4e2bc4SSteven Rostedt static void *g_start(struct seq_file *m, loff_t *pos)
6204ea4e2bc4SSteven Rostedt {
6205faf982a6SNamhyung Kim 	struct ftrace_graph_data *fgd = m->private;
6206faf982a6SNamhyung Kim 
6207ea4e2bc4SSteven Rostedt 	mutex_lock(&graph_lock);
6208ea4e2bc4SSteven Rostedt 
6209649b988bSSteven Rostedt (VMware) 	if (fgd->type == GRAPH_FILTER_FUNCTION)
6210649b988bSSteven Rostedt (VMware) 		fgd->hash = rcu_dereference_protected(ftrace_graph_hash,
6211649b988bSSteven Rostedt (VMware) 					lockdep_is_held(&graph_lock));
6212649b988bSSteven Rostedt (VMware) 	else
6213649b988bSSteven Rostedt (VMware) 		fgd->hash = rcu_dereference_protected(ftrace_graph_notrace_hash,
6214649b988bSSteven Rostedt (VMware) 					lockdep_is_held(&graph_lock));
6215649b988bSSteven Rostedt (VMware) 
6216f9349a8fSFrederic Weisbecker 	/* Nothing, tell g_show to print all functions are enabled */
6217b9b0c831SNamhyung Kim 	if (ftrace_hash_empty(fgd->hash) && !*pos)
6218555fc781SSteven Rostedt (VMware) 		return FTRACE_GRAPH_EMPTY;
6219f9349a8fSFrederic Weisbecker 
6220b9b0c831SNamhyung Kim 	fgd->idx = 0;
6221b9b0c831SNamhyung Kim 	fgd->entry = NULL;
622285951842SLi Zefan 	return __g_next(m, pos);
6223ea4e2bc4SSteven Rostedt }
6224ea4e2bc4SSteven Rostedt 
6225ea4e2bc4SSteven Rostedt static void g_stop(struct seq_file *m, void *p)
6226ea4e2bc4SSteven Rostedt {
6227ea4e2bc4SSteven Rostedt 	mutex_unlock(&graph_lock);
6228ea4e2bc4SSteven Rostedt }
6229ea4e2bc4SSteven Rostedt 
6230ea4e2bc4SSteven Rostedt static int g_show(struct seq_file *m, void *v)
6231ea4e2bc4SSteven Rostedt {
6232b9b0c831SNamhyung Kim 	struct ftrace_func_entry *entry = v;
6233ea4e2bc4SSteven Rostedt 
6234b9b0c831SNamhyung Kim 	if (!entry)
6235ea4e2bc4SSteven Rostedt 		return 0;
6236ea4e2bc4SSteven Rostedt 
6237555fc781SSteven Rostedt (VMware) 	if (entry == FTRACE_GRAPH_EMPTY) {
6238280d1429SNamhyung Kim 		struct ftrace_graph_data *fgd = m->private;
6239280d1429SNamhyung Kim 
6240b9b0c831SNamhyung Kim 		if (fgd->type == GRAPH_FILTER_FUNCTION)
6241fa6f0cc7SRasmus Villemoes 			seq_puts(m, "#### all functions enabled ####\n");
6242280d1429SNamhyung Kim 		else
6243fa6f0cc7SRasmus Villemoes 			seq_puts(m, "#### no functions disabled ####\n");
6244f9349a8fSFrederic Weisbecker 		return 0;
6245f9349a8fSFrederic Weisbecker 	}
6246f9349a8fSFrederic Weisbecker 
6247b9b0c831SNamhyung Kim 	seq_printf(m, "%ps\n", (void *)entry->ip);
6248ea4e2bc4SSteven Rostedt 
6249ea4e2bc4SSteven Rostedt 	return 0;
6250ea4e2bc4SSteven Rostedt }
6251ea4e2bc4SSteven Rostedt 
625288e9d34cSJames Morris static const struct seq_operations ftrace_graph_seq_ops = {
6253ea4e2bc4SSteven Rostedt 	.start = g_start,
6254ea4e2bc4SSteven Rostedt 	.next = g_next,
6255ea4e2bc4SSteven Rostedt 	.stop = g_stop,
6256ea4e2bc4SSteven Rostedt 	.show = g_show,
6257ea4e2bc4SSteven Rostedt };
6258ea4e2bc4SSteven Rostedt 
6259ea4e2bc4SSteven Rostedt static int
6260faf982a6SNamhyung Kim __ftrace_graph_open(struct inode *inode, struct file *file,
6261faf982a6SNamhyung Kim 		    struct ftrace_graph_data *fgd)
6262ea4e2bc4SSteven Rostedt {
626317911ff3SSteven Rostedt (VMware) 	int ret;
6264b9b0c831SNamhyung Kim 	struct ftrace_hash *new_hash = NULL;
6265ea4e2bc4SSteven Rostedt 
626617911ff3SSteven Rostedt (VMware) 	ret = security_locked_down(LOCKDOWN_TRACEFS);
626717911ff3SSteven Rostedt (VMware) 	if (ret)
626817911ff3SSteven Rostedt (VMware) 		return ret;
626917911ff3SSteven Rostedt (VMware) 
6270b9b0c831SNamhyung Kim 	if (file->f_mode & FMODE_WRITE) {
6271b9b0c831SNamhyung Kim 		const int size_bits = FTRACE_HASH_DEFAULT_BITS;
6272b9b0c831SNamhyung Kim 
6273e704eff3SSteven Rostedt (VMware) 		if (trace_parser_get_init(&fgd->parser, FTRACE_BUFF_MAX))
6274e704eff3SSteven Rostedt (VMware) 			return -ENOMEM;
6275e704eff3SSteven Rostedt (VMware) 
6276b9b0c831SNamhyung Kim 		if (file->f_flags & O_TRUNC)
6277b9b0c831SNamhyung Kim 			new_hash = alloc_ftrace_hash(size_bits);
6278b9b0c831SNamhyung Kim 		else
6279b9b0c831SNamhyung Kim 			new_hash = alloc_and_copy_ftrace_hash(size_bits,
6280b9b0c831SNamhyung Kim 							      fgd->hash);
6281b9b0c831SNamhyung Kim 		if (!new_hash) {
6282b9b0c831SNamhyung Kim 			ret = -ENOMEM;
6283b9b0c831SNamhyung Kim 			goto out;
6284ea4e2bc4SSteven Rostedt 		}
6285b9b0c831SNamhyung Kim 	}
6286ea4e2bc4SSteven Rostedt 
6287faf982a6SNamhyung Kim 	if (file->f_mode & FMODE_READ) {
6288b9b0c831SNamhyung Kim 		ret = seq_open(file, &ftrace_graph_seq_ops);
6289faf982a6SNamhyung Kim 		if (!ret) {
6290faf982a6SNamhyung Kim 			struct seq_file *m = file->private_data;
6291faf982a6SNamhyung Kim 			m->private = fgd;
6292b9b0c831SNamhyung Kim 		} else {
6293b9b0c831SNamhyung Kim 			/* Failed */
6294b9b0c831SNamhyung Kim 			free_ftrace_hash(new_hash);
6295b9b0c831SNamhyung Kim 			new_hash = NULL;
6296faf982a6SNamhyung Kim 		}
6297faf982a6SNamhyung Kim 	} else
6298faf982a6SNamhyung Kim 		file->private_data = fgd;
6299a4ec5e0cSLi Zefan 
6300b9b0c831SNamhyung Kim out:
6301e704eff3SSteven Rostedt (VMware) 	if (ret < 0 && file->f_mode & FMODE_WRITE)
6302e704eff3SSteven Rostedt (VMware) 		trace_parser_put(&fgd->parser);
6303e704eff3SSteven Rostedt (VMware) 
6304b9b0c831SNamhyung Kim 	fgd->new_hash = new_hash;
6305649b988bSSteven Rostedt (VMware) 
6306649b988bSSteven Rostedt (VMware) 	/*
6307649b988bSSteven Rostedt (VMware) 	 * All uses of fgd->hash must be taken with the graph_lock
6308649b988bSSteven Rostedt (VMware) 	 * held. The graph_lock is going to be released, so force
6309649b988bSSteven Rostedt (VMware) 	 * fgd->hash to be reinitialized when it is taken again.
6310649b988bSSteven Rostedt (VMware) 	 */
6311649b988bSSteven Rostedt (VMware) 	fgd->hash = NULL;
6312649b988bSSteven Rostedt (VMware) 
6313ea4e2bc4SSteven Rostedt 	return ret;
6314ea4e2bc4SSteven Rostedt }
6315ea4e2bc4SSteven Rostedt 
6316ea4e2bc4SSteven Rostedt static int
6317faf982a6SNamhyung Kim ftrace_graph_open(struct inode *inode, struct file *file)
6318faf982a6SNamhyung Kim {
6319faf982a6SNamhyung Kim 	struct ftrace_graph_data *fgd;
6320b9b0c831SNamhyung Kim 	int ret;
6321faf982a6SNamhyung Kim 
6322faf982a6SNamhyung Kim 	if (unlikely(ftrace_disabled))
6323faf982a6SNamhyung Kim 		return -ENODEV;
6324faf982a6SNamhyung Kim 
6325faf982a6SNamhyung Kim 	fgd = kmalloc(sizeof(*fgd), GFP_KERNEL);
6326faf982a6SNamhyung Kim 	if (fgd == NULL)
6327faf982a6SNamhyung Kim 		return -ENOMEM;
6328faf982a6SNamhyung Kim 
6329b9b0c831SNamhyung Kim 	mutex_lock(&graph_lock);
6330b9b0c831SNamhyung Kim 
6331649b988bSSteven Rostedt (VMware) 	fgd->hash = rcu_dereference_protected(ftrace_graph_hash,
6332649b988bSSteven Rostedt (VMware) 					lockdep_is_held(&graph_lock));
6333b9b0c831SNamhyung Kim 	fgd->type = GRAPH_FILTER_FUNCTION;
6334faf982a6SNamhyung Kim 	fgd->seq_ops = &ftrace_graph_seq_ops;
6335faf982a6SNamhyung Kim 
6336b9b0c831SNamhyung Kim 	ret = __ftrace_graph_open(inode, file, fgd);
6337b9b0c831SNamhyung Kim 	if (ret < 0)
6338b9b0c831SNamhyung Kim 		kfree(fgd);
6339b9b0c831SNamhyung Kim 
6340b9b0c831SNamhyung Kim 	mutex_unlock(&graph_lock);
6341b9b0c831SNamhyung Kim 	return ret;
6342faf982a6SNamhyung Kim }
6343faf982a6SNamhyung Kim 
6344faf982a6SNamhyung Kim static int
634529ad23b0SNamhyung Kim ftrace_graph_notrace_open(struct inode *inode, struct file *file)
634629ad23b0SNamhyung Kim {
634729ad23b0SNamhyung Kim 	struct ftrace_graph_data *fgd;
6348b9b0c831SNamhyung Kim 	int ret;
634929ad23b0SNamhyung Kim 
635029ad23b0SNamhyung Kim 	if (unlikely(ftrace_disabled))
635129ad23b0SNamhyung Kim 		return -ENODEV;
635229ad23b0SNamhyung Kim 
635329ad23b0SNamhyung Kim 	fgd = kmalloc(sizeof(*fgd), GFP_KERNEL);
635429ad23b0SNamhyung Kim 	if (fgd == NULL)
635529ad23b0SNamhyung Kim 		return -ENOMEM;
635629ad23b0SNamhyung Kim 
6357b9b0c831SNamhyung Kim 	mutex_lock(&graph_lock);
6358b9b0c831SNamhyung Kim 
6359649b988bSSteven Rostedt (VMware) 	fgd->hash = rcu_dereference_protected(ftrace_graph_notrace_hash,
6360649b988bSSteven Rostedt (VMware) 					lockdep_is_held(&graph_lock));
6361b9b0c831SNamhyung Kim 	fgd->type = GRAPH_FILTER_NOTRACE;
636229ad23b0SNamhyung Kim 	fgd->seq_ops = &ftrace_graph_seq_ops;
636329ad23b0SNamhyung Kim 
6364b9b0c831SNamhyung Kim 	ret = __ftrace_graph_open(inode, file, fgd);
6365b9b0c831SNamhyung Kim 	if (ret < 0)
6366b9b0c831SNamhyung Kim 		kfree(fgd);
6367b9b0c831SNamhyung Kim 
6368b9b0c831SNamhyung Kim 	mutex_unlock(&graph_lock);
6369b9b0c831SNamhyung Kim 	return ret;
637029ad23b0SNamhyung Kim }
637129ad23b0SNamhyung Kim 
637229ad23b0SNamhyung Kim static int
637387827111SLi Zefan ftrace_graph_release(struct inode *inode, struct file *file)
637487827111SLi Zefan {
6375b9b0c831SNamhyung Kim 	struct ftrace_graph_data *fgd;
6376e704eff3SSteven Rostedt (VMware) 	struct ftrace_hash *old_hash, *new_hash;
6377e704eff3SSteven Rostedt (VMware) 	struct trace_parser *parser;
6378e704eff3SSteven Rostedt (VMware) 	int ret = 0;
6379b9b0c831SNamhyung Kim 
6380faf982a6SNamhyung Kim 	if (file->f_mode & FMODE_READ) {
6381faf982a6SNamhyung Kim 		struct seq_file *m = file->private_data;
6382faf982a6SNamhyung Kim 
6383b9b0c831SNamhyung Kim 		fgd = m->private;
638487827111SLi Zefan 		seq_release(inode, file);
6385faf982a6SNamhyung Kim 	} else {
6386b9b0c831SNamhyung Kim 		fgd = file->private_data;
6387faf982a6SNamhyung Kim 	}
6388faf982a6SNamhyung Kim 
6389e704eff3SSteven Rostedt (VMware) 
6390e704eff3SSteven Rostedt (VMware) 	if (file->f_mode & FMODE_WRITE) {
6391e704eff3SSteven Rostedt (VMware) 
6392e704eff3SSteven Rostedt (VMware) 		parser = &fgd->parser;
6393e704eff3SSteven Rostedt (VMware) 
6394e704eff3SSteven Rostedt (VMware) 		if (trace_parser_loaded((parser))) {
6395e704eff3SSteven Rostedt (VMware) 			ret = ftrace_graph_set_hash(fgd->new_hash,
6396e704eff3SSteven Rostedt (VMware) 						    parser->buffer);
6397e704eff3SSteven Rostedt (VMware) 		}
6398e704eff3SSteven Rostedt (VMware) 
6399e704eff3SSteven Rostedt (VMware) 		trace_parser_put(parser);
6400e704eff3SSteven Rostedt (VMware) 
6401e704eff3SSteven Rostedt (VMware) 		new_hash = __ftrace_hash_move(fgd->new_hash);
6402e704eff3SSteven Rostedt (VMware) 		if (!new_hash) {
6403e704eff3SSteven Rostedt (VMware) 			ret = -ENOMEM;
6404e704eff3SSteven Rostedt (VMware) 			goto out;
6405e704eff3SSteven Rostedt (VMware) 		}
6406e704eff3SSteven Rostedt (VMware) 
6407e704eff3SSteven Rostedt (VMware) 		mutex_lock(&graph_lock);
6408e704eff3SSteven Rostedt (VMware) 
6409e704eff3SSteven Rostedt (VMware) 		if (fgd->type == GRAPH_FILTER_FUNCTION) {
6410e704eff3SSteven Rostedt (VMware) 			old_hash = rcu_dereference_protected(ftrace_graph_hash,
6411e704eff3SSteven Rostedt (VMware) 					lockdep_is_held(&graph_lock));
6412e704eff3SSteven Rostedt (VMware) 			rcu_assign_pointer(ftrace_graph_hash, new_hash);
6413e704eff3SSteven Rostedt (VMware) 		} else {
6414e704eff3SSteven Rostedt (VMware) 			old_hash = rcu_dereference_protected(ftrace_graph_notrace_hash,
6415e704eff3SSteven Rostedt (VMware) 					lockdep_is_held(&graph_lock));
6416e704eff3SSteven Rostedt (VMware) 			rcu_assign_pointer(ftrace_graph_notrace_hash, new_hash);
6417e704eff3SSteven Rostedt (VMware) 		}
6418e704eff3SSteven Rostedt (VMware) 
6419e704eff3SSteven Rostedt (VMware) 		mutex_unlock(&graph_lock);
6420e704eff3SSteven Rostedt (VMware) 
642154a16ff6SSteven Rostedt (VMware) 		/*
642254a16ff6SSteven Rostedt (VMware) 		 * We need to do a hard force of sched synchronization.
642354a16ff6SSteven Rostedt (VMware) 		 * This is because we use preempt_disable() to do RCU, but
642454a16ff6SSteven Rostedt (VMware) 		 * the function tracers can be called where RCU is not watching
642554a16ff6SSteven Rostedt (VMware) 		 * (like before user_exit()). We can not rely on the RCU
642654a16ff6SSteven Rostedt (VMware) 		 * infrastructure to do the synchronization, thus we must do it
642754a16ff6SSteven Rostedt (VMware) 		 * ourselves.
642854a16ff6SSteven Rostedt (VMware) 		 */
642968e83498SNicolas Saenz Julienne 		if (old_hash != EMPTY_HASH)
6430e5a971d7SPaul E. McKenney 			synchronize_rcu_tasks_rude();
6431e704eff3SSteven Rostedt (VMware) 
6432e704eff3SSteven Rostedt (VMware) 		free_ftrace_hash(old_hash);
6433e704eff3SSteven Rostedt (VMware) 	}
6434e704eff3SSteven Rostedt (VMware) 
6435e704eff3SSteven Rostedt (VMware)  out:
6436f9797c2fSLuis Henriques 	free_ftrace_hash(fgd->new_hash);
6437b9b0c831SNamhyung Kim 	kfree(fgd);
6438b9b0c831SNamhyung Kim 
6439e704eff3SSteven Rostedt (VMware) 	return ret;
644087827111SLi Zefan }
644187827111SLi Zefan 
644287827111SLi Zefan static int
6443b9b0c831SNamhyung Kim ftrace_graph_set_hash(struct ftrace_hash *hash, char *buffer)
6444ea4e2bc4SSteven Rostedt {
64453ba00929SDmitry Safonov 	struct ftrace_glob func_g;
6446ea4e2bc4SSteven Rostedt 	struct dyn_ftrace *rec;
6447ea4e2bc4SSteven Rostedt 	struct ftrace_page *pg;
6448b9b0c831SNamhyung Kim 	struct ftrace_func_entry *entry;
6449c7c6b1feSLi Zefan 	int fail = 1;
64503ba00929SDmitry Safonov 	int not;
6451ea4e2bc4SSteven Rostedt 
6452f9349a8fSFrederic Weisbecker 	/* decode regex */
64533ba00929SDmitry Safonov 	func_g.type = filter_parse_regex(buffer, strlen(buffer),
64543ba00929SDmitry Safonov 					 &func_g.search, &not);
6455f9349a8fSFrederic Weisbecker 
64563ba00929SDmitry Safonov 	func_g.len = strlen(func_g.search);
6457f9349a8fSFrederic Weisbecker 
645852baf119SSteven Rostedt 	mutex_lock(&ftrace_lock);
645945a4a237SSteven Rostedt 
646045a4a237SSteven Rostedt 	if (unlikely(ftrace_disabled)) {
646145a4a237SSteven Rostedt 		mutex_unlock(&ftrace_lock);
646245a4a237SSteven Rostedt 		return -ENODEV;
646345a4a237SSteven Rostedt 	}
646445a4a237SSteven Rostedt 
6465265c831cSSteven Rostedt 	do_for_each_ftrace_rec(pg, rec) {
6466ea4e2bc4SSteven Rostedt 
6467546fece4SSteven Rostedt (Red Hat) 		if (rec->flags & FTRACE_FL_DISABLED)
6468546fece4SSteven Rostedt (Red Hat) 			continue;
6469546fece4SSteven Rostedt (Red Hat) 
64700b507e1eSDmitry Safonov 		if (ftrace_match_record(rec, &func_g, NULL, 0)) {
6471b9b0c831SNamhyung Kim 			entry = ftrace_lookup_ip(hash, rec->ip);
6472c7c6b1feSLi Zefan 
6473c7c6b1feSLi Zefan 			if (!not) {
6474c7c6b1feSLi Zefan 				fail = 0;
6475b9b0c831SNamhyung Kim 
6476b9b0c831SNamhyung Kim 				if (entry)
6477b9b0c831SNamhyung Kim 					continue;
6478b9b0c831SNamhyung Kim 				if (add_hash_entry(hash, rec->ip) < 0)
6479c7c6b1feSLi Zefan 					goto out;
6480c7c6b1feSLi Zefan 			} else {
6481b9b0c831SNamhyung Kim 				if (entry) {
6482b9b0c831SNamhyung Kim 					free_hash_entry(hash, entry);
6483c7c6b1feSLi Zefan 					fail = 0;
6484c7c6b1feSLi Zefan 				}
6485c7c6b1feSLi Zefan 			}
6486f9349a8fSFrederic Weisbecker 		}
6487265c831cSSteven Rostedt 	} while_for_each_ftrace_rec();
6488c7c6b1feSLi Zefan out:
648952baf119SSteven Rostedt 	mutex_unlock(&ftrace_lock);
6490ea4e2bc4SSteven Rostedt 
6491c7c6b1feSLi Zefan 	if (fail)
6492c7c6b1feSLi Zefan 		return -EINVAL;
6493c7c6b1feSLi Zefan 
6494c7c6b1feSLi Zefan 	return 0;
6495ea4e2bc4SSteven Rostedt }
6496ea4e2bc4SSteven Rostedt 
6497ea4e2bc4SSteven Rostedt static ssize_t
6498ea4e2bc4SSteven Rostedt ftrace_graph_write(struct file *file, const char __user *ubuf,
6499ea4e2bc4SSteven Rostedt 		   size_t cnt, loff_t *ppos)
6500ea4e2bc4SSteven Rostedt {
65016a10108bSNamhyung Kim 	ssize_t read, ret = 0;
6502faf982a6SNamhyung Kim 	struct ftrace_graph_data *fgd = file->private_data;
6503e704eff3SSteven Rostedt (VMware) 	struct trace_parser *parser;
6504ea4e2bc4SSteven Rostedt 
6505c7c6b1feSLi Zefan 	if (!cnt)
6506ea4e2bc4SSteven Rostedt 		return 0;
6507ea4e2bc4SSteven Rostedt 
6508ae98d27aSSteven Rostedt (VMware) 	/* Read mode uses seq functions */
6509ae98d27aSSteven Rostedt (VMware) 	if (file->f_mode & FMODE_READ) {
6510ae98d27aSSteven Rostedt (VMware) 		struct seq_file *m = file->private_data;
6511ae98d27aSSteven Rostedt (VMware) 		fgd = m->private;
6512ae98d27aSSteven Rostedt (VMware) 	}
6513ae98d27aSSteven Rostedt (VMware) 
6514e704eff3SSteven Rostedt (VMware) 	parser = &fgd->parser;
6515689fd8b6S[email protected] 
6516e704eff3SSteven Rostedt (VMware) 	read = trace_get_user(parser, ubuf, cnt, ppos);
6517ea4e2bc4SSteven Rostedt 
6518e704eff3SSteven Rostedt (VMware) 	if (read >= 0 && trace_parser_loaded(parser) &&
6519e704eff3SSteven Rostedt (VMware) 	    !trace_parser_cont(parser)) {
65206a10108bSNamhyung Kim 
6521b9b0c831SNamhyung Kim 		ret = ftrace_graph_set_hash(fgd->new_hash,
6522e704eff3SSteven Rostedt (VMware) 					    parser->buffer);
6523e704eff3SSteven Rostedt (VMware) 		trace_parser_clear(parser);
6524689fd8b6S[email protected] 	}
6525ea4e2bc4SSteven Rostedt 
65266a10108bSNamhyung Kim 	if (!ret)
6527ea4e2bc4SSteven Rostedt 		ret = read;
65281eb90f13SLi Zefan 
6529ea4e2bc4SSteven Rostedt 	return ret;
6530ea4e2bc4SSteven Rostedt }
6531ea4e2bc4SSteven Rostedt 
6532ea4e2bc4SSteven Rostedt static const struct file_operations ftrace_graph_fops = {
6533ea4e2bc4SSteven Rostedt 	.open		= ftrace_graph_open,
6534850a80cfSLai Jiangshan 	.read		= seq_read,
6535ea4e2bc4SSteven Rostedt 	.write		= ftrace_graph_write,
6536098c879eSSteven Rostedt (Red Hat) 	.llseek		= tracing_lseek,
653787827111SLi Zefan 	.release	= ftrace_graph_release,
6538ea4e2bc4SSteven Rostedt };
653929ad23b0SNamhyung Kim 
654029ad23b0SNamhyung Kim static const struct file_operations ftrace_graph_notrace_fops = {
654129ad23b0SNamhyung Kim 	.open		= ftrace_graph_notrace_open,
654229ad23b0SNamhyung Kim 	.read		= seq_read,
654329ad23b0SNamhyung Kim 	.write		= ftrace_graph_write,
6544098c879eSSteven Rostedt (Red Hat) 	.llseek		= tracing_lseek,
654529ad23b0SNamhyung Kim 	.release	= ftrace_graph_release,
654629ad23b0SNamhyung Kim };
6547ea4e2bc4SSteven Rostedt #endif /* CONFIG_FUNCTION_GRAPH_TRACER */
6548ea4e2bc4SSteven Rostedt 
6549591dffdaSSteven Rostedt (Red Hat) void ftrace_create_filter_files(struct ftrace_ops *ops,
6550591dffdaSSteven Rostedt (Red Hat) 				struct dentry *parent)
6551591dffdaSSteven Rostedt (Red Hat) {
6552591dffdaSSteven Rostedt (Red Hat) 
655321ccc9cdSSteven Rostedt (VMware) 	trace_create_file("set_ftrace_filter", TRACE_MODE_WRITE, parent,
6554591dffdaSSteven Rostedt (Red Hat) 			  ops, &ftrace_filter_fops);
6555591dffdaSSteven Rostedt (Red Hat) 
655621ccc9cdSSteven Rostedt (VMware) 	trace_create_file("set_ftrace_notrace", TRACE_MODE_WRITE, parent,
6557591dffdaSSteven Rostedt (Red Hat) 			  ops, &ftrace_notrace_fops);
6558591dffdaSSteven Rostedt (Red Hat) }
6559591dffdaSSteven Rostedt (Red Hat) 
6560591dffdaSSteven Rostedt (Red Hat) /*
6561591dffdaSSteven Rostedt (Red Hat)  * The name "destroy_filter_files" is really a misnomer. Although
65629efb85c5SHariprasad Kelam  * in the future, it may actually delete the files, but this is
6563591dffdaSSteven Rostedt (Red Hat)  * really intended to make sure the ops passed in are disabled
6564591dffdaSSteven Rostedt (Red Hat)  * and that when this function returns, the caller is free to
6565591dffdaSSteven Rostedt (Red Hat)  * free the ops.
6566591dffdaSSteven Rostedt (Red Hat)  *
6567591dffdaSSteven Rostedt (Red Hat)  * The "destroy" name is only to match the "create" name that this
6568591dffdaSSteven Rostedt (Red Hat)  * should be paired with.
6569591dffdaSSteven Rostedt (Red Hat)  */
6570591dffdaSSteven Rostedt (Red Hat) void ftrace_destroy_filter_files(struct ftrace_ops *ops)
6571591dffdaSSteven Rostedt (Red Hat) {
6572591dffdaSSteven Rostedt (Red Hat) 	mutex_lock(&ftrace_lock);
6573591dffdaSSteven Rostedt (Red Hat) 	if (ops->flags & FTRACE_OPS_FL_ENABLED)
6574591dffdaSSteven Rostedt (Red Hat) 		ftrace_shutdown(ops, 0);
6575591dffdaSSteven Rostedt (Red Hat) 	ops->flags |= FTRACE_OPS_FL_DELETED;
65762840f84fSSteven Rostedt (VMware) 	ftrace_free_filter(ops);
6577591dffdaSSteven Rostedt (Red Hat) 	mutex_unlock(&ftrace_lock);
6578591dffdaSSteven Rostedt (Red Hat) }
6579591dffdaSSteven Rostedt (Red Hat) 
65808434dc93SSteven Rostedt (Red Hat) static __init int ftrace_init_dyn_tracefs(struct dentry *d_tracer)
65815072c59fSSteven Rostedt {
65825072c59fSSteven Rostedt 
658321ccc9cdSSteven Rostedt (VMware) 	trace_create_file("available_filter_functions", TRACE_MODE_READ,
65845072c59fSSteven Rostedt 			d_tracer, NULL, &ftrace_avail_fops);
65855072c59fSSteven Rostedt 
658621ccc9cdSSteven Rostedt (VMware) 	trace_create_file("enabled_functions", TRACE_MODE_READ,
6587647bcd03SSteven Rostedt 			d_tracer, NULL, &ftrace_enabled_fops);
6588647bcd03SSteven Rostedt 
6589591dffdaSSteven Rostedt (Red Hat) 	ftrace_create_filter_files(&global_ops, d_tracer);
6590ad90c0e3SSteven Rostedt 
6591ea4e2bc4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
659221ccc9cdSSteven Rostedt (VMware) 	trace_create_file("set_graph_function", TRACE_MODE_WRITE, d_tracer,
6593ea4e2bc4SSteven Rostedt 				    NULL,
6594ea4e2bc4SSteven Rostedt 				    &ftrace_graph_fops);
659521ccc9cdSSteven Rostedt (VMware) 	trace_create_file("set_graph_notrace", TRACE_MODE_WRITE, d_tracer,
659629ad23b0SNamhyung Kim 				    NULL,
659729ad23b0SNamhyung Kim 				    &ftrace_graph_notrace_fops);
6598ea4e2bc4SSteven Rostedt #endif /* CONFIG_FUNCTION_GRAPH_TRACER */
6599ea4e2bc4SSteven Rostedt 
66005072c59fSSteven Rostedt 	return 0;
66015072c59fSSteven Rostedt }
66025072c59fSSteven Rostedt 
66039fd49328SSteven Rostedt static int ftrace_cmp_ips(const void *a, const void *b)
660468950619SSteven Rostedt {
66059fd49328SSteven Rostedt 	const unsigned long *ipa = a;
66069fd49328SSteven Rostedt 	const unsigned long *ipb = b;
660768950619SSteven Rostedt 
66089fd49328SSteven Rostedt 	if (*ipa > *ipb)
66099fd49328SSteven Rostedt 		return 1;
66109fd49328SSteven Rostedt 	if (*ipa < *ipb)
66119fd49328SSteven Rostedt 		return -1;
66129fd49328SSteven Rostedt 	return 0;
66139fd49328SSteven Rostedt }
66149fd49328SSteven Rostedt 
66158147dc78SSteven Rostedt (VMware) #ifdef CONFIG_FTRACE_SORT_STARTUP_TEST
66168147dc78SSteven Rostedt (VMware) static void test_is_sorted(unsigned long *start, unsigned long count)
66178147dc78SSteven Rostedt (VMware) {
66188147dc78SSteven Rostedt (VMware) 	int i;
66198147dc78SSteven Rostedt (VMware) 
66208147dc78SSteven Rostedt (VMware) 	for (i = 1; i < count; i++) {
66218147dc78SSteven Rostedt (VMware) 		if (WARN(start[i - 1] > start[i],
66228147dc78SSteven Rostedt (VMware) 			 "[%d] %pS at %lx is not sorted with %pS at %lx\n", i,
66238147dc78SSteven Rostedt (VMware) 			 (void *)start[i - 1], start[i - 1],
66248147dc78SSteven Rostedt (VMware) 			 (void *)start[i], start[i]))
66258147dc78SSteven Rostedt (VMware) 			break;
66268147dc78SSteven Rostedt (VMware) 	}
66278147dc78SSteven Rostedt (VMware) 	if (i == count)
66288147dc78SSteven Rostedt (VMware) 		pr_info("ftrace section at %px sorted properly\n", start);
66298147dc78SSteven Rostedt (VMware) }
66308147dc78SSteven Rostedt (VMware) #else
66318147dc78SSteven Rostedt (VMware) static void test_is_sorted(unsigned long *start, unsigned long count)
66328147dc78SSteven Rostedt (VMware) {
66338147dc78SSteven Rostedt (VMware) }
66348147dc78SSteven Rostedt (VMware) #endif
66358147dc78SSteven Rostedt (VMware) 
66365cb084bbSJiri Olsa static int ftrace_process_locs(struct module *mod,
663731e88909SSteven Rostedt 			       unsigned long *start,
663868bf21aaSSteven Rostedt 			       unsigned long *end)
663968bf21aaSSteven Rostedt {
6640706c81f8SSteven Rostedt 	struct ftrace_page *start_pg;
6641a7900875SSteven Rostedt 	struct ftrace_page *pg;
6642706c81f8SSteven Rostedt 	struct dyn_ftrace *rec;
6643a7900875SSteven Rostedt 	unsigned long count;
664468bf21aaSSteven Rostedt 	unsigned long *p;
664568bf21aaSSteven Rostedt 	unsigned long addr;
66464376cac6SSteven Rostedt 	unsigned long flags = 0; /* Shut up gcc */
6647a7900875SSteven Rostedt 	int ret = -ENOMEM;
6648a7900875SSteven Rostedt 
6649a7900875SSteven Rostedt 	count = end - start;
6650a7900875SSteven Rostedt 
6651a7900875SSteven Rostedt 	if (!count)
6652a7900875SSteven Rostedt 		return 0;
6653a7900875SSteven Rostedt 
665472b3942aSYinan Liu 	/*
665572b3942aSYinan Liu 	 * Sorting mcount in vmlinux at build time depend on
66566b9b6413SSteven Rostedt (Google) 	 * CONFIG_BUILDTIME_MCOUNT_SORT, while mcount loc in
665772b3942aSYinan Liu 	 * modules can not be sorted at build time.
665872b3942aSYinan Liu 	 */
66596b9b6413SSteven Rostedt (Google) 	if (!IS_ENABLED(CONFIG_BUILDTIME_MCOUNT_SORT) || mod) {
66609fd49328SSteven Rostedt 		sort(start, count, sizeof(*start),
66616db02903SRasmus Villemoes 		     ftrace_cmp_ips, NULL);
66628147dc78SSteven Rostedt (VMware) 	} else {
66638147dc78SSteven Rostedt (VMware) 		test_is_sorted(start, count);
666472b3942aSYinan Liu 	}
66659fd49328SSteven Rostedt 
6666706c81f8SSteven Rostedt 	start_pg = ftrace_allocate_pages(count);
6667706c81f8SSteven Rostedt 	if (!start_pg)
6668a7900875SSteven Rostedt 		return -ENOMEM;
666968bf21aaSSteven Rostedt 
6670e6ea44e9SSteven Rostedt 	mutex_lock(&ftrace_lock);
6671a7900875SSteven Rostedt 
667232082309SSteven Rostedt 	/*
667332082309SSteven Rostedt 	 * Core and each module needs their own pages, as
667432082309SSteven Rostedt 	 * modules will free them when they are removed.
667532082309SSteven Rostedt 	 * Force a new page to be allocated for modules.
667632082309SSteven Rostedt 	 */
6677a7900875SSteven Rostedt 	if (!mod) {
6678a7900875SSteven Rostedt 		WARN_ON(ftrace_pages || ftrace_pages_start);
6679a7900875SSteven Rostedt 		/* First initialization */
6680706c81f8SSteven Rostedt 		ftrace_pages = ftrace_pages_start = start_pg;
6681a7900875SSteven Rostedt 	} else {
668232082309SSteven Rostedt 		if (!ftrace_pages)
6683a7900875SSteven Rostedt 			goto out;
668432082309SSteven Rostedt 
6685a7900875SSteven Rostedt 		if (WARN_ON(ftrace_pages->next)) {
6686a7900875SSteven Rostedt 			/* Hmm, we have free pages? */
6687a7900875SSteven Rostedt 			while (ftrace_pages->next)
668832082309SSteven Rostedt 				ftrace_pages = ftrace_pages->next;
668932082309SSteven Rostedt 		}
6690a7900875SSteven Rostedt 
6691706c81f8SSteven Rostedt 		ftrace_pages->next = start_pg;
669232082309SSteven Rostedt 	}
669332082309SSteven Rostedt 
669468bf21aaSSteven Rostedt 	p = start;
6695706c81f8SSteven Rostedt 	pg = start_pg;
669668bf21aaSSteven Rostedt 	while (p < end) {
6697db42523bSLinus Torvalds 		unsigned long end_offset;
669868bf21aaSSteven Rostedt 		addr = ftrace_call_adjust(*p++);
669920e5227eSSteven Rostedt 		/*
670020e5227eSSteven Rostedt 		 * Some architecture linkers will pad between
670120e5227eSSteven Rostedt 		 * the different mcount_loc sections of different
670220e5227eSSteven Rostedt 		 * object files to satisfy alignments.
670320e5227eSSteven Rostedt 		 * Skip any NULL pointers.
670420e5227eSSteven Rostedt 		 */
670520e5227eSSteven Rostedt 		if (!addr)
670620e5227eSSteven Rostedt 			continue;
6707706c81f8SSteven Rostedt 
6708db42523bSLinus Torvalds 		end_offset = (pg->index+1) * sizeof(pg->records[0]);
6709db42523bSLinus Torvalds 		if (end_offset > PAGE_SIZE << pg->order) {
6710706c81f8SSteven Rostedt 			/* We should have allocated enough */
6711706c81f8SSteven Rostedt 			if (WARN_ON(!pg->next))
6712a7900875SSteven Rostedt 				break;
6713706c81f8SSteven Rostedt 			pg = pg->next;
671468bf21aaSSteven Rostedt 		}
671568bf21aaSSteven Rostedt 
6716706c81f8SSteven Rostedt 		rec = &pg->records[pg->index++];
6717706c81f8SSteven Rostedt 		rec->ip = addr;
6718706c81f8SSteven Rostedt 	}
6719706c81f8SSteven Rostedt 
6720706c81f8SSteven Rostedt 	/* We should have used all pages */
6721706c81f8SSteven Rostedt 	WARN_ON(pg->next);
6722706c81f8SSteven Rostedt 
6723706c81f8SSteven Rostedt 	/* Assign the last page to ftrace_pages */
6724706c81f8SSteven Rostedt 	ftrace_pages = pg;
6725706c81f8SSteven Rostedt 
6726a4f18ed1SSteven Rostedt 	/*
67274376cac6SSteven Rostedt 	 * We only need to disable interrupts on start up
67284376cac6SSteven Rostedt 	 * because we are modifying code that an interrupt
67294376cac6SSteven Rostedt 	 * may execute, and the modification is not atomic.
67304376cac6SSteven Rostedt 	 * But for modules, nothing runs the code we modify
67314376cac6SSteven Rostedt 	 * until we are finished with it, and there's no
67324376cac6SSteven Rostedt 	 * reason to cause large interrupt latencies while we do it.
6733a4f18ed1SSteven Rostedt 	 */
67344376cac6SSteven Rostedt 	if (!mod)
6735a4f18ed1SSteven Rostedt 		local_irq_save(flags);
67361dc43cf0SJiri Slaby 	ftrace_update_code(mod, start_pg);
67374376cac6SSteven Rostedt 	if (!mod)
6738a4f18ed1SSteven Rostedt 		local_irq_restore(flags);
6739a7900875SSteven Rostedt 	ret = 0;
6740a7900875SSteven Rostedt  out:
6741e6ea44e9SSteven Rostedt 	mutex_unlock(&ftrace_lock);
674268bf21aaSSteven Rostedt 
6743a7900875SSteven Rostedt 	return ret;
674468bf21aaSSteven Rostedt }
674568bf21aaSSteven Rostedt 
6746aba4b5c2SSteven Rostedt (VMware) struct ftrace_mod_func {
6747aba4b5c2SSteven Rostedt (VMware) 	struct list_head	list;
6748aba4b5c2SSteven Rostedt (VMware) 	char			*name;
6749aba4b5c2SSteven Rostedt (VMware) 	unsigned long		ip;
6750aba4b5c2SSteven Rostedt (VMware) 	unsigned int		size;
6751aba4b5c2SSteven Rostedt (VMware) };
6752aba4b5c2SSteven Rostedt (VMware) 
6753aba4b5c2SSteven Rostedt (VMware) struct ftrace_mod_map {
67546aa69784SSteven Rostedt (VMware) 	struct rcu_head		rcu;
6755aba4b5c2SSteven Rostedt (VMware) 	struct list_head	list;
6756aba4b5c2SSteven Rostedt (VMware) 	struct module		*mod;
6757aba4b5c2SSteven Rostedt (VMware) 	unsigned long		start_addr;
6758aba4b5c2SSteven Rostedt (VMware) 	unsigned long		end_addr;
6759aba4b5c2SSteven Rostedt (VMware) 	struct list_head	funcs;
67606171a031SSteven Rostedt (VMware) 	unsigned int		num_funcs;
6761aba4b5c2SSteven Rostedt (VMware) };
6762aba4b5c2SSteven Rostedt (VMware) 
6763fc0ea795SAdrian Hunter static int ftrace_get_trampoline_kallsym(unsigned int symnum,
6764fc0ea795SAdrian Hunter 					 unsigned long *value, char *type,
6765fc0ea795SAdrian Hunter 					 char *name, char *module_name,
6766fc0ea795SAdrian Hunter 					 int *exported)
6767fc0ea795SAdrian Hunter {
6768fc0ea795SAdrian Hunter 	struct ftrace_ops *op;
6769fc0ea795SAdrian Hunter 
6770fc0ea795SAdrian Hunter 	list_for_each_entry_rcu(op, &ftrace_ops_trampoline_list, list) {
6771fc0ea795SAdrian Hunter 		if (!op->trampoline || symnum--)
6772fc0ea795SAdrian Hunter 			continue;
6773fc0ea795SAdrian Hunter 		*value = op->trampoline;
6774fc0ea795SAdrian Hunter 		*type = 't';
6775fc0ea795SAdrian Hunter 		strlcpy(name, FTRACE_TRAMPOLINE_SYM, KSYM_NAME_LEN);
6776fc0ea795SAdrian Hunter 		strlcpy(module_name, FTRACE_TRAMPOLINE_MOD, MODULE_NAME_LEN);
6777fc0ea795SAdrian Hunter 		*exported = 0;
6778fc0ea795SAdrian Hunter 		return 0;
6779fc0ea795SAdrian Hunter 	}
6780fc0ea795SAdrian Hunter 
6781fc0ea795SAdrian Hunter 	return -ERANGE;
6782fc0ea795SAdrian Hunter }
6783fc0ea795SAdrian Hunter 
6784123d6455SWang Jingjin #if defined(CONFIG_DYNAMIC_FTRACE_WITH_DIRECT_CALLS) || defined(CONFIG_MODULES)
6785123d6455SWang Jingjin /*
6786123d6455SWang Jingjin  * Check if the current ops references the given ip.
6787123d6455SWang Jingjin  *
6788123d6455SWang Jingjin  * If the ops traces all functions, then it was already accounted for.
6789123d6455SWang Jingjin  * If the ops does not trace the current record function, skip it.
6790123d6455SWang Jingjin  * If the ops ignores the function via notrace filter, skip it.
6791123d6455SWang Jingjin  */
6792123d6455SWang Jingjin static bool
6793123d6455SWang Jingjin ops_references_ip(struct ftrace_ops *ops, unsigned long ip)
6794123d6455SWang Jingjin {
6795123d6455SWang Jingjin 	/* If ops isn't enabled, ignore it */
6796123d6455SWang Jingjin 	if (!(ops->flags & FTRACE_OPS_FL_ENABLED))
6797123d6455SWang Jingjin 		return false;
6798123d6455SWang Jingjin 
6799123d6455SWang Jingjin 	/* If ops traces all then it includes this function */
6800123d6455SWang Jingjin 	if (ops_traces_mod(ops))
6801123d6455SWang Jingjin 		return true;
6802123d6455SWang Jingjin 
6803123d6455SWang Jingjin 	/* The function must be in the filter */
6804123d6455SWang Jingjin 	if (!ftrace_hash_empty(ops->func_hash->filter_hash) &&
6805123d6455SWang Jingjin 	    !__ftrace_lookup_ip(ops->func_hash->filter_hash, ip))
6806123d6455SWang Jingjin 		return false;
6807123d6455SWang Jingjin 
6808123d6455SWang Jingjin 	/* If in notrace hash, we ignore it too */
6809123d6455SWang Jingjin 	if (ftrace_lookup_ip(ops->func_hash->notrace_hash, ip))
6810123d6455SWang Jingjin 		return false;
6811123d6455SWang Jingjin 
6812123d6455SWang Jingjin 	return true;
6813123d6455SWang Jingjin }
6814123d6455SWang Jingjin #endif
6815123d6455SWang Jingjin 
681693eb677dSSteven Rostedt #ifdef CONFIG_MODULES
681732082309SSteven Rostedt 
681832082309SSteven Rostedt #define next_to_ftrace_page(p) container_of(p, struct ftrace_page, next)
681932082309SSteven Rostedt 
68206aa69784SSteven Rostedt (VMware) static LIST_HEAD(ftrace_mod_maps);
68216aa69784SSteven Rostedt (VMware) 
6822b7ffffbbSSteven Rostedt (Red Hat) static int referenced_filters(struct dyn_ftrace *rec)
6823b7ffffbbSSteven Rostedt (Red Hat) {
6824b7ffffbbSSteven Rostedt (Red Hat) 	struct ftrace_ops *ops;
6825b7ffffbbSSteven Rostedt (Red Hat) 	int cnt = 0;
6826b7ffffbbSSteven Rostedt (Red Hat) 
6827b7ffffbbSSteven Rostedt (Red Hat) 	for (ops = ftrace_ops_list; ops != &ftrace_list_end; ops = ops->next) {
6828123d6455SWang Jingjin 		if (ops_references_ip(ops, rec->ip)) {
6829c5f51572SChengming Zhou 			if (WARN_ON_ONCE(ops->flags & FTRACE_OPS_FL_DIRECT))
6830c5f51572SChengming Zhou 				continue;
6831c5f51572SChengming Zhou 			if (WARN_ON_ONCE(ops->flags & FTRACE_OPS_FL_IPMODIFY))
6832c5f51572SChengming Zhou 				continue;
6833b7ffffbbSSteven Rostedt (Red Hat) 			cnt++;
68348a224ffbSChengming Zhou 			if (ops->flags & FTRACE_OPS_FL_SAVE_REGS)
68358a224ffbSChengming Zhou 				rec->flags |= FTRACE_FL_REGS;
6836c5f51572SChengming Zhou 			if (cnt == 1 && ops->trampoline)
6837c5f51572SChengming Zhou 				rec->flags |= FTRACE_FL_TRAMP;
6838c5f51572SChengming Zhou 			else
6839c5f51572SChengming Zhou 				rec->flags &= ~FTRACE_FL_TRAMP;
68408a224ffbSChengming Zhou 		}
6841b7ffffbbSSteven Rostedt (Red Hat) 	}
6842b7ffffbbSSteven Rostedt (Red Hat) 
6843b7ffffbbSSteven Rostedt (Red Hat) 	return cnt;
6844b7ffffbbSSteven Rostedt (Red Hat) }
6845b7ffffbbSSteven Rostedt (Red Hat) 
68462a5bfe47SSteven Rostedt (VMware) static void
68472a5bfe47SSteven Rostedt (VMware) clear_mod_from_hash(struct ftrace_page *pg, struct ftrace_hash *hash)
68482a5bfe47SSteven Rostedt (VMware) {
68492a5bfe47SSteven Rostedt (VMware) 	struct ftrace_func_entry *entry;
68502a5bfe47SSteven Rostedt (VMware) 	struct dyn_ftrace *rec;
68512a5bfe47SSteven Rostedt (VMware) 	int i;
68522a5bfe47SSteven Rostedt (VMware) 
68532a5bfe47SSteven Rostedt (VMware) 	if (ftrace_hash_empty(hash))
68542a5bfe47SSteven Rostedt (VMware) 		return;
68552a5bfe47SSteven Rostedt (VMware) 
68562a5bfe47SSteven Rostedt (VMware) 	for (i = 0; i < pg->index; i++) {
68572a5bfe47SSteven Rostedt (VMware) 		rec = &pg->records[i];
68582a5bfe47SSteven Rostedt (VMware) 		entry = __ftrace_lookup_ip(hash, rec->ip);
68592a5bfe47SSteven Rostedt (VMware) 		/*
68602a5bfe47SSteven Rostedt (VMware) 		 * Do not allow this rec to match again.
68612a5bfe47SSteven Rostedt (VMware) 		 * Yeah, it may waste some memory, but will be removed
68622a5bfe47SSteven Rostedt (VMware) 		 * if/when the hash is modified again.
68632a5bfe47SSteven Rostedt (VMware) 		 */
68642a5bfe47SSteven Rostedt (VMware) 		if (entry)
68652a5bfe47SSteven Rostedt (VMware) 			entry->ip = 0;
68662a5bfe47SSteven Rostedt (VMware) 	}
68672a5bfe47SSteven Rostedt (VMware) }
68682a5bfe47SSteven Rostedt (VMware) 
6869f2cc020dSIngo Molnar /* Clear any records from hashes */
68702a5bfe47SSteven Rostedt (VMware) static void clear_mod_from_hashes(struct ftrace_page *pg)
68712a5bfe47SSteven Rostedt (VMware) {
68722a5bfe47SSteven Rostedt (VMware) 	struct trace_array *tr;
68732a5bfe47SSteven Rostedt (VMware) 
68742a5bfe47SSteven Rostedt (VMware) 	mutex_lock(&trace_types_lock);
68752a5bfe47SSteven Rostedt (VMware) 	list_for_each_entry(tr, &ftrace_trace_arrays, list) {
68762a5bfe47SSteven Rostedt (VMware) 		if (!tr->ops || !tr->ops->func_hash)
68772a5bfe47SSteven Rostedt (VMware) 			continue;
68782a5bfe47SSteven Rostedt (VMware) 		mutex_lock(&tr->ops->func_hash->regex_lock);
68792a5bfe47SSteven Rostedt (VMware) 		clear_mod_from_hash(pg, tr->ops->func_hash->filter_hash);
68802a5bfe47SSteven Rostedt (VMware) 		clear_mod_from_hash(pg, tr->ops->func_hash->notrace_hash);
68812a5bfe47SSteven Rostedt (VMware) 		mutex_unlock(&tr->ops->func_hash->regex_lock);
68822a5bfe47SSteven Rostedt (VMware) 	}
68832a5bfe47SSteven Rostedt (VMware) 	mutex_unlock(&trace_types_lock);
68842a5bfe47SSteven Rostedt (VMware) }
68852a5bfe47SSteven Rostedt (VMware) 
68866aa69784SSteven Rostedt (VMware) static void ftrace_free_mod_map(struct rcu_head *rcu)
68876aa69784SSteven Rostedt (VMware) {
68886aa69784SSteven Rostedt (VMware) 	struct ftrace_mod_map *mod_map = container_of(rcu, struct ftrace_mod_map, rcu);
68896aa69784SSteven Rostedt (VMware) 	struct ftrace_mod_func *mod_func;
68906aa69784SSteven Rostedt (VMware) 	struct ftrace_mod_func *n;
68916aa69784SSteven Rostedt (VMware) 
68926aa69784SSteven Rostedt (VMware) 	/* All the contents of mod_map are now not visible to readers */
68936aa69784SSteven Rostedt (VMware) 	list_for_each_entry_safe(mod_func, n, &mod_map->funcs, list) {
68946aa69784SSteven Rostedt (VMware) 		kfree(mod_func->name);
68956aa69784SSteven Rostedt (VMware) 		list_del(&mod_func->list);
68966aa69784SSteven Rostedt (VMware) 		kfree(mod_func);
68976aa69784SSteven Rostedt (VMware) 	}
68986aa69784SSteven Rostedt (VMware) 
68996aa69784SSteven Rostedt (VMware) 	kfree(mod_map);
69006aa69784SSteven Rostedt (VMware) }
69016aa69784SSteven Rostedt (VMware) 
6902e7247a15S[email protected] void ftrace_release_mod(struct module *mod)
690393eb677dSSteven Rostedt {
69046aa69784SSteven Rostedt (VMware) 	struct ftrace_mod_map *mod_map;
69056aa69784SSteven Rostedt (VMware) 	struct ftrace_mod_map *n;
690693eb677dSSteven Rostedt 	struct dyn_ftrace *rec;
690732082309SSteven Rostedt 	struct ftrace_page **last_pg;
69082a5bfe47SSteven Rostedt (VMware) 	struct ftrace_page *tmp_page = NULL;
690993eb677dSSteven Rostedt 	struct ftrace_page *pg;
691093eb677dSSteven Rostedt 
691193eb677dSSteven Rostedt 	mutex_lock(&ftrace_lock);
691245a4a237SSteven Rostedt 
691345a4a237SSteven Rostedt 	if (ftrace_disabled)
691445a4a237SSteven Rostedt 		goto out_unlock;
691545a4a237SSteven Rostedt 
69166aa69784SSteven Rostedt (VMware) 	list_for_each_entry_safe(mod_map, n, &ftrace_mod_maps, list) {
69176aa69784SSteven Rostedt (VMware) 		if (mod_map->mod == mod) {
69186aa69784SSteven Rostedt (VMware) 			list_del_rcu(&mod_map->list);
691974401729SPaul E. McKenney 			call_rcu(&mod_map->rcu, ftrace_free_mod_map);
69206aa69784SSteven Rostedt (VMware) 			break;
69216aa69784SSteven Rostedt (VMware) 		}
69226aa69784SSteven Rostedt (VMware) 	}
69236aa69784SSteven Rostedt (VMware) 
692432082309SSteven Rostedt 	/*
692532082309SSteven Rostedt 	 * Each module has its own ftrace_pages, remove
692632082309SSteven Rostedt 	 * them from the list.
692732082309SSteven Rostedt 	 */
692832082309SSteven Rostedt 	last_pg = &ftrace_pages_start;
692932082309SSteven Rostedt 	for (pg = ftrace_pages_start; pg; pg = *last_pg) {
693032082309SSteven Rostedt 		rec = &pg->records[0];
69313e234289SSteven Rostedt (VMware) 		if (within_module_core(rec->ip, mod) ||
69323e234289SSteven Rostedt (VMware) 		    within_module_init(rec->ip, mod)) {
693393eb677dSSteven Rostedt 			/*
693432082309SSteven Rostedt 			 * As core pages are first, the first
693532082309SSteven Rostedt 			 * page should never be a module page.
693693eb677dSSteven Rostedt 			 */
693732082309SSteven Rostedt 			if (WARN_ON(pg == ftrace_pages_start))
693832082309SSteven Rostedt 				goto out_unlock;
693932082309SSteven Rostedt 
694032082309SSteven Rostedt 			/* Check if we are deleting the last page */
694132082309SSteven Rostedt 			if (pg == ftrace_pages)
694232082309SSteven Rostedt 				ftrace_pages = next_to_ftrace_page(last_pg);
694332082309SSteven Rostedt 
694483dd1493SSteven Rostedt (VMware) 			ftrace_update_tot_cnt -= pg->index;
694532082309SSteven Rostedt 			*last_pg = pg->next;
69462a5bfe47SSteven Rostedt (VMware) 
69472a5bfe47SSteven Rostedt (VMware) 			pg->next = tmp_page;
69482a5bfe47SSteven Rostedt (VMware) 			tmp_page = pg;
694932082309SSteven Rostedt 		} else
695032082309SSteven Rostedt 			last_pg = &pg->next;
695193eb677dSSteven Rostedt 	}
695245a4a237SSteven Rostedt  out_unlock:
695393eb677dSSteven Rostedt 	mutex_unlock(&ftrace_lock);
69542a5bfe47SSteven Rostedt (VMware) 
69552a5bfe47SSteven Rostedt (VMware) 	for (pg = tmp_page; pg; pg = tmp_page) {
69562a5bfe47SSteven Rostedt (VMware) 
69572a5bfe47SSteven Rostedt (VMware) 		/* Needs to be called outside of ftrace_lock */
69582a5bfe47SSteven Rostedt (VMware) 		clear_mod_from_hashes(pg);
69592a5bfe47SSteven Rostedt (VMware) 
6960db42523bSLinus Torvalds 		if (pg->records) {
6961db42523bSLinus Torvalds 			free_pages((unsigned long)pg->records, pg->order);
6962db42523bSLinus Torvalds 			ftrace_number_of_pages -= 1 << pg->order;
6963db42523bSLinus Torvalds 		}
69642a5bfe47SSteven Rostedt (VMware) 		tmp_page = pg->next;
69652a5bfe47SSteven Rostedt (VMware) 		kfree(pg);
6966da537f0aSSteven Rostedt (VMware) 		ftrace_number_of_groups--;
69672a5bfe47SSteven Rostedt (VMware) 	}
696893eb677dSSteven Rostedt }
696993eb677dSSteven Rostedt 
69707dcd182bSJessica Yu void ftrace_module_enable(struct module *mod)
6971b7ffffbbSSteven Rostedt (Red Hat) {
6972b7ffffbbSSteven Rostedt (Red Hat) 	struct dyn_ftrace *rec;
6973b7ffffbbSSteven Rostedt (Red Hat) 	struct ftrace_page *pg;
6974b7ffffbbSSteven Rostedt (Red Hat) 
6975b7ffffbbSSteven Rostedt (Red Hat) 	mutex_lock(&ftrace_lock);
6976b7ffffbbSSteven Rostedt (Red Hat) 
6977b7ffffbbSSteven Rostedt (Red Hat) 	if (ftrace_disabled)
6978b7ffffbbSSteven Rostedt (Red Hat) 		goto out_unlock;
6979b7ffffbbSSteven Rostedt (Red Hat) 
6980b7ffffbbSSteven Rostedt (Red Hat) 	/*
6981b7ffffbbSSteven Rostedt (Red Hat) 	 * If the tracing is enabled, go ahead and enable the record.
6982b7ffffbbSSteven Rostedt (Red Hat) 	 *
69839efb85c5SHariprasad Kelam 	 * The reason not to enable the record immediately is the
6984b7ffffbbSSteven Rostedt (Red Hat) 	 * inherent check of ftrace_make_nop/ftrace_make_call for
6985b7ffffbbSSteven Rostedt (Red Hat) 	 * correct previous instructions.  Making first the NOP
6986b7ffffbbSSteven Rostedt (Red Hat) 	 * conversion puts the module to the correct state, thus
6987b7ffffbbSSteven Rostedt (Red Hat) 	 * passing the ftrace_make_call check.
6988b7ffffbbSSteven Rostedt (Red Hat) 	 *
6989b7ffffbbSSteven Rostedt (Red Hat) 	 * We also delay this to after the module code already set the
6990b7ffffbbSSteven Rostedt (Red Hat) 	 * text to read-only, as we now need to set it back to read-write
6991b7ffffbbSSteven Rostedt (Red Hat) 	 * so that we can modify the text.
6992b7ffffbbSSteven Rostedt (Red Hat) 	 */
6993b7ffffbbSSteven Rostedt (Red Hat) 	if (ftrace_start_up)
6994b7ffffbbSSteven Rostedt (Red Hat) 		ftrace_arch_code_modify_prepare();
6995b7ffffbbSSteven Rostedt (Red Hat) 
6996b7ffffbbSSteven Rostedt (Red Hat) 	do_for_each_ftrace_rec(pg, rec) {
6997b7ffffbbSSteven Rostedt (Red Hat) 		int cnt;
6998b7ffffbbSSteven Rostedt (Red Hat) 		/*
6999b7ffffbbSSteven Rostedt (Red Hat) 		 * do_for_each_ftrace_rec() is a double loop.
7000b7ffffbbSSteven Rostedt (Red Hat) 		 * module text shares the pg. If a record is
7001b7ffffbbSSteven Rostedt (Red Hat) 		 * not part of this module, then skip this pg,
7002b7ffffbbSSteven Rostedt (Red Hat) 		 * which the "break" will do.
7003b7ffffbbSSteven Rostedt (Red Hat) 		 */
70043e234289SSteven Rostedt (VMware) 		if (!within_module_core(rec->ip, mod) &&
70053e234289SSteven Rostedt (VMware) 		    !within_module_init(rec->ip, mod))
7006b7ffffbbSSteven Rostedt (Red Hat) 			break;
7007b7ffffbbSSteven Rostedt (Red Hat) 
7008b39181f7SSteven Rostedt (Google) 		/* Weak functions should still be ignored */
7009b39181f7SSteven Rostedt (Google) 		if (!test_for_valid_rec(rec)) {
7010b39181f7SSteven Rostedt (Google) 			/* Clear all other flags. Should not be enabled anyway */
7011b39181f7SSteven Rostedt (Google) 			rec->flags = FTRACE_FL_DISABLED;
7012b39181f7SSteven Rostedt (Google) 			continue;
7013b39181f7SSteven Rostedt (Google) 		}
7014b39181f7SSteven Rostedt (Google) 
7015b7ffffbbSSteven Rostedt (Red Hat) 		cnt = 0;
7016b7ffffbbSSteven Rostedt (Red Hat) 
7017b7ffffbbSSteven Rostedt (Red Hat) 		/*
7018b7ffffbbSSteven Rostedt (Red Hat) 		 * When adding a module, we need to check if tracers are
7019b7ffffbbSSteven Rostedt (Red Hat) 		 * currently enabled and if they are, and can trace this record,
7020b7ffffbbSSteven Rostedt (Red Hat) 		 * we need to enable the module functions as well as update the
7021b7ffffbbSSteven Rostedt (Red Hat) 		 * reference counts for those function records.
7022b7ffffbbSSteven Rostedt (Red Hat) 		 */
7023b7ffffbbSSteven Rostedt (Red Hat) 		if (ftrace_start_up)
7024b7ffffbbSSteven Rostedt (Red Hat) 			cnt += referenced_filters(rec);
7025b7ffffbbSSteven Rostedt (Red Hat) 
70268a224ffbSChengming Zhou 		rec->flags &= ~FTRACE_FL_DISABLED;
70278a224ffbSChengming Zhou 		rec->flags += cnt;
7028b7ffffbbSSteven Rostedt (Red Hat) 
7029b7ffffbbSSteven Rostedt (Red Hat) 		if (ftrace_start_up && cnt) {
7030b7ffffbbSSteven Rostedt (Red Hat) 			int failed = __ftrace_replace_code(rec, 1);
7031b7ffffbbSSteven Rostedt (Red Hat) 			if (failed) {
7032b7ffffbbSSteven Rostedt (Red Hat) 				ftrace_bug(failed, rec);
7033b7ffffbbSSteven Rostedt (Red Hat) 				goto out_loop;
7034b7ffffbbSSteven Rostedt (Red Hat) 			}
7035b7ffffbbSSteven Rostedt (Red Hat) 		}
7036b7ffffbbSSteven Rostedt (Red Hat) 
7037b7ffffbbSSteven Rostedt (Red Hat) 	} while_for_each_ftrace_rec();
7038b7ffffbbSSteven Rostedt (Red Hat) 
7039b7ffffbbSSteven Rostedt (Red Hat)  out_loop:
7040b7ffffbbSSteven Rostedt (Red Hat) 	if (ftrace_start_up)
7041b7ffffbbSSteven Rostedt (Red Hat) 		ftrace_arch_code_modify_post_process();
7042b7ffffbbSSteven Rostedt (Red Hat) 
7043b7ffffbbSSteven Rostedt (Red Hat)  out_unlock:
7044b7ffffbbSSteven Rostedt (Red Hat) 	mutex_unlock(&ftrace_lock);
7045d7fbf8dfSSteven Rostedt (VMware) 
7046d7fbf8dfSSteven Rostedt (VMware) 	process_cached_mods(mod->name);
7047b7ffffbbSSteven Rostedt (Red Hat) }
7048b7ffffbbSSteven Rostedt (Red Hat) 
7049a949ae56SSteven Rostedt (Red Hat) void ftrace_module_init(struct module *mod)
705093eb677dSSteven Rostedt {
70512889c658SYuntao Wang 	int ret;
70522889c658SYuntao Wang 
705397e9b4fcSSteven Rostedt (Red Hat) 	if (ftrace_disabled || !mod->num_ftrace_callsites)
7054b6b71f66SAbel Vesa 		return;
7055b6b71f66SAbel Vesa 
70562889c658SYuntao Wang 	ret = ftrace_process_locs(mod, mod->ftrace_callsites,
705797e9b4fcSSteven Rostedt (Red Hat) 				  mod->ftrace_callsites + mod->num_ftrace_callsites);
70582889c658SYuntao Wang 	if (ret)
70592889c658SYuntao Wang 		pr_warn("ftrace: failed to allocate entries for module '%s' functions\n",
70602889c658SYuntao Wang 			mod->name);
706193eb677dSSteven Rostedt }
7062aba4b5c2SSteven Rostedt (VMware) 
7063aba4b5c2SSteven Rostedt (VMware) static void save_ftrace_mod_rec(struct ftrace_mod_map *mod_map,
7064aba4b5c2SSteven Rostedt (VMware) 				struct dyn_ftrace *rec)
7065aba4b5c2SSteven Rostedt (VMware) {
7066aba4b5c2SSteven Rostedt (VMware) 	struct ftrace_mod_func *mod_func;
7067aba4b5c2SSteven Rostedt (VMware) 	unsigned long symsize;
7068aba4b5c2SSteven Rostedt (VMware) 	unsigned long offset;
7069aba4b5c2SSteven Rostedt (VMware) 	char str[KSYM_SYMBOL_LEN];
7070aba4b5c2SSteven Rostedt (VMware) 	char *modname;
7071aba4b5c2SSteven Rostedt (VMware) 	const char *ret;
7072aba4b5c2SSteven Rostedt (VMware) 
7073aba4b5c2SSteven Rostedt (VMware) 	ret = kallsyms_lookup(rec->ip, &symsize, &offset, &modname, str);
7074aba4b5c2SSteven Rostedt (VMware) 	if (!ret)
7075aba4b5c2SSteven Rostedt (VMware) 		return;
7076aba4b5c2SSteven Rostedt (VMware) 
7077aba4b5c2SSteven Rostedt (VMware) 	mod_func = kmalloc(sizeof(*mod_func), GFP_KERNEL);
7078aba4b5c2SSteven Rostedt (VMware) 	if (!mod_func)
7079aba4b5c2SSteven Rostedt (VMware) 		return;
7080aba4b5c2SSteven Rostedt (VMware) 
7081aba4b5c2SSteven Rostedt (VMware) 	mod_func->name = kstrdup(str, GFP_KERNEL);
7082aba4b5c2SSteven Rostedt (VMware) 	if (!mod_func->name) {
7083aba4b5c2SSteven Rostedt (VMware) 		kfree(mod_func);
7084aba4b5c2SSteven Rostedt (VMware) 		return;
7085aba4b5c2SSteven Rostedt (VMware) 	}
7086aba4b5c2SSteven Rostedt (VMware) 
7087aba4b5c2SSteven Rostedt (VMware) 	mod_func->ip = rec->ip - offset;
7088aba4b5c2SSteven Rostedt (VMware) 	mod_func->size = symsize;
7089aba4b5c2SSteven Rostedt (VMware) 
70906171a031SSteven Rostedt (VMware) 	mod_map->num_funcs++;
70916171a031SSteven Rostedt (VMware) 
7092aba4b5c2SSteven Rostedt (VMware) 	list_add_rcu(&mod_func->list, &mod_map->funcs);
7093aba4b5c2SSteven Rostedt (VMware) }
7094aba4b5c2SSteven Rostedt (VMware) 
7095aba4b5c2SSteven Rostedt (VMware) static struct ftrace_mod_map *
7096aba4b5c2SSteven Rostedt (VMware) allocate_ftrace_mod_map(struct module *mod,
7097aba4b5c2SSteven Rostedt (VMware) 			unsigned long start, unsigned long end)
7098aba4b5c2SSteven Rostedt (VMware) {
7099aba4b5c2SSteven Rostedt (VMware) 	struct ftrace_mod_map *mod_map;
7100aba4b5c2SSteven Rostedt (VMware) 
7101aba4b5c2SSteven Rostedt (VMware) 	mod_map = kmalloc(sizeof(*mod_map), GFP_KERNEL);
7102aba4b5c2SSteven Rostedt (VMware) 	if (!mod_map)
7103aba4b5c2SSteven Rostedt (VMware) 		return NULL;
7104aba4b5c2SSteven Rostedt (VMware) 
7105aba4b5c2SSteven Rostedt (VMware) 	mod_map->mod = mod;
7106aba4b5c2SSteven Rostedt (VMware) 	mod_map->start_addr = start;
7107aba4b5c2SSteven Rostedt (VMware) 	mod_map->end_addr = end;
71086171a031SSteven Rostedt (VMware) 	mod_map->num_funcs = 0;
7109aba4b5c2SSteven Rostedt (VMware) 
7110aba4b5c2SSteven Rostedt (VMware) 	INIT_LIST_HEAD_RCU(&mod_map->funcs);
7111aba4b5c2SSteven Rostedt (VMware) 
7112aba4b5c2SSteven Rostedt (VMware) 	list_add_rcu(&mod_map->list, &ftrace_mod_maps);
7113aba4b5c2SSteven Rostedt (VMware) 
7114aba4b5c2SSteven Rostedt (VMware) 	return mod_map;
7115aba4b5c2SSteven Rostedt (VMware) }
7116aba4b5c2SSteven Rostedt (VMware) 
7117aba4b5c2SSteven Rostedt (VMware) static const char *
7118aba4b5c2SSteven Rostedt (VMware) ftrace_func_address_lookup(struct ftrace_mod_map *mod_map,
7119aba4b5c2SSteven Rostedt (VMware) 			   unsigned long addr, unsigned long *size,
7120aba4b5c2SSteven Rostedt (VMware) 			   unsigned long *off, char *sym)
7121aba4b5c2SSteven Rostedt (VMware) {
7122aba4b5c2SSteven Rostedt (VMware) 	struct ftrace_mod_func *found_func =  NULL;
7123aba4b5c2SSteven Rostedt (VMware) 	struct ftrace_mod_func *mod_func;
7124aba4b5c2SSteven Rostedt (VMware) 
7125aba4b5c2SSteven Rostedt (VMware) 	list_for_each_entry_rcu(mod_func, &mod_map->funcs, list) {
7126aba4b5c2SSteven Rostedt (VMware) 		if (addr >= mod_func->ip &&
7127aba4b5c2SSteven Rostedt (VMware) 		    addr < mod_func->ip + mod_func->size) {
7128aba4b5c2SSteven Rostedt (VMware) 			found_func = mod_func;
7129aba4b5c2SSteven Rostedt (VMware) 			break;
7130aba4b5c2SSteven Rostedt (VMware) 		}
7131aba4b5c2SSteven Rostedt (VMware) 	}
7132aba4b5c2SSteven Rostedt (VMware) 
7133aba4b5c2SSteven Rostedt (VMware) 	if (found_func) {
7134aba4b5c2SSteven Rostedt (VMware) 		if (size)
7135aba4b5c2SSteven Rostedt (VMware) 			*size = found_func->size;
7136aba4b5c2SSteven Rostedt (VMware) 		if (off)
7137aba4b5c2SSteven Rostedt (VMware) 			*off = addr - found_func->ip;
7138aba4b5c2SSteven Rostedt (VMware) 		if (sym)
7139aba4b5c2SSteven Rostedt (VMware) 			strlcpy(sym, found_func->name, KSYM_NAME_LEN);
7140aba4b5c2SSteven Rostedt (VMware) 
7141aba4b5c2SSteven Rostedt (VMware) 		return found_func->name;
7142aba4b5c2SSteven Rostedt (VMware) 	}
7143aba4b5c2SSteven Rostedt (VMware) 
7144aba4b5c2SSteven Rostedt (VMware) 	return NULL;
7145aba4b5c2SSteven Rostedt (VMware) }
7146aba4b5c2SSteven Rostedt (VMware) 
7147aba4b5c2SSteven Rostedt (VMware) const char *
7148aba4b5c2SSteven Rostedt (VMware) ftrace_mod_address_lookup(unsigned long addr, unsigned long *size,
7149aba4b5c2SSteven Rostedt (VMware) 		   unsigned long *off, char **modname, char *sym)
7150aba4b5c2SSteven Rostedt (VMware) {
7151aba4b5c2SSteven Rostedt (VMware) 	struct ftrace_mod_map *mod_map;
7152aba4b5c2SSteven Rostedt (VMware) 	const char *ret = NULL;
7153aba4b5c2SSteven Rostedt (VMware) 
715474401729SPaul E. McKenney 	/* mod_map is freed via call_rcu() */
7155aba4b5c2SSteven Rostedt (VMware) 	preempt_disable();
7156aba4b5c2SSteven Rostedt (VMware) 	list_for_each_entry_rcu(mod_map, &ftrace_mod_maps, list) {
7157aba4b5c2SSteven Rostedt (VMware) 		ret = ftrace_func_address_lookup(mod_map, addr, size, off, sym);
7158aba4b5c2SSteven Rostedt (VMware) 		if (ret) {
7159aba4b5c2SSteven Rostedt (VMware) 			if (modname)
7160aba4b5c2SSteven Rostedt (VMware) 				*modname = mod_map->mod->name;
7161aba4b5c2SSteven Rostedt (VMware) 			break;
7162aba4b5c2SSteven Rostedt (VMware) 		}
7163aba4b5c2SSteven Rostedt (VMware) 	}
7164aba4b5c2SSteven Rostedt (VMware) 	preempt_enable();
7165aba4b5c2SSteven Rostedt (VMware) 
7166aba4b5c2SSteven Rostedt (VMware) 	return ret;
7167aba4b5c2SSteven Rostedt (VMware) }
7168aba4b5c2SSteven Rostedt (VMware) 
71696171a031SSteven Rostedt (VMware) int ftrace_mod_get_kallsym(unsigned int symnum, unsigned long *value,
71706171a031SSteven Rostedt (VMware) 			   char *type, char *name,
71716171a031SSteven Rostedt (VMware) 			   char *module_name, int *exported)
71726171a031SSteven Rostedt (VMware) {
71736171a031SSteven Rostedt (VMware) 	struct ftrace_mod_map *mod_map;
71746171a031SSteven Rostedt (VMware) 	struct ftrace_mod_func *mod_func;
7175fc0ea795SAdrian Hunter 	int ret;
71766171a031SSteven Rostedt (VMware) 
71776171a031SSteven Rostedt (VMware) 	preempt_disable();
71786171a031SSteven Rostedt (VMware) 	list_for_each_entry_rcu(mod_map, &ftrace_mod_maps, list) {
71796171a031SSteven Rostedt (VMware) 
71806171a031SSteven Rostedt (VMware) 		if (symnum >= mod_map->num_funcs) {
71816171a031SSteven Rostedt (VMware) 			symnum -= mod_map->num_funcs;
71826171a031SSteven Rostedt (VMware) 			continue;
71836171a031SSteven Rostedt (VMware) 		}
71846171a031SSteven Rostedt (VMware) 
71856171a031SSteven Rostedt (VMware) 		list_for_each_entry_rcu(mod_func, &mod_map->funcs, list) {
71866171a031SSteven Rostedt (VMware) 			if (symnum > 1) {
71876171a031SSteven Rostedt (VMware) 				symnum--;
71886171a031SSteven Rostedt (VMware) 				continue;
71896171a031SSteven Rostedt (VMware) 			}
71906171a031SSteven Rostedt (VMware) 
71916171a031SSteven Rostedt (VMware) 			*value = mod_func->ip;
71926171a031SSteven Rostedt (VMware) 			*type = 'T';
71936171a031SSteven Rostedt (VMware) 			strlcpy(name, mod_func->name, KSYM_NAME_LEN);
71946171a031SSteven Rostedt (VMware) 			strlcpy(module_name, mod_map->mod->name, MODULE_NAME_LEN);
71956171a031SSteven Rostedt (VMware) 			*exported = 1;
71966171a031SSteven Rostedt (VMware) 			preempt_enable();
71976171a031SSteven Rostedt (VMware) 			return 0;
71986171a031SSteven Rostedt (VMware) 		}
71996171a031SSteven Rostedt (VMware) 		WARN_ON(1);
72006171a031SSteven Rostedt (VMware) 		break;
72016171a031SSteven Rostedt (VMware) 	}
7202fc0ea795SAdrian Hunter 	ret = ftrace_get_trampoline_kallsym(symnum, value, type, name,
7203fc0ea795SAdrian Hunter 					    module_name, exported);
72046171a031SSteven Rostedt (VMware) 	preempt_enable();
7205fc0ea795SAdrian Hunter 	return ret;
72066171a031SSteven Rostedt (VMware) }
72076171a031SSteven Rostedt (VMware) 
7208aba4b5c2SSteven Rostedt (VMware) #else
7209aba4b5c2SSteven Rostedt (VMware) static void save_ftrace_mod_rec(struct ftrace_mod_map *mod_map,
7210aba4b5c2SSteven Rostedt (VMware) 				struct dyn_ftrace *rec) { }
7211aba4b5c2SSteven Rostedt (VMware) static inline struct ftrace_mod_map *
7212aba4b5c2SSteven Rostedt (VMware) allocate_ftrace_mod_map(struct module *mod,
7213aba4b5c2SSteven Rostedt (VMware) 			unsigned long start, unsigned long end)
7214aba4b5c2SSteven Rostedt (VMware) {
7215aba4b5c2SSteven Rostedt (VMware) 	return NULL;
7216aba4b5c2SSteven Rostedt (VMware) }
7217fc0ea795SAdrian Hunter int ftrace_mod_get_kallsym(unsigned int symnum, unsigned long *value,
7218fc0ea795SAdrian Hunter 			   char *type, char *name, char *module_name,
7219fc0ea795SAdrian Hunter 			   int *exported)
7220fc0ea795SAdrian Hunter {
7221fc0ea795SAdrian Hunter 	int ret;
7222fc0ea795SAdrian Hunter 
7223fc0ea795SAdrian Hunter 	preempt_disable();
7224fc0ea795SAdrian Hunter 	ret = ftrace_get_trampoline_kallsym(symnum, value, type, name,
7225fc0ea795SAdrian Hunter 					    module_name, exported);
7226fc0ea795SAdrian Hunter 	preempt_enable();
7227fc0ea795SAdrian Hunter 	return ret;
7228fc0ea795SAdrian Hunter }
722993eb677dSSteven Rostedt #endif /* CONFIG_MODULES */
723093eb677dSSteven Rostedt 
72318715b108SJoel Fernandes struct ftrace_init_func {
72328715b108SJoel Fernandes 	struct list_head list;
72338715b108SJoel Fernandes 	unsigned long ip;
72348715b108SJoel Fernandes };
72358715b108SJoel Fernandes 
72368715b108SJoel Fernandes /* Clear any init ips from hashes */
72378715b108SJoel Fernandes static void
72388715b108SJoel Fernandes clear_func_from_hash(struct ftrace_init_func *func, struct ftrace_hash *hash)
723942c269c8SSteven Rostedt (VMware) {
72408715b108SJoel Fernandes 	struct ftrace_func_entry *entry;
72418715b108SJoel Fernandes 
724208468754SChangbin Du 	entry = ftrace_lookup_ip(hash, func->ip);
72438715b108SJoel Fernandes 	/*
72448715b108SJoel Fernandes 	 * Do not allow this rec to match again.
72458715b108SJoel Fernandes 	 * Yeah, it may waste some memory, but will be removed
72468715b108SJoel Fernandes 	 * if/when the hash is modified again.
72478715b108SJoel Fernandes 	 */
72488715b108SJoel Fernandes 	if (entry)
72498715b108SJoel Fernandes 		entry->ip = 0;
72508715b108SJoel Fernandes }
72518715b108SJoel Fernandes 
72528715b108SJoel Fernandes static void
72538715b108SJoel Fernandes clear_func_from_hashes(struct ftrace_init_func *func)
72548715b108SJoel Fernandes {
72558715b108SJoel Fernandes 	struct trace_array *tr;
72568715b108SJoel Fernandes 
72578715b108SJoel Fernandes 	mutex_lock(&trace_types_lock);
72588715b108SJoel Fernandes 	list_for_each_entry(tr, &ftrace_trace_arrays, list) {
72598715b108SJoel Fernandes 		if (!tr->ops || !tr->ops->func_hash)
72608715b108SJoel Fernandes 			continue;
72618715b108SJoel Fernandes 		mutex_lock(&tr->ops->func_hash->regex_lock);
72628715b108SJoel Fernandes 		clear_func_from_hash(func, tr->ops->func_hash->filter_hash);
72638715b108SJoel Fernandes 		clear_func_from_hash(func, tr->ops->func_hash->notrace_hash);
72648715b108SJoel Fernandes 		mutex_unlock(&tr->ops->func_hash->regex_lock);
72658715b108SJoel Fernandes 	}
72668715b108SJoel Fernandes 	mutex_unlock(&trace_types_lock);
72678715b108SJoel Fernandes }
72688715b108SJoel Fernandes 
72698715b108SJoel Fernandes static void add_to_clear_hash_list(struct list_head *clear_list,
72708715b108SJoel Fernandes 				   struct dyn_ftrace *rec)
72718715b108SJoel Fernandes {
72728715b108SJoel Fernandes 	struct ftrace_init_func *func;
72738715b108SJoel Fernandes 
72748715b108SJoel Fernandes 	func = kmalloc(sizeof(*func), GFP_KERNEL);
72758715b108SJoel Fernandes 	if (!func) {
727624589e3aSSteven Rostedt (VMware) 		MEM_FAIL(1, "alloc failure, ftrace filter could be stale\n");
72778715b108SJoel Fernandes 		return;
72788715b108SJoel Fernandes 	}
72798715b108SJoel Fernandes 
72808715b108SJoel Fernandes 	func->ip = rec->ip;
72818715b108SJoel Fernandes 	list_add(&func->list, clear_list);
72828715b108SJoel Fernandes }
72838715b108SJoel Fernandes 
7284aba4b5c2SSteven Rostedt (VMware) void ftrace_free_mem(struct module *mod, void *start_ptr, void *end_ptr)
728542c269c8SSteven Rostedt (VMware) {
72866cafbe15SSteven Rostedt (VMware) 	unsigned long start = (unsigned long)(start_ptr);
72876cafbe15SSteven Rostedt (VMware) 	unsigned long end = (unsigned long)(end_ptr);
728842c269c8SSteven Rostedt (VMware) 	struct ftrace_page **last_pg = &ftrace_pages_start;
728942c269c8SSteven Rostedt (VMware) 	struct ftrace_page *pg;
729042c269c8SSteven Rostedt (VMware) 	struct dyn_ftrace *rec;
729142c269c8SSteven Rostedt (VMware) 	struct dyn_ftrace key;
7292aba4b5c2SSteven Rostedt (VMware) 	struct ftrace_mod_map *mod_map = NULL;
72938715b108SJoel Fernandes 	struct ftrace_init_func *func, *func_next;
72948715b108SJoel Fernandes 	struct list_head clear_hash;
729542c269c8SSteven Rostedt (VMware) 
72968715b108SJoel Fernandes 	INIT_LIST_HEAD(&clear_hash);
72978715b108SJoel Fernandes 
729842c269c8SSteven Rostedt (VMware) 	key.ip = start;
729942c269c8SSteven Rostedt (VMware) 	key.flags = end;	/* overload flags, as it is unsigned long */
730042c269c8SSteven Rostedt (VMware) 
730142c269c8SSteven Rostedt (VMware) 	mutex_lock(&ftrace_lock);
730242c269c8SSteven Rostedt (VMware) 
7303aba4b5c2SSteven Rostedt (VMware) 	/*
7304aba4b5c2SSteven Rostedt (VMware) 	 * If we are freeing module init memory, then check if
7305aba4b5c2SSteven Rostedt (VMware) 	 * any tracer is active. If so, we need to save a mapping of
7306aba4b5c2SSteven Rostedt (VMware) 	 * the module functions being freed with the address.
7307aba4b5c2SSteven Rostedt (VMware) 	 */
7308aba4b5c2SSteven Rostedt (VMware) 	if (mod && ftrace_ops_list != &ftrace_list_end)
7309aba4b5c2SSteven Rostedt (VMware) 		mod_map = allocate_ftrace_mod_map(mod, start, end);
7310aba4b5c2SSteven Rostedt (VMware) 
731142c269c8SSteven Rostedt (VMware) 	for (pg = ftrace_pages_start; pg; last_pg = &pg->next, pg = *last_pg) {
731242c269c8SSteven Rostedt (VMware) 		if (end < pg->records[0].ip ||
731342c269c8SSteven Rostedt (VMware) 		    start >= (pg->records[pg->index - 1].ip + MCOUNT_INSN_SIZE))
731442c269c8SSteven Rostedt (VMware) 			continue;
731542c269c8SSteven Rostedt (VMware)  again:
731642c269c8SSteven Rostedt (VMware) 		rec = bsearch(&key, pg->records, pg->index,
731742c269c8SSteven Rostedt (VMware) 			      sizeof(struct dyn_ftrace),
731842c269c8SSteven Rostedt (VMware) 			      ftrace_cmp_recs);
731942c269c8SSteven Rostedt (VMware) 		if (!rec)
732042c269c8SSteven Rostedt (VMware) 			continue;
7321aba4b5c2SSteven Rostedt (VMware) 
73228715b108SJoel Fernandes 		/* rec will be cleared from hashes after ftrace_lock unlock */
73238715b108SJoel Fernandes 		add_to_clear_hash_list(&clear_hash, rec);
73248715b108SJoel Fernandes 
7325aba4b5c2SSteven Rostedt (VMware) 		if (mod_map)
7326aba4b5c2SSteven Rostedt (VMware) 			save_ftrace_mod_rec(mod_map, rec);
7327aba4b5c2SSteven Rostedt (VMware) 
732842c269c8SSteven Rostedt (VMware) 		pg->index--;
73294ec78467SSteven Rostedt (VMware) 		ftrace_update_tot_cnt--;
733042c269c8SSteven Rostedt (VMware) 		if (!pg->index) {
733142c269c8SSteven Rostedt (VMware) 			*last_pg = pg->next;
7332db42523bSLinus Torvalds 			if (pg->records) {
7333db42523bSLinus Torvalds 				free_pages((unsigned long)pg->records, pg->order);
7334db42523bSLinus Torvalds 				ftrace_number_of_pages -= 1 << pg->order;
7335db42523bSLinus Torvalds 			}
7336da537f0aSSteven Rostedt (VMware) 			ftrace_number_of_groups--;
733742c269c8SSteven Rostedt (VMware) 			kfree(pg);
733842c269c8SSteven Rostedt (VMware) 			pg = container_of(last_pg, struct ftrace_page, next);
733942c269c8SSteven Rostedt (VMware) 			if (!(*last_pg))
734042c269c8SSteven Rostedt (VMware) 				ftrace_pages = pg;
734142c269c8SSteven Rostedt (VMware) 			continue;
734242c269c8SSteven Rostedt (VMware) 		}
734342c269c8SSteven Rostedt (VMware) 		memmove(rec, rec + 1,
734442c269c8SSteven Rostedt (VMware) 			(pg->index - (rec - pg->records)) * sizeof(*rec));
734542c269c8SSteven Rostedt (VMware) 		/* More than one function may be in this block */
734642c269c8SSteven Rostedt (VMware) 		goto again;
734742c269c8SSteven Rostedt (VMware) 	}
734842c269c8SSteven Rostedt (VMware) 	mutex_unlock(&ftrace_lock);
73498715b108SJoel Fernandes 
73508715b108SJoel Fernandes 	list_for_each_entry_safe(func, func_next, &clear_hash, list) {
73518715b108SJoel Fernandes 		clear_func_from_hashes(func);
73528715b108SJoel Fernandes 		kfree(func);
73538715b108SJoel Fernandes 	}
735442c269c8SSteven Rostedt (VMware) }
735542c269c8SSteven Rostedt (VMware) 
73566cafbe15SSteven Rostedt (VMware) void __init ftrace_free_init_mem(void)
73576cafbe15SSteven Rostedt (VMware) {
73586cafbe15SSteven Rostedt (VMware) 	void *start = (void *)(&__init_begin);
73596cafbe15SSteven Rostedt (VMware) 	void *end = (void *)(&__init_end);
73606cafbe15SSteven Rostedt (VMware) 
7361380af29bSSteven Rostedt (Google) 	ftrace_boot_snapshot();
7362380af29bSSteven Rostedt (Google) 
7363aba4b5c2SSteven Rostedt (VMware) 	ftrace_free_mem(NULL, start, end);
736493eb677dSSteven Rostedt }
736593eb677dSSteven Rostedt 
73666644c654SWeizhao Ouyang int __init __weak ftrace_dyn_arch_init(void)
73676644c654SWeizhao Ouyang {
73686644c654SWeizhao Ouyang 	return 0;
73696644c654SWeizhao Ouyang }
73706644c654SWeizhao Ouyang 
737168bf21aaSSteven Rostedt void __init ftrace_init(void)
737268bf21aaSSteven Rostedt {
73731dc43cf0SJiri Slaby 	extern unsigned long __start_mcount_loc[];
73741dc43cf0SJiri Slaby 	extern unsigned long __stop_mcount_loc[];
73753a36cb11SJiri Slaby 	unsigned long count, flags;
737668bf21aaSSteven Rostedt 	int ret;
737768bf21aaSSteven Rostedt 
737868bf21aaSSteven Rostedt 	local_irq_save(flags);
73793a36cb11SJiri Slaby 	ret = ftrace_dyn_arch_init();
738068bf21aaSSteven Rostedt 	local_irq_restore(flags);
7381af64a7cbSJiri Slaby 	if (ret)
738268bf21aaSSteven Rostedt 		goto failed;
738368bf21aaSSteven Rostedt 
738468bf21aaSSteven Rostedt 	count = __stop_mcount_loc - __start_mcount_loc;
7385c867ccd8SJiri Slaby 	if (!count) {
7386c867ccd8SJiri Slaby 		pr_info("ftrace: No functions to be traced?\n");
738768bf21aaSSteven Rostedt 		goto failed;
7388c867ccd8SJiri Slaby 	}
7389c867ccd8SJiri Slaby 
7390c867ccd8SJiri Slaby 	pr_info("ftrace: allocating %ld entries in %ld pages\n",
7391c867ccd8SJiri Slaby 		count, count / ENTRIES_PER_PAGE + 1);
739268bf21aaSSteven Rostedt 
73935cb084bbSJiri Olsa 	ret = ftrace_process_locs(NULL,
739431e88909SSteven Rostedt 				  __start_mcount_loc,
739568bf21aaSSteven Rostedt 				  __stop_mcount_loc);
73962889c658SYuntao Wang 	if (ret) {
73972889c658SYuntao Wang 		pr_warn("ftrace: failed to allocate entries for functions\n");
73982889c658SYuntao Wang 		goto failed;
73992889c658SYuntao Wang 	}
740068bf21aaSSteven Rostedt 
7401da537f0aSSteven Rostedt (VMware) 	pr_info("ftrace: allocated %ld pages with %ld groups\n",
7402da537f0aSSteven Rostedt (VMware) 		ftrace_number_of_pages, ftrace_number_of_groups);
7403da537f0aSSteven Rostedt (VMware) 
74042889c658SYuntao Wang 	last_ftrace_enabled = ftrace_enabled = 1;
74052889c658SYuntao Wang 
74062af15d6aSSteven Rostedt 	set_ftrace_early_filters();
74072af15d6aSSteven Rostedt 
740868bf21aaSSteven Rostedt 	return;
740968bf21aaSSteven Rostedt  failed:
741068bf21aaSSteven Rostedt 	ftrace_disabled = 1;
741168bf21aaSSteven Rostedt }
741268bf21aaSSteven Rostedt 
7413f3bea491SSteven Rostedt (Red Hat) /* Do nothing if arch does not support this */
7414f3bea491SSteven Rostedt (Red Hat) void __weak arch_ftrace_update_trampoline(struct ftrace_ops *ops)
7415f3bea491SSteven Rostedt (Red Hat) {
7416f3bea491SSteven Rostedt (Red Hat) }
7417f3bea491SSteven Rostedt (Red Hat) 
7418f3bea491SSteven Rostedt (Red Hat) static void ftrace_update_trampoline(struct ftrace_ops *ops)
7419f3bea491SSteven Rostedt (Red Hat) {
7420fc0ea795SAdrian Hunter 	unsigned long trampoline = ops->trampoline;
7421fc0ea795SAdrian Hunter 
7422f3bea491SSteven Rostedt (Red Hat) 	arch_ftrace_update_trampoline(ops);
7423fc0ea795SAdrian Hunter 	if (ops->trampoline && ops->trampoline != trampoline &&
7424dd9ddf46SAdrian Hunter 	    (ops->flags & FTRACE_OPS_FL_ALLOC_TRAMP)) {
7425dd9ddf46SAdrian Hunter 		/* Add to kallsyms before the perf events */
7426fc0ea795SAdrian Hunter 		ftrace_add_trampoline_to_kallsyms(ops);
7427dd9ddf46SAdrian Hunter 		perf_event_ksymbol(PERF_RECORD_KSYMBOL_TYPE_OOL,
7428dd9ddf46SAdrian Hunter 				   ops->trampoline, ops->trampoline_size, false,
7429dd9ddf46SAdrian Hunter 				   FTRACE_TRAMPOLINE_SYM);
7430548e1f6cSAdrian Hunter 		/*
7431548e1f6cSAdrian Hunter 		 * Record the perf text poke event after the ksymbol register
7432548e1f6cSAdrian Hunter 		 * event.
7433548e1f6cSAdrian Hunter 		 */
7434548e1f6cSAdrian Hunter 		perf_event_text_poke((void *)ops->trampoline, NULL, 0,
7435548e1f6cSAdrian Hunter 				     (void *)ops->trampoline,
7436548e1f6cSAdrian Hunter 				     ops->trampoline_size);
7437dd9ddf46SAdrian Hunter 	}
7438f3bea491SSteven Rostedt (Red Hat) }
7439f3bea491SSteven Rostedt (Red Hat) 
744004ec7bb6SSteven Rostedt (VMware) void ftrace_init_trace_array(struct trace_array *tr)
744104ec7bb6SSteven Rostedt (VMware) {
744204ec7bb6SSteven Rostedt (VMware) 	INIT_LIST_HEAD(&tr->func_probes);
7443673feb9dSSteven Rostedt (VMware) 	INIT_LIST_HEAD(&tr->mod_trace);
7444673feb9dSSteven Rostedt (VMware) 	INIT_LIST_HEAD(&tr->mod_notrace);
744504ec7bb6SSteven Rostedt (VMware) }
74463d083395SSteven Rostedt #else
74470b6e4d56SFrederic Weisbecker 
74483306fc4aSSteven Rostedt (VMware) struct ftrace_ops global_ops = {
7449bd69c30bSSteven Rostedt 	.func			= ftrace_stub,
7450a25d036dSSteven Rostedt (VMware) 	.flags			= FTRACE_OPS_FL_INITIALIZED |
7451e3eea140SSteven Rostedt (Red Hat) 				  FTRACE_OPS_FL_PID,
7452bd69c30bSSteven Rostedt };
7453bd69c30bSSteven Rostedt 
74540b6e4d56SFrederic Weisbecker static int __init ftrace_nodyn_init(void)
74550b6e4d56SFrederic Weisbecker {
74560b6e4d56SFrederic Weisbecker 	ftrace_enabled = 1;
74570b6e4d56SFrederic Weisbecker 	return 0;
74580b6e4d56SFrederic Weisbecker }
74596f415672SSteven Rostedt core_initcall(ftrace_nodyn_init);
74600b6e4d56SFrederic Weisbecker 
74618434dc93SSteven Rostedt (Red Hat) static inline int ftrace_init_dyn_tracefs(struct dentry *d_tracer) { return 0; }
7462e1effa01SSteven Rostedt (Red Hat) static inline void ftrace_startup_all(int command) { }
74638a56d776SSteven Rostedt (Red Hat) 
7464f3bea491SSteven Rostedt (Red Hat) static void ftrace_update_trampoline(struct ftrace_ops *ops)
7465f3bea491SSteven Rostedt (Red Hat) {
7466f3bea491SSteven Rostedt (Red Hat) }
7467f3bea491SSteven Rostedt (Red Hat) 
74683d083395SSteven Rostedt #endif /* CONFIG_DYNAMIC_FTRACE */
74693d083395SSteven Rostedt 
74704104d326SSteven Rostedt (Red Hat) __init void ftrace_init_global_array_ops(struct trace_array *tr)
74714104d326SSteven Rostedt (Red Hat) {
74724104d326SSteven Rostedt (Red Hat) 	tr->ops = &global_ops;
74734104d326SSteven Rostedt (Red Hat) 	tr->ops->private = tr;
747404ec7bb6SSteven Rostedt (VMware) 	ftrace_init_trace_array(tr);
74754104d326SSteven Rostedt (Red Hat) }
74764104d326SSteven Rostedt (Red Hat) 
74774104d326SSteven Rostedt (Red Hat) void ftrace_init_array_ops(struct trace_array *tr, ftrace_func_t func)
74784104d326SSteven Rostedt (Red Hat) {
74794104d326SSteven Rostedt (Red Hat) 	/* If we filter on pids, update to use the pid function */
74804104d326SSteven Rostedt (Red Hat) 	if (tr->flags & TRACE_ARRAY_FL_GLOBAL) {
74814104d326SSteven Rostedt (Red Hat) 		if (WARN_ON(tr->ops->func != ftrace_stub))
74824104d326SSteven Rostedt (Red Hat) 			printk("ftrace ops had %pS for function\n",
74834104d326SSteven Rostedt (Red Hat) 			       tr->ops->func);
74844104d326SSteven Rostedt (Red Hat) 	}
74854104d326SSteven Rostedt (Red Hat) 	tr->ops->func = func;
74864104d326SSteven Rostedt (Red Hat) 	tr->ops->private = tr;
74874104d326SSteven Rostedt (Red Hat) }
74884104d326SSteven Rostedt (Red Hat) 
74894104d326SSteven Rostedt (Red Hat) void ftrace_reset_array_ops(struct trace_array *tr)
74904104d326SSteven Rostedt (Red Hat) {
74914104d326SSteven Rostedt (Red Hat) 	tr->ops->func = ftrace_stub;
74924104d326SSteven Rostedt (Red Hat) }
74934104d326SSteven Rostedt (Red Hat) 
7494fabe38abSMasami Hiramatsu static nokprobe_inline void
74952f5f6ad9SSteven Rostedt __ftrace_ops_list_func(unsigned long ip, unsigned long parent_ip,
7496d19ad077SSteven Rostedt (VMware) 		       struct ftrace_ops *ignored, struct ftrace_regs *fregs)
7497b848914cSSteven Rostedt {
7498d19ad077SSteven Rostedt (VMware) 	struct pt_regs *regs = ftrace_get_regs(fregs);
7499cdbe61bfSSteven Rostedt 	struct ftrace_ops *op;
7500edc15cafSSteven Rostedt 	int bit;
7501b848914cSSteven Rostedt 
7502ce5e4803S王贇 	/*
7503ce5e4803S王贇 	 * The ftrace_test_and_set_recursion() will disable preemption,
7504ce5e4803S王贇 	 * which is required since some of the ops may be dynamically
7505ce5e4803S王贇 	 * allocated, they must be freed after a synchronize_rcu().
7506ce5e4803S王贇 	 */
7507ed65df63SSteven Rostedt (VMware) 	bit = trace_test_and_set_recursion(ip, parent_ip, TRACE_LIST_START);
7508edc15cafSSteven Rostedt 	if (bit < 0)
7509b1cff0adSSteven Rostedt 		return;
7510b1cff0adSSteven Rostedt 
75110a016409SSteven Rostedt 	do_for_each_ftrace_op(op, ftrace_ops_list) {
75122fa717a0SSteven Rostedt (VMware) 		/* Stub functions don't need to be called nor tested */
75132fa717a0SSteven Rostedt (VMware) 		if (op->flags & FTRACE_OPS_FL_STUB)
75142fa717a0SSteven Rostedt (VMware) 			continue;
7515ba27f2bcSSteven Rostedt (Red Hat) 		/*
7516ba27f2bcSSteven Rostedt (Red Hat) 		 * Check the following for each ops before calling their func:
7517ba27f2bcSSteven Rostedt (Red Hat) 		 *  if RCU flag is set, then rcu_is_watching() must be true
7518ba27f2bcSSteven Rostedt (Red Hat) 		 *  if PER_CPU is set, then ftrace_function_local_disable()
7519ba27f2bcSSteven Rostedt (Red Hat) 		 *                          must be false
7520ba27f2bcSSteven Rostedt (Red Hat) 		 *  Otherwise test if the ip matches the ops filter
7521ba27f2bcSSteven Rostedt (Red Hat) 		 *
7522ba27f2bcSSteven Rostedt (Red Hat) 		 * If any of the above fails then the op->func() is not executed.
7523ba27f2bcSSteven Rostedt (Red Hat) 		 */
7524ba27f2bcSSteven Rostedt (Red Hat) 		if ((!(op->flags & FTRACE_OPS_FL_RCU) || rcu_is_watching()) &&
7525ba27f2bcSSteven Rostedt (Red Hat) 		    ftrace_ops_test(op, ip, regs)) {
75261d48d596SSteven Rostedt (Red Hat) 			if (FTRACE_WARN_ON(!op->func)) {
75271d48d596SSteven Rostedt (Red Hat) 				pr_warn("op=%p %pS\n", op, op);
75284104d326SSteven Rostedt (Red Hat) 				goto out;
75294104d326SSteven Rostedt (Red Hat) 			}
7530d19ad077SSteven Rostedt (VMware) 			op->func(ip, parent_ip, op, fregs);
75314104d326SSteven Rostedt (Red Hat) 		}
75320a016409SSteven Rostedt 	} while_for_each_ftrace_op(op);
75334104d326SSteven Rostedt (Red Hat) out:
7534edc15cafSSteven Rostedt 	trace_clear_recursion(bit);
7535b848914cSSteven Rostedt }
7536b848914cSSteven Rostedt 
75372f5f6ad9SSteven Rostedt /*
75382f5f6ad9SSteven Rostedt  * Some archs only support passing ip and parent_ip. Even though
75392f5f6ad9SSteven Rostedt  * the list function ignores the op parameter, we do not want any
75402f5f6ad9SSteven Rostedt  * C side effects, where a function is called without the caller
75412f5f6ad9SSteven Rostedt  * sending a third parameter.
7542a1e2e31dSSteven Rostedt  * Archs are to support both the regs and ftrace_ops at the same time.
7543a1e2e31dSSteven Rostedt  * If they support ftrace_ops, it is assumed they support regs.
7544a1e2e31dSSteven Rostedt  * If call backs want to use regs, they must either check for regs
754506aeaaeaSMasami Hiramatsu  * being NULL, or CONFIG_DYNAMIC_FTRACE_WITH_REGS.
754606aeaaeaSMasami Hiramatsu  * Note, CONFIG_DYNAMIC_FTRACE_WITH_REGS expects a full regs to be saved.
7547a1e2e31dSSteven Rostedt  * An architecture can pass partial regs with ftrace_ops and still
7548b8ec330aSLi Bin  * set the ARCH_SUPPORTS_FTRACE_OPS.
754934cdd18bSSteven Rostedt (VMware)  *
755034cdd18bSSteven Rostedt (VMware)  * In vmlinux.lds.h, ftrace_ops_list_func() is defined to be
755134cdd18bSSteven Rostedt (VMware)  * arch_ftrace_ops_list_func.
75522f5f6ad9SSteven Rostedt  */
75532f5f6ad9SSteven Rostedt #if ARCH_SUPPORTS_FTRACE_OPS
755434cdd18bSSteven Rostedt (VMware) void arch_ftrace_ops_list_func(unsigned long ip, unsigned long parent_ip,
7555d19ad077SSteven Rostedt (VMware) 			       struct ftrace_ops *op, struct ftrace_regs *fregs)
75562f5f6ad9SSteven Rostedt {
7557d19ad077SSteven Rostedt (VMware) 	__ftrace_ops_list_func(ip, parent_ip, NULL, fregs);
75582f5f6ad9SSteven Rostedt }
75592f5f6ad9SSteven Rostedt #else
756034cdd18bSSteven Rostedt (VMware) void arch_ftrace_ops_list_func(unsigned long ip, unsigned long parent_ip)
75612f5f6ad9SSteven Rostedt {
7562a1e2e31dSSteven Rostedt 	__ftrace_ops_list_func(ip, parent_ip, NULL, NULL);
75632f5f6ad9SSteven Rostedt }
75642f5f6ad9SSteven Rostedt #endif
756534cdd18bSSteven Rostedt (VMware) NOKPROBE_SYMBOL(arch_ftrace_ops_list_func);
75662f5f6ad9SSteven Rostedt 
7567f1ff6348SSteven Rostedt (Red Hat) /*
7568f1ff6348SSteven Rostedt (Red Hat)  * If there's only one function registered but it does not support
7569c68c0fa2SSteven Rostedt (Red Hat)  * recursion, needs RCU protection and/or requires per cpu handling, then
7570c68c0fa2SSteven Rostedt (Red Hat)  * this function will be called by the mcount trampoline.
7571f1ff6348SSteven Rostedt (Red Hat)  */
7572c68c0fa2SSteven Rostedt (Red Hat) static void ftrace_ops_assist_func(unsigned long ip, unsigned long parent_ip,
7573d19ad077SSteven Rostedt (VMware) 				   struct ftrace_ops *op, struct ftrace_regs *fregs)
7574f1ff6348SSteven Rostedt (Red Hat) {
7575f1ff6348SSteven Rostedt (Red Hat) 	int bit;
7576f1ff6348SSteven Rostedt (Red Hat) 
7577ed65df63SSteven Rostedt (VMware) 	bit = trace_test_and_set_recursion(ip, parent_ip, TRACE_LIST_START);
7578f1ff6348SSteven Rostedt (Red Hat) 	if (bit < 0)
7579f1ff6348SSteven Rostedt (Red Hat) 		return;
7580f1ff6348SSteven Rostedt (Red Hat) 
7581b40341faSSteven Rostedt (VMware) 	if (!(op->flags & FTRACE_OPS_FL_RCU) || rcu_is_watching())
7582d19ad077SSteven Rostedt (VMware) 		op->func(ip, parent_ip, op, fregs);
7583c68c0fa2SSteven Rostedt (Red Hat) 
7584f1ff6348SSteven Rostedt (Red Hat) 	trace_clear_recursion(bit);
7585f1ff6348SSteven Rostedt (Red Hat) }
7586fabe38abSMasami Hiramatsu NOKPROBE_SYMBOL(ftrace_ops_assist_func);
7587f1ff6348SSteven Rostedt (Red Hat) 
758887354059SSteven Rostedt (Red Hat) /**
758987354059SSteven Rostedt (Red Hat)  * ftrace_ops_get_func - get the function a trampoline should call
759087354059SSteven Rostedt (Red Hat)  * @ops: the ops to get the function for
759187354059SSteven Rostedt (Red Hat)  *
759287354059SSteven Rostedt (Red Hat)  * Normally the mcount trampoline will call the ops->func, but there
759387354059SSteven Rostedt (Red Hat)  * are times that it should not. For example, if the ops does not
759487354059SSteven Rostedt (Red Hat)  * have its own recursion protection, then it should call the
75953a150df9SChunyu Hu  * ftrace_ops_assist_func() instead.
759687354059SSteven Rostedt (Red Hat)  *
759787354059SSteven Rostedt (Red Hat)  * Returns the function that the trampoline should call for @ops.
759887354059SSteven Rostedt (Red Hat)  */
759987354059SSteven Rostedt (Red Hat) ftrace_func_t ftrace_ops_get_func(struct ftrace_ops *ops)
760087354059SSteven Rostedt (Red Hat) {
760187354059SSteven Rostedt (Red Hat) 	/*
7602a25d036dSSteven Rostedt (VMware) 	 * If the function does not handle recursion or needs to be RCU safe,
7603a25d036dSSteven Rostedt (VMware) 	 * then we need to call the assist handler.
760487354059SSteven Rostedt (Red Hat) 	 */
7605a25d036dSSteven Rostedt (VMware) 	if (ops->flags & (FTRACE_OPS_FL_RECURSION |
7606a25d036dSSteven Rostedt (VMware) 			  FTRACE_OPS_FL_RCU))
7607c68c0fa2SSteven Rostedt (Red Hat) 		return ftrace_ops_assist_func;
760887354059SSteven Rostedt (Red Hat) 
760987354059SSteven Rostedt (Red Hat) 	return ops->func;
761087354059SSteven Rostedt (Red Hat) }
761187354059SSteven Rostedt (Red Hat) 
7612345ddcc8SSteven Rostedt (Red Hat) static void
7613345ddcc8SSteven Rostedt (Red Hat) ftrace_filter_pid_sched_switch_probe(void *data, bool preempt,
7614fa2c3254SValentin Schneider 				     struct task_struct *prev,
76159c2136beSDelyan Kratunov 				     struct task_struct *next,
76169c2136beSDelyan Kratunov 				     unsigned int prev_state)
7617e32d8956SSteven Rostedt {
7618345ddcc8SSteven Rostedt (Red Hat) 	struct trace_array *tr = data;
7619345ddcc8SSteven Rostedt (Red Hat) 	struct trace_pid_list *pid_list;
7620b3b1e6edSSteven Rostedt (VMware) 	struct trace_pid_list *no_pid_list;
7621345ddcc8SSteven Rostedt (Red Hat) 
7622345ddcc8SSteven Rostedt (Red Hat) 	pid_list = rcu_dereference_sched(tr->function_pids);
7623b3b1e6edSSteven Rostedt (VMware) 	no_pid_list = rcu_dereference_sched(tr->function_no_pids);
7624345ddcc8SSteven Rostedt (Red Hat) 
7625b3b1e6edSSteven Rostedt (VMware) 	if (trace_ignore_this_task(pid_list, no_pid_list, next))
76261c5eb448SSteven Rostedt (VMware) 		this_cpu_write(tr->array_buffer.data->ftrace_ignore_pid,
7627717e3f5eSSteven Rostedt (VMware) 			       FTRACE_PID_IGNORE);
7628717e3f5eSSteven Rostedt (VMware) 	else
7629717e3f5eSSteven Rostedt (VMware) 		this_cpu_write(tr->array_buffer.data->ftrace_ignore_pid,
7630717e3f5eSSteven Rostedt (VMware) 			       next->pid);
7631345ddcc8SSteven Rostedt (Red Hat) }
7632345ddcc8SSteven Rostedt (Red Hat) 
76331e10486fSNamhyung Kim static void
76341e10486fSNamhyung Kim ftrace_pid_follow_sched_process_fork(void *data,
76351e10486fSNamhyung Kim 				     struct task_struct *self,
76361e10486fSNamhyung Kim 				     struct task_struct *task)
76371e10486fSNamhyung Kim {
76381e10486fSNamhyung Kim 	struct trace_pid_list *pid_list;
76391e10486fSNamhyung Kim 	struct trace_array *tr = data;
76401e10486fSNamhyung Kim 
76411e10486fSNamhyung Kim 	pid_list = rcu_dereference_sched(tr->function_pids);
76421e10486fSNamhyung Kim 	trace_filter_add_remove_task(pid_list, self, task);
7643b3b1e6edSSteven Rostedt (VMware) 
7644b3b1e6edSSteven Rostedt (VMware) 	pid_list = rcu_dereference_sched(tr->function_no_pids);
7645b3b1e6edSSteven Rostedt (VMware) 	trace_filter_add_remove_task(pid_list, self, task);
76461e10486fSNamhyung Kim }
76471e10486fSNamhyung Kim 
76481e10486fSNamhyung Kim static void
76491e10486fSNamhyung Kim ftrace_pid_follow_sched_process_exit(void *data, struct task_struct *task)
76501e10486fSNamhyung Kim {
76511e10486fSNamhyung Kim 	struct trace_pid_list *pid_list;
76521e10486fSNamhyung Kim 	struct trace_array *tr = data;
76531e10486fSNamhyung Kim 
76541e10486fSNamhyung Kim 	pid_list = rcu_dereference_sched(tr->function_pids);
76551e10486fSNamhyung Kim 	trace_filter_add_remove_task(pid_list, NULL, task);
7656b3b1e6edSSteven Rostedt (VMware) 
7657b3b1e6edSSteven Rostedt (VMware) 	pid_list = rcu_dereference_sched(tr->function_no_pids);
7658b3b1e6edSSteven Rostedt (VMware) 	trace_filter_add_remove_task(pid_list, NULL, task);
76591e10486fSNamhyung Kim }
76601e10486fSNamhyung Kim 
76611e10486fSNamhyung Kim void ftrace_pid_follow_fork(struct trace_array *tr, bool enable)
76621e10486fSNamhyung Kim {
76631e10486fSNamhyung Kim 	if (enable) {
76641e10486fSNamhyung Kim 		register_trace_sched_process_fork(ftrace_pid_follow_sched_process_fork,
76651e10486fSNamhyung Kim 						  tr);
7666afcab636SSteven Rostedt (VMware) 		register_trace_sched_process_free(ftrace_pid_follow_sched_process_exit,
76671e10486fSNamhyung Kim 						  tr);
76681e10486fSNamhyung Kim 	} else {
76691e10486fSNamhyung Kim 		unregister_trace_sched_process_fork(ftrace_pid_follow_sched_process_fork,
76701e10486fSNamhyung Kim 						    tr);
7671afcab636SSteven Rostedt (VMware) 		unregister_trace_sched_process_free(ftrace_pid_follow_sched_process_exit,
76721e10486fSNamhyung Kim 						    tr);
76731e10486fSNamhyung Kim 	}
76741e10486fSNamhyung Kim }
76751e10486fSNamhyung Kim 
7676b3b1e6edSSteven Rostedt (VMware) static void clear_ftrace_pids(struct trace_array *tr, int type)
7677345ddcc8SSteven Rostedt (Red Hat) {
7678345ddcc8SSteven Rostedt (Red Hat) 	struct trace_pid_list *pid_list;
7679b3b1e6edSSteven Rostedt (VMware) 	struct trace_pid_list *no_pid_list;
7680e32d8956SSteven Rostedt 	int cpu;
7681e32d8956SSteven Rostedt 
7682345ddcc8SSteven Rostedt (Red Hat) 	pid_list = rcu_dereference_protected(tr->function_pids,
7683345ddcc8SSteven Rostedt (Red Hat) 					     lockdep_is_held(&ftrace_lock));
7684b3b1e6edSSteven Rostedt (VMware) 	no_pid_list = rcu_dereference_protected(tr->function_no_pids,
7685b3b1e6edSSteven Rostedt (VMware) 						lockdep_is_held(&ftrace_lock));
7686b3b1e6edSSteven Rostedt (VMware) 
7687b3b1e6edSSteven Rostedt (VMware) 	/* Make sure there's something to do */
768827683626SSteven Rostedt (VMware) 	if (!pid_type_enabled(type, pid_list, no_pid_list))
7689345ddcc8SSteven Rostedt (Red Hat) 		return;
7690345ddcc8SSteven Rostedt (Red Hat) 
7691b3b1e6edSSteven Rostedt (VMware) 	/* See if the pids still need to be checked after this */
769227683626SSteven Rostedt (VMware) 	if (!still_need_pid_events(type, pid_list, no_pid_list)) {
7693345ddcc8SSteven Rostedt (Red Hat) 		unregister_trace_sched_switch(ftrace_filter_pid_sched_switch_probe, tr);
7694345ddcc8SSteven Rostedt (Red Hat) 		for_each_possible_cpu(cpu)
7695717e3f5eSSteven Rostedt (VMware) 			per_cpu_ptr(tr->array_buffer.data, cpu)->ftrace_ignore_pid = FTRACE_PID_TRACE;
7696b3b1e6edSSteven Rostedt (VMware) 	}
7697345ddcc8SSteven Rostedt (Red Hat) 
7698b3b1e6edSSteven Rostedt (VMware) 	if (type & TRACE_PIDS)
7699345ddcc8SSteven Rostedt (Red Hat) 		rcu_assign_pointer(tr->function_pids, NULL);
7700345ddcc8SSteven Rostedt (Red Hat) 
7701b3b1e6edSSteven Rostedt (VMware) 	if (type & TRACE_NO_PIDS)
7702b3b1e6edSSteven Rostedt (VMware) 		rcu_assign_pointer(tr->function_no_pids, NULL);
7703b3b1e6edSSteven Rostedt (VMware) 
7704345ddcc8SSteven Rostedt (Red Hat) 	/* Wait till all users are no longer using pid filtering */
770574401729SPaul E. McKenney 	synchronize_rcu();
7706345ddcc8SSteven Rostedt (Red Hat) 
7707b3b1e6edSSteven Rostedt (VMware) 	if ((type & TRACE_PIDS) && pid_list)
77086954e415SSteven Rostedt (VMware) 		trace_pid_list_free(pid_list);
7709b3b1e6edSSteven Rostedt (VMware) 
7710b3b1e6edSSteven Rostedt (VMware) 	if ((type & TRACE_NO_PIDS) && no_pid_list)
77116954e415SSteven Rostedt (VMware) 		trace_pid_list_free(no_pid_list);
7712e32d8956SSteven Rostedt }
7713e32d8956SSteven Rostedt 
7714d879d0b8SNamhyung Kim void ftrace_clear_pids(struct trace_array *tr)
7715d879d0b8SNamhyung Kim {
7716d879d0b8SNamhyung Kim 	mutex_lock(&ftrace_lock);
7717d879d0b8SNamhyung Kim 
7718b3b1e6edSSteven Rostedt (VMware) 	clear_ftrace_pids(tr, TRACE_PIDS | TRACE_NO_PIDS);
7719d879d0b8SNamhyung Kim 
7720d879d0b8SNamhyung Kim 	mutex_unlock(&ftrace_lock);
7721d879d0b8SNamhyung Kim }
7722d879d0b8SNamhyung Kim 
7723b3b1e6edSSteven Rostedt (VMware) static void ftrace_pid_reset(struct trace_array *tr, int type)
7724e32d8956SSteven Rostedt {
7725756d17eeS[email protected] 	mutex_lock(&ftrace_lock);
7726b3b1e6edSSteven Rostedt (VMware) 	clear_ftrace_pids(tr, type);
7727756d17eeS[email protected] 
7728756d17eeS[email protected] 	ftrace_update_pid_func();
7729e1effa01SSteven Rostedt (Red Hat) 	ftrace_startup_all(0);
7730756d17eeS[email protected] 
7731756d17eeS[email protected] 	mutex_unlock(&ftrace_lock);
7732756d17eeS[email protected] }
7733756d17eeS[email protected] 
7734345ddcc8SSteven Rostedt (Red Hat) /* Greater than any max PID */
7735345ddcc8SSteven Rostedt (Red Hat) #define FTRACE_NO_PIDS		(void *)(PID_MAX_LIMIT + 1)
7736345ddcc8SSteven Rostedt (Red Hat) 
7737756d17eeS[email protected] static void *fpid_start(struct seq_file *m, loff_t *pos)
7738345ddcc8SSteven Rostedt (Red Hat) 	__acquires(RCU)
7739756d17eeS[email protected] {
7740345ddcc8SSteven Rostedt (Red Hat) 	struct trace_pid_list *pid_list;
7741345ddcc8SSteven Rostedt (Red Hat) 	struct trace_array *tr = m->private;
7742345ddcc8SSteven Rostedt (Red Hat) 
7743756d17eeS[email protected] 	mutex_lock(&ftrace_lock);
7744345ddcc8SSteven Rostedt (Red Hat) 	rcu_read_lock_sched();
7745756d17eeS[email protected] 
7746345ddcc8SSteven Rostedt (Red Hat) 	pid_list = rcu_dereference_sched(tr->function_pids);
7747756d17eeS[email protected] 
7748345ddcc8SSteven Rostedt (Red Hat) 	if (!pid_list)
7749345ddcc8SSteven Rostedt (Red Hat) 		return !(*pos) ? FTRACE_NO_PIDS : NULL;
7750345ddcc8SSteven Rostedt (Red Hat) 
7751345ddcc8SSteven Rostedt (Red Hat) 	return trace_pid_start(pid_list, pos);
7752756d17eeS[email protected] }
7753756d17eeS[email protected] 
7754756d17eeS[email protected] static void *fpid_next(struct seq_file *m, void *v, loff_t *pos)
7755756d17eeS[email protected] {
7756345ddcc8SSteven Rostedt (Red Hat) 	struct trace_array *tr = m->private;
7757345ddcc8SSteven Rostedt (Red Hat) 	struct trace_pid_list *pid_list = rcu_dereference_sched(tr->function_pids);
7758345ddcc8SSteven Rostedt (Red Hat) 
7759e4075e8bSVasily Averin 	if (v == FTRACE_NO_PIDS) {
7760e4075e8bSVasily Averin 		(*pos)++;
7761756d17eeS[email protected] 		return NULL;
7762e4075e8bSVasily Averin 	}
7763345ddcc8SSteven Rostedt (Red Hat) 	return trace_pid_next(pid_list, v, pos);
7764756d17eeS[email protected] }
7765756d17eeS[email protected] 
7766756d17eeS[email protected] static void fpid_stop(struct seq_file *m, void *p)
7767345ddcc8SSteven Rostedt (Red Hat) 	__releases(RCU)
7768756d17eeS[email protected] {
7769345ddcc8SSteven Rostedt (Red Hat) 	rcu_read_unlock_sched();
7770756d17eeS[email protected] 	mutex_unlock(&ftrace_lock);
7771756d17eeS[email protected] }
7772756d17eeS[email protected] 
7773756d17eeS[email protected] static int fpid_show(struct seq_file *m, void *v)
7774756d17eeS[email protected] {
7775345ddcc8SSteven Rostedt (Red Hat) 	if (v == FTRACE_NO_PIDS) {
7776fa6f0cc7SRasmus Villemoes 		seq_puts(m, "no pid\n");
7777756d17eeS[email protected] 		return 0;
7778756d17eeS[email protected] 	}
7779756d17eeS[email protected] 
7780345ddcc8SSteven Rostedt (Red Hat) 	return trace_pid_show(m, v);
7781756d17eeS[email protected] }
7782756d17eeS[email protected] 
7783756d17eeS[email protected] static const struct seq_operations ftrace_pid_sops = {
7784756d17eeS[email protected] 	.start = fpid_start,
7785756d17eeS[email protected] 	.next = fpid_next,
7786756d17eeS[email protected] 	.stop = fpid_stop,
7787756d17eeS[email protected] 	.show = fpid_show,
7788756d17eeS[email protected] };
7789756d17eeS[email protected] 
7790b3b1e6edSSteven Rostedt (VMware) static void *fnpid_start(struct seq_file *m, loff_t *pos)
7791b3b1e6edSSteven Rostedt (VMware) 	__acquires(RCU)
7792756d17eeS[email protected] {
7793b3b1e6edSSteven Rostedt (VMware) 	struct trace_pid_list *pid_list;
7794b3b1e6edSSteven Rostedt (VMware) 	struct trace_array *tr = m->private;
7795b3b1e6edSSteven Rostedt (VMware) 
7796b3b1e6edSSteven Rostedt (VMware) 	mutex_lock(&ftrace_lock);
7797b3b1e6edSSteven Rostedt (VMware) 	rcu_read_lock_sched();
7798b3b1e6edSSteven Rostedt (VMware) 
7799b3b1e6edSSteven Rostedt (VMware) 	pid_list = rcu_dereference_sched(tr->function_no_pids);
7800b3b1e6edSSteven Rostedt (VMware) 
7801b3b1e6edSSteven Rostedt (VMware) 	if (!pid_list)
7802b3b1e6edSSteven Rostedt (VMware) 		return !(*pos) ? FTRACE_NO_PIDS : NULL;
7803b3b1e6edSSteven Rostedt (VMware) 
7804b3b1e6edSSteven Rostedt (VMware) 	return trace_pid_start(pid_list, pos);
7805b3b1e6edSSteven Rostedt (VMware) }
7806b3b1e6edSSteven Rostedt (VMware) 
7807b3b1e6edSSteven Rostedt (VMware) static void *fnpid_next(struct seq_file *m, void *v, loff_t *pos)
7808b3b1e6edSSteven Rostedt (VMware) {
7809b3b1e6edSSteven Rostedt (VMware) 	struct trace_array *tr = m->private;
7810b3b1e6edSSteven Rostedt (VMware) 	struct trace_pid_list *pid_list = rcu_dereference_sched(tr->function_no_pids);
7811b3b1e6edSSteven Rostedt (VMware) 
7812b3b1e6edSSteven Rostedt (VMware) 	if (v == FTRACE_NO_PIDS) {
7813b3b1e6edSSteven Rostedt (VMware) 		(*pos)++;
7814b3b1e6edSSteven Rostedt (VMware) 		return NULL;
7815b3b1e6edSSteven Rostedt (VMware) 	}
7816b3b1e6edSSteven Rostedt (VMware) 	return trace_pid_next(pid_list, v, pos);
7817b3b1e6edSSteven Rostedt (VMware) }
7818b3b1e6edSSteven Rostedt (VMware) 
7819b3b1e6edSSteven Rostedt (VMware) static const struct seq_operations ftrace_no_pid_sops = {
7820b3b1e6edSSteven Rostedt (VMware) 	.start = fnpid_start,
7821b3b1e6edSSteven Rostedt (VMware) 	.next = fnpid_next,
7822b3b1e6edSSteven Rostedt (VMware) 	.stop = fpid_stop,
7823b3b1e6edSSteven Rostedt (VMware) 	.show = fpid_show,
7824b3b1e6edSSteven Rostedt (VMware) };
7825b3b1e6edSSteven Rostedt (VMware) 
7826b3b1e6edSSteven Rostedt (VMware) static int pid_open(struct inode *inode, struct file *file, int type)
7827b3b1e6edSSteven Rostedt (VMware) {
7828b3b1e6edSSteven Rostedt (VMware) 	const struct seq_operations *seq_ops;
7829345ddcc8SSteven Rostedt (Red Hat) 	struct trace_array *tr = inode->i_private;
7830345ddcc8SSteven Rostedt (Red Hat) 	struct seq_file *m;
7831756d17eeS[email protected] 	int ret = 0;
7832756d17eeS[email protected] 
78338530dec6SSteven Rostedt (VMware) 	ret = tracing_check_open_get_tr(tr);
78348530dec6SSteven Rostedt (VMware) 	if (ret)
78358530dec6SSteven Rostedt (VMware) 		return ret;
7836345ddcc8SSteven Rostedt (Red Hat) 
7837756d17eeS[email protected] 	if ((file->f_mode & FMODE_WRITE) &&
7838756d17eeS[email protected] 	    (file->f_flags & O_TRUNC))
7839b3b1e6edSSteven Rostedt (VMware) 		ftrace_pid_reset(tr, type);
7840756d17eeS[email protected] 
7841b3b1e6edSSteven Rostedt (VMware) 	switch (type) {
7842b3b1e6edSSteven Rostedt (VMware) 	case TRACE_PIDS:
7843b3b1e6edSSteven Rostedt (VMware) 		seq_ops = &ftrace_pid_sops;
7844b3b1e6edSSteven Rostedt (VMware) 		break;
7845b3b1e6edSSteven Rostedt (VMware) 	case TRACE_NO_PIDS:
7846b3b1e6edSSteven Rostedt (VMware) 		seq_ops = &ftrace_no_pid_sops;
7847b3b1e6edSSteven Rostedt (VMware) 		break;
7848026bb845SKaitao Cheng 	default:
7849026bb845SKaitao Cheng 		trace_array_put(tr);
7850026bb845SKaitao Cheng 		WARN_ON_ONCE(1);
7851026bb845SKaitao Cheng 		return -EINVAL;
7852b3b1e6edSSteven Rostedt (VMware) 	}
7853b3b1e6edSSteven Rostedt (VMware) 
7854b3b1e6edSSteven Rostedt (VMware) 	ret = seq_open(file, seq_ops);
7855345ddcc8SSteven Rostedt (Red Hat) 	if (ret < 0) {
7856345ddcc8SSteven Rostedt (Red Hat) 		trace_array_put(tr);
7857345ddcc8SSteven Rostedt (Red Hat) 	} else {
7858345ddcc8SSteven Rostedt (Red Hat) 		m = file->private_data;
7859345ddcc8SSteven Rostedt (Red Hat) 		/* copy tr over to seq ops */
7860345ddcc8SSteven Rostedt (Red Hat) 		m->private = tr;
7861345ddcc8SSteven Rostedt (Red Hat) 	}
7862756d17eeS[email protected] 
7863756d17eeS[email protected] 	return ret;
7864756d17eeS[email protected] }
7865756d17eeS[email protected] 
7866b3b1e6edSSteven Rostedt (VMware) static int
7867b3b1e6edSSteven Rostedt (VMware) ftrace_pid_open(struct inode *inode, struct file *file)
7868b3b1e6edSSteven Rostedt (VMware) {
7869b3b1e6edSSteven Rostedt (VMware) 	return pid_open(inode, file, TRACE_PIDS);
7870b3b1e6edSSteven Rostedt (VMware) }
7871b3b1e6edSSteven Rostedt (VMware) 
7872b3b1e6edSSteven Rostedt (VMware) static int
7873b3b1e6edSSteven Rostedt (VMware) ftrace_no_pid_open(struct inode *inode, struct file *file)
7874b3b1e6edSSteven Rostedt (VMware) {
7875b3b1e6edSSteven Rostedt (VMware) 	return pid_open(inode, file, TRACE_NO_PIDS);
7876b3b1e6edSSteven Rostedt (VMware) }
7877b3b1e6edSSteven Rostedt (VMware) 
7878345ddcc8SSteven Rostedt (Red Hat) static void ignore_task_cpu(void *data)
7879345ddcc8SSteven Rostedt (Red Hat) {
7880345ddcc8SSteven Rostedt (Red Hat) 	struct trace_array *tr = data;
7881345ddcc8SSteven Rostedt (Red Hat) 	struct trace_pid_list *pid_list;
7882b3b1e6edSSteven Rostedt (VMware) 	struct trace_pid_list *no_pid_list;
7883345ddcc8SSteven Rostedt (Red Hat) 
7884345ddcc8SSteven Rostedt (Red Hat) 	/*
7885345ddcc8SSteven Rostedt (Red Hat) 	 * This function is called by on_each_cpu() while the
7886345ddcc8SSteven Rostedt (Red Hat) 	 * event_mutex is held.
7887345ddcc8SSteven Rostedt (Red Hat) 	 */
7888345ddcc8SSteven Rostedt (Red Hat) 	pid_list = rcu_dereference_protected(tr->function_pids,
7889345ddcc8SSteven Rostedt (Red Hat) 					     mutex_is_locked(&ftrace_lock));
7890b3b1e6edSSteven Rostedt (VMware) 	no_pid_list = rcu_dereference_protected(tr->function_no_pids,
7891b3b1e6edSSteven Rostedt (VMware) 						mutex_is_locked(&ftrace_lock));
7892345ddcc8SSteven Rostedt (Red Hat) 
7893b3b1e6edSSteven Rostedt (VMware) 	if (trace_ignore_this_task(pid_list, no_pid_list, current))
78941c5eb448SSteven Rostedt (VMware) 		this_cpu_write(tr->array_buffer.data->ftrace_ignore_pid,
7895717e3f5eSSteven Rostedt (VMware) 			       FTRACE_PID_IGNORE);
7896717e3f5eSSteven Rostedt (VMware) 	else
7897717e3f5eSSteven Rostedt (VMware) 		this_cpu_write(tr->array_buffer.data->ftrace_ignore_pid,
7898717e3f5eSSteven Rostedt (VMware) 			       current->pid);
7899345ddcc8SSteven Rostedt (Red Hat) }
7900345ddcc8SSteven Rostedt (Red Hat) 
7901df4fc315SSteven Rostedt static ssize_t
7902b3b1e6edSSteven Rostedt (VMware) pid_write(struct file *filp, const char __user *ubuf,
7903b3b1e6edSSteven Rostedt (VMware) 	  size_t cnt, loff_t *ppos, int type)
7904df4fc315SSteven Rostedt {
7905345ddcc8SSteven Rostedt (Red Hat) 	struct seq_file *m = filp->private_data;
7906345ddcc8SSteven Rostedt (Red Hat) 	struct trace_array *tr = m->private;
7907b3b1e6edSSteven Rostedt (VMware) 	struct trace_pid_list *filtered_pids;
7908b3b1e6edSSteven Rostedt (VMware) 	struct trace_pid_list *other_pids;
7909345ddcc8SSteven Rostedt (Red Hat) 	struct trace_pid_list *pid_list;
7910345ddcc8SSteven Rostedt (Red Hat) 	ssize_t ret;
7911df4fc315SSteven Rostedt 
7912345ddcc8SSteven Rostedt (Red Hat) 	if (!cnt)
7913345ddcc8SSteven Rostedt (Red Hat) 		return 0;
7914df4fc315SSteven Rostedt 
7915345ddcc8SSteven Rostedt (Red Hat) 	mutex_lock(&ftrace_lock);
7916df4fc315SSteven Rostedt 
7917b3b1e6edSSteven Rostedt (VMware) 	switch (type) {
7918b3b1e6edSSteven Rostedt (VMware) 	case TRACE_PIDS:
7919345ddcc8SSteven Rostedt (Red Hat) 		filtered_pids = rcu_dereference_protected(tr->function_pids,
7920345ddcc8SSteven Rostedt (Red Hat) 					     lockdep_is_held(&ftrace_lock));
7921b3b1e6edSSteven Rostedt (VMware) 		other_pids = rcu_dereference_protected(tr->function_no_pids,
7922b3b1e6edSSteven Rostedt (VMware) 					     lockdep_is_held(&ftrace_lock));
7923b3b1e6edSSteven Rostedt (VMware) 		break;
7924b3b1e6edSSteven Rostedt (VMware) 	case TRACE_NO_PIDS:
7925b3b1e6edSSteven Rostedt (VMware) 		filtered_pids = rcu_dereference_protected(tr->function_no_pids,
7926b3b1e6edSSteven Rostedt (VMware) 					     lockdep_is_held(&ftrace_lock));
7927b3b1e6edSSteven Rostedt (VMware) 		other_pids = rcu_dereference_protected(tr->function_pids,
7928b3b1e6edSSteven Rostedt (VMware) 					     lockdep_is_held(&ftrace_lock));
7929b3b1e6edSSteven Rostedt (VMware) 		break;
7930026bb845SKaitao Cheng 	default:
7931026bb845SKaitao Cheng 		ret = -EINVAL;
7932026bb845SKaitao Cheng 		WARN_ON_ONCE(1);
7933026bb845SKaitao Cheng 		goto out;
7934b3b1e6edSSteven Rostedt (VMware) 	}
7935345ddcc8SSteven Rostedt (Red Hat) 
7936345ddcc8SSteven Rostedt (Red Hat) 	ret = trace_pid_write(filtered_pids, &pid_list, ubuf, cnt);
7937345ddcc8SSteven Rostedt (Red Hat) 	if (ret < 0)
7938345ddcc8SSteven Rostedt (Red Hat) 		goto out;
7939345ddcc8SSteven Rostedt (Red Hat) 
7940b3b1e6edSSteven Rostedt (VMware) 	switch (type) {
7941b3b1e6edSSteven Rostedt (VMware) 	case TRACE_PIDS:
7942345ddcc8SSteven Rostedt (Red Hat) 		rcu_assign_pointer(tr->function_pids, pid_list);
7943b3b1e6edSSteven Rostedt (VMware) 		break;
7944b3b1e6edSSteven Rostedt (VMware) 	case TRACE_NO_PIDS:
7945b3b1e6edSSteven Rostedt (VMware) 		rcu_assign_pointer(tr->function_no_pids, pid_list);
7946b3b1e6edSSteven Rostedt (VMware) 		break;
7947b3b1e6edSSteven Rostedt (VMware) 	}
7948b3b1e6edSSteven Rostedt (VMware) 
7949345ddcc8SSteven Rostedt (Red Hat) 
7950345ddcc8SSteven Rostedt (Red Hat) 	if (filtered_pids) {
795174401729SPaul E. McKenney 		synchronize_rcu();
79526954e415SSteven Rostedt (VMware) 		trace_pid_list_free(filtered_pids);
7953b3b1e6edSSteven Rostedt (VMware) 	} else if (pid_list && !other_pids) {
7954345ddcc8SSteven Rostedt (Red Hat) 		/* Register a probe to set whether to ignore the tracing of a task */
7955345ddcc8SSteven Rostedt (Red Hat) 		register_trace_sched_switch(ftrace_filter_pid_sched_switch_probe, tr);
7956345ddcc8SSteven Rostedt (Red Hat) 	}
7957df4fc315SSteven Rostedt 
7958756d17eeS[email protected] 	/*
7959345ddcc8SSteven Rostedt (Red Hat) 	 * Ignoring of pids is done at task switch. But we have to
7960345ddcc8SSteven Rostedt (Red Hat) 	 * check for those tasks that are currently running.
7961345ddcc8SSteven Rostedt (Red Hat) 	 * Always do this in case a pid was appended or removed.
7962756d17eeS[email protected] 	 */
7963345ddcc8SSteven Rostedt (Red Hat) 	on_each_cpu(ignore_task_cpu, tr, 1);
7964756d17eeS[email protected] 
7965345ddcc8SSteven Rostedt (Red Hat) 	ftrace_update_pid_func();
7966345ddcc8SSteven Rostedt (Red Hat) 	ftrace_startup_all(0);
7967345ddcc8SSteven Rostedt (Red Hat)  out:
7968345ddcc8SSteven Rostedt (Red Hat) 	mutex_unlock(&ftrace_lock);
7969345ddcc8SSteven Rostedt (Red Hat) 
7970345ddcc8SSteven Rostedt (Red Hat) 	if (ret > 0)
7971345ddcc8SSteven Rostedt (Red Hat) 		*ppos += ret;
7972345ddcc8SSteven Rostedt (Red Hat) 
7973df4fc315SSteven Rostedt 	return ret;
7974e32d8956SSteven Rostedt }
7975978f3a45SSteven Rostedt 
7976b3b1e6edSSteven Rostedt (VMware) static ssize_t
7977b3b1e6edSSteven Rostedt (VMware) ftrace_pid_write(struct file *filp, const char __user *ubuf,
7978b3b1e6edSSteven Rostedt (VMware) 		 size_t cnt, loff_t *ppos)
7979b3b1e6edSSteven Rostedt (VMware) {
7980b3b1e6edSSteven Rostedt (VMware) 	return pid_write(filp, ubuf, cnt, ppos, TRACE_PIDS);
7981b3b1e6edSSteven Rostedt (VMware) }
7982b3b1e6edSSteven Rostedt (VMware) 
7983b3b1e6edSSteven Rostedt (VMware) static ssize_t
7984b3b1e6edSSteven Rostedt (VMware) ftrace_no_pid_write(struct file *filp, const char __user *ubuf,
7985b3b1e6edSSteven Rostedt (VMware) 		    size_t cnt, loff_t *ppos)
7986b3b1e6edSSteven Rostedt (VMware) {
7987b3b1e6edSSteven Rostedt (VMware) 	return pid_write(filp, ubuf, cnt, ppos, TRACE_NO_PIDS);
7988b3b1e6edSSteven Rostedt (VMware) }
7989b3b1e6edSSteven Rostedt (VMware) 
7990756d17eeS[email protected] static int
7991756d17eeS[email protected] ftrace_pid_release(struct inode *inode, struct file *file)
7992756d17eeS[email protected] {
7993345ddcc8SSteven Rostedt (Red Hat) 	struct trace_array *tr = inode->i_private;
7994978f3a45SSteven Rostedt 
7995345ddcc8SSteven Rostedt (Red Hat) 	trace_array_put(tr);
7996345ddcc8SSteven Rostedt (Red Hat) 
7997345ddcc8SSteven Rostedt (Red Hat) 	return seq_release(inode, file);
7998df4fc315SSteven Rostedt }
7999df4fc315SSteven Rostedt 
80005e2336a0SSteven Rostedt static const struct file_operations ftrace_pid_fops = {
8001756d17eeS[email protected] 	.open		= ftrace_pid_open,
8002df4fc315SSteven Rostedt 	.write		= ftrace_pid_write,
8003756d17eeS[email protected] 	.read		= seq_read,
8004098c879eSSteven Rostedt (Red Hat) 	.llseek		= tracing_lseek,
8005756d17eeS[email protected] 	.release	= ftrace_pid_release,
8006df4fc315SSteven Rostedt };
8007df4fc315SSteven Rostedt 
8008b3b1e6edSSteven Rostedt (VMware) static const struct file_operations ftrace_no_pid_fops = {
8009b3b1e6edSSteven Rostedt (VMware) 	.open		= ftrace_no_pid_open,
8010b3b1e6edSSteven Rostedt (VMware) 	.write		= ftrace_no_pid_write,
8011b3b1e6edSSteven Rostedt (VMware) 	.read		= seq_read,
8012b3b1e6edSSteven Rostedt (VMware) 	.llseek		= tracing_lseek,
8013b3b1e6edSSteven Rostedt (VMware) 	.release	= ftrace_pid_release,
8014b3b1e6edSSteven Rostedt (VMware) };
8015b3b1e6edSSteven Rostedt (VMware) 
8016345ddcc8SSteven Rostedt (Red Hat) void ftrace_init_tracefs(struct trace_array *tr, struct dentry *d_tracer)
8017df4fc315SSteven Rostedt {
801821ccc9cdSSteven Rostedt (VMware) 	trace_create_file("set_ftrace_pid", TRACE_MODE_WRITE, d_tracer,
8019345ddcc8SSteven Rostedt (Red Hat) 			    tr, &ftrace_pid_fops);
802021ccc9cdSSteven Rostedt (VMware) 	trace_create_file("set_ftrace_notrace_pid", TRACE_MODE_WRITE,
802121ccc9cdSSteven Rostedt (VMware) 			  d_tracer, tr, &ftrace_no_pid_fops);
8022df4fc315SSteven Rostedt }
8023df4fc315SSteven Rostedt 
8024501c2375SSteven Rostedt (Red Hat) void __init ftrace_init_tracefs_toplevel(struct trace_array *tr,
8025501c2375SSteven Rostedt (Red Hat) 					 struct dentry *d_tracer)
8026501c2375SSteven Rostedt (Red Hat) {
8027501c2375SSteven Rostedt (Red Hat) 	/* Only the top level directory has the dyn_tracefs and profile */
8028501c2375SSteven Rostedt (Red Hat) 	WARN_ON(!(tr->flags & TRACE_ARRAY_FL_GLOBAL));
8029501c2375SSteven Rostedt (Red Hat) 
8030501c2375SSteven Rostedt (Red Hat) 	ftrace_init_dyn_tracefs(d_tracer);
8031501c2375SSteven Rostedt (Red Hat) 	ftrace_profile_tracefs(d_tracer);
8032501c2375SSteven Rostedt (Red Hat) }
8033501c2375SSteven Rostedt (Red Hat) 
80343d083395SSteven Rostedt /**
803581adbdc0SSteven Rostedt  * ftrace_kill - kill ftrace
8036a2bb6a3dSSteven Rostedt  *
8037a2bb6a3dSSteven Rostedt  * This function should be used by panic code. It stops ftrace
8038a2bb6a3dSSteven Rostedt  * but in a not so nice way. If you need to simply kill ftrace
8039a2bb6a3dSSteven Rostedt  * from a non-atomic section, use ftrace_kill.
8040a2bb6a3dSSteven Rostedt  */
804181adbdc0SSteven Rostedt void ftrace_kill(void)
8042a2bb6a3dSSteven Rostedt {
8043a2bb6a3dSSteven Rostedt 	ftrace_disabled = 1;
8044a2bb6a3dSSteven Rostedt 	ftrace_enabled = 0;
80455ccba64aSYisheng Xie 	ftrace_trace_function = ftrace_stub;
8046a2bb6a3dSSteven Rostedt }
8047a2bb6a3dSSteven Rostedt 
8048a2bb6a3dSSteven Rostedt /**
80496130722fSSteven Rostedt (VMware)  * ftrace_is_dead - Test if ftrace is dead or not.
80506130722fSSteven Rostedt (VMware)  *
80516130722fSSteven Rostedt (VMware)  * Returns 1 if ftrace is "dead", zero otherwise.
8052e0a413f6SSteven Rostedt  */
8053e0a413f6SSteven Rostedt int ftrace_is_dead(void)
8054e0a413f6SSteven Rostedt {
8055e0a413f6SSteven Rostedt 	return ftrace_disabled;
8056e0a413f6SSteven Rostedt }
8057e0a413f6SSteven Rostedt 
805853cd885bSSong Liu #ifdef CONFIG_DYNAMIC_FTRACE_WITH_DIRECT_CALLS
805953cd885bSSong Liu /*
806053cd885bSSong Liu  * When registering ftrace_ops with IPMODIFY, it is necessary to make sure
806153cd885bSSong Liu  * it doesn't conflict with any direct ftrace_ops. If there is existing
806253cd885bSSong Liu  * direct ftrace_ops on a kernel function being patched, call
806353cd885bSSong Liu  * FTRACE_OPS_CMD_ENABLE_SHARE_IPMODIFY_PEER on it to enable sharing.
806453cd885bSSong Liu  *
806553cd885bSSong Liu  * @ops:     ftrace_ops being registered.
806653cd885bSSong Liu  *
806753cd885bSSong Liu  * Returns:
806853cd885bSSong Liu  *         0 on success;
806953cd885bSSong Liu  *         Negative on failure.
807053cd885bSSong Liu  */
807153cd885bSSong Liu static int prepare_direct_functions_for_ipmodify(struct ftrace_ops *ops)
807253cd885bSSong Liu {
807353cd885bSSong Liu 	struct ftrace_func_entry *entry;
807453cd885bSSong Liu 	struct ftrace_hash *hash;
807553cd885bSSong Liu 	struct ftrace_ops *op;
807653cd885bSSong Liu 	int size, i, ret;
807753cd885bSSong Liu 
807853cd885bSSong Liu 	lockdep_assert_held_once(&direct_mutex);
807953cd885bSSong Liu 
808053cd885bSSong Liu 	if (!(ops->flags & FTRACE_OPS_FL_IPMODIFY))
808153cd885bSSong Liu 		return 0;
808253cd885bSSong Liu 
808353cd885bSSong Liu 	hash = ops->func_hash->filter_hash;
808453cd885bSSong Liu 	size = 1 << hash->size_bits;
808553cd885bSSong Liu 	for (i = 0; i < size; i++) {
808653cd885bSSong Liu 		hlist_for_each_entry(entry, &hash->buckets[i], hlist) {
808753cd885bSSong Liu 			unsigned long ip = entry->ip;
808853cd885bSSong Liu 			bool found_op = false;
808953cd885bSSong Liu 
809053cd885bSSong Liu 			mutex_lock(&ftrace_lock);
809153cd885bSSong Liu 			do_for_each_ftrace_op(op, ftrace_ops_list) {
809253cd885bSSong Liu 				if (!(op->flags & FTRACE_OPS_FL_DIRECT))
809353cd885bSSong Liu 					continue;
809453cd885bSSong Liu 				if (ops_references_ip(op, ip)) {
809553cd885bSSong Liu 					found_op = true;
809653cd885bSSong Liu 					break;
809753cd885bSSong Liu 				}
809853cd885bSSong Liu 			} while_for_each_ftrace_op(op);
809953cd885bSSong Liu 			mutex_unlock(&ftrace_lock);
810053cd885bSSong Liu 
810153cd885bSSong Liu 			if (found_op) {
810253cd885bSSong Liu 				if (!op->ops_func)
810353cd885bSSong Liu 					return -EBUSY;
810453cd885bSSong Liu 
810553cd885bSSong Liu 				ret = op->ops_func(op, FTRACE_OPS_CMD_ENABLE_SHARE_IPMODIFY_PEER);
810653cd885bSSong Liu 				if (ret)
810753cd885bSSong Liu 					return ret;
810853cd885bSSong Liu 			}
810953cd885bSSong Liu 		}
811053cd885bSSong Liu 	}
811153cd885bSSong Liu 
811253cd885bSSong Liu 	return 0;
811353cd885bSSong Liu }
811453cd885bSSong Liu 
811553cd885bSSong Liu /*
811653cd885bSSong Liu  * Similar to prepare_direct_functions_for_ipmodify, clean up after ops
811753cd885bSSong Liu  * with IPMODIFY is unregistered. The cleanup is optional for most DIRECT
811853cd885bSSong Liu  * ops.
811953cd885bSSong Liu  */
812053cd885bSSong Liu static void cleanup_direct_functions_after_ipmodify(struct ftrace_ops *ops)
812153cd885bSSong Liu {
812253cd885bSSong Liu 	struct ftrace_func_entry *entry;
812353cd885bSSong Liu 	struct ftrace_hash *hash;
812453cd885bSSong Liu 	struct ftrace_ops *op;
812553cd885bSSong Liu 	int size, i;
812653cd885bSSong Liu 
812753cd885bSSong Liu 	if (!(ops->flags & FTRACE_OPS_FL_IPMODIFY))
812853cd885bSSong Liu 		return;
812953cd885bSSong Liu 
813053cd885bSSong Liu 	mutex_lock(&direct_mutex);
813153cd885bSSong Liu 
813253cd885bSSong Liu 	hash = ops->func_hash->filter_hash;
813353cd885bSSong Liu 	size = 1 << hash->size_bits;
813453cd885bSSong Liu 	for (i = 0; i < size; i++) {
813553cd885bSSong Liu 		hlist_for_each_entry(entry, &hash->buckets[i], hlist) {
813653cd885bSSong Liu 			unsigned long ip = entry->ip;
813753cd885bSSong Liu 			bool found_op = false;
813853cd885bSSong Liu 
813953cd885bSSong Liu 			mutex_lock(&ftrace_lock);
814053cd885bSSong Liu 			do_for_each_ftrace_op(op, ftrace_ops_list) {
814153cd885bSSong Liu 				if (!(op->flags & FTRACE_OPS_FL_DIRECT))
814253cd885bSSong Liu 					continue;
814353cd885bSSong Liu 				if (ops_references_ip(op, ip)) {
814453cd885bSSong Liu 					found_op = true;
814553cd885bSSong Liu 					break;
814653cd885bSSong Liu 				}
814753cd885bSSong Liu 			} while_for_each_ftrace_op(op);
814853cd885bSSong Liu 			mutex_unlock(&ftrace_lock);
814953cd885bSSong Liu 
815053cd885bSSong Liu 			/* The cleanup is optional, ignore any errors */
815153cd885bSSong Liu 			if (found_op && op->ops_func)
815253cd885bSSong Liu 				op->ops_func(op, FTRACE_OPS_CMD_DISABLE_SHARE_IPMODIFY_PEER);
815353cd885bSSong Liu 		}
815453cd885bSSong Liu 	}
815553cd885bSSong Liu 	mutex_unlock(&direct_mutex);
815653cd885bSSong Liu }
815753cd885bSSong Liu 
815853cd885bSSong Liu #define lock_direct_mutex()	mutex_lock(&direct_mutex)
815953cd885bSSong Liu #define unlock_direct_mutex()	mutex_unlock(&direct_mutex)
816053cd885bSSong Liu 
816153cd885bSSong Liu #else  /* CONFIG_DYNAMIC_FTRACE_WITH_DIRECT_CALLS */
816253cd885bSSong Liu 
816353cd885bSSong Liu static int prepare_direct_functions_for_ipmodify(struct ftrace_ops *ops)
816453cd885bSSong Liu {
816553cd885bSSong Liu 	return 0;
816653cd885bSSong Liu }
816753cd885bSSong Liu 
816853cd885bSSong Liu static void cleanup_direct_functions_after_ipmodify(struct ftrace_ops *ops)
816953cd885bSSong Liu {
817053cd885bSSong Liu }
817153cd885bSSong Liu 
817253cd885bSSong Liu #define lock_direct_mutex()	do { } while (0)
817353cd885bSSong Liu #define unlock_direct_mutex()	do { } while (0)
817453cd885bSSong Liu 
817553cd885bSSong Liu #endif  /* CONFIG_DYNAMIC_FTRACE_WITH_DIRECT_CALLS */
817653cd885bSSong Liu 
817753cd885bSSong Liu /*
817853cd885bSSong Liu  * Similar to register_ftrace_function, except we don't lock direct_mutex.
817953cd885bSSong Liu  */
818053cd885bSSong Liu static int register_ftrace_function_nolock(struct ftrace_ops *ops)
818153cd885bSSong Liu {
818253cd885bSSong Liu 	int ret;
818353cd885bSSong Liu 
818453cd885bSSong Liu 	ftrace_ops_init(ops);
818553cd885bSSong Liu 
818653cd885bSSong Liu 	mutex_lock(&ftrace_lock);
818753cd885bSSong Liu 
818853cd885bSSong Liu 	ret = ftrace_startup(ops, 0);
818953cd885bSSong Liu 
819053cd885bSSong Liu 	mutex_unlock(&ftrace_lock);
819153cd885bSSong Liu 
819253cd885bSSong Liu 	return ret;
819353cd885bSSong Liu }
819453cd885bSSong Liu 
8195e0a413f6SSteven Rostedt /**
81963d083395SSteven Rostedt  * register_ftrace_function - register a function for profiling
819778cbc651SJiapeng Chong  * @ops:	ops structure that holds the function for profiling.
81983d083395SSteven Rostedt  *
81993d083395SSteven Rostedt  * Register a function to be called by all functions in the
82003d083395SSteven Rostedt  * kernel.
82013d083395SSteven Rostedt  *
82023d083395SSteven Rostedt  * Note: @ops->func and all the functions it calls must be labeled
82033d083395SSteven Rostedt  *       with "notrace", otherwise it will go into a
82043d083395SSteven Rostedt  *       recursive loop.
82053d083395SSteven Rostedt  */
82063d083395SSteven Rostedt int register_ftrace_function(struct ftrace_ops *ops)
82073d083395SSteven Rostedt {
82083b1a8f45SColin Ian King 	int ret;
82094eebcc81SSteven Rostedt 
821053cd885bSSong Liu 	lock_direct_mutex();
821153cd885bSSong Liu 	ret = prepare_direct_functions_for_ipmodify(ops);
821253cd885bSSong Liu 	if (ret < 0)
821353cd885bSSong Liu 		goto out_unlock;
8214f04f24fbSMasami Hiramatsu 
821553cd885bSSong Liu 	ret = register_ftrace_function_nolock(ops);
8216e7d3737eSFrederic Weisbecker 
821753cd885bSSong Liu out_unlock:
821853cd885bSSong Liu 	unlock_direct_mutex();
8219b0fc494fSSteven Rostedt 	return ret;
82203d083395SSteven Rostedt }
8221cdbe61bfSSteven Rostedt EXPORT_SYMBOL_GPL(register_ftrace_function);
82223d083395SSteven Rostedt 
82233d083395SSteven Rostedt /**
822432632920SUwe Kleine-Koenig  * unregister_ftrace_function - unregister a function for profiling.
822578cbc651SJiapeng Chong  * @ops:	ops structure that holds the function to unregister
82263d083395SSteven Rostedt  *
82273d083395SSteven Rostedt  * Unregister a function that was added to be called by ftrace profiling.
82283d083395SSteven Rostedt  */
82293d083395SSteven Rostedt int unregister_ftrace_function(struct ftrace_ops *ops)
82303d083395SSteven Rostedt {
82313d083395SSteven Rostedt 	int ret;
82323d083395SSteven Rostedt 
8233e6ea44e9SSteven Rostedt 	mutex_lock(&ftrace_lock);
82348a56d776SSteven Rostedt (Red Hat) 	ret = ftrace_shutdown(ops, 0);
8235e6ea44e9SSteven Rostedt 	mutex_unlock(&ftrace_lock);
8236b0fc494fSSteven Rostedt 
823753cd885bSSong Liu 	cleanup_direct_functions_after_ipmodify(ops);
8238b0fc494fSSteven Rostedt 	return ret;
8239b0fc494fSSteven Rostedt }
8240cdbe61bfSSteven Rostedt EXPORT_SYMBOL_GPL(unregister_ftrace_function);
8241b0fc494fSSteven Rostedt 
8242bed0d9a5SJiri Olsa static int symbols_cmp(const void *a, const void *b)
8243bed0d9a5SJiri Olsa {
8244bed0d9a5SJiri Olsa 	const char **str_a = (const char **) a;
8245bed0d9a5SJiri Olsa 	const char **str_b = (const char **) b;
8246bed0d9a5SJiri Olsa 
8247bed0d9a5SJiri Olsa 	return strcmp(*str_a, *str_b);
8248bed0d9a5SJiri Olsa }
8249bed0d9a5SJiri Olsa 
8250bed0d9a5SJiri Olsa struct kallsyms_data {
8251bed0d9a5SJiri Olsa 	unsigned long *addrs;
8252bed0d9a5SJiri Olsa 	const char **syms;
8253bed0d9a5SJiri Olsa 	size_t cnt;
8254bed0d9a5SJiri Olsa 	size_t found;
8255bed0d9a5SJiri Olsa };
8256bed0d9a5SJiri Olsa 
8257bed0d9a5SJiri Olsa static int kallsyms_callback(void *data, const char *name,
8258bed0d9a5SJiri Olsa 			     struct module *mod, unsigned long addr)
8259bed0d9a5SJiri Olsa {
8260bed0d9a5SJiri Olsa 	struct kallsyms_data *args = data;
8261eb1b2985SJiri Olsa 	const char **sym;
8262eb1b2985SJiri Olsa 	int idx;
8263bed0d9a5SJiri Olsa 
8264eb1b2985SJiri Olsa 	sym = bsearch(&name, args->syms, args->cnt, sizeof(*args->syms), symbols_cmp);
8265eb1b2985SJiri Olsa 	if (!sym)
8266eb1b2985SJiri Olsa 		return 0;
8267eb1b2985SJiri Olsa 
8268eb1b2985SJiri Olsa 	idx = sym - args->syms;
8269eb1b2985SJiri Olsa 	if (args->addrs[idx])
8270bed0d9a5SJiri Olsa 		return 0;
8271bed0d9a5SJiri Olsa 
8272bed0d9a5SJiri Olsa 	addr = ftrace_location(addr);
8273bed0d9a5SJiri Olsa 	if (!addr)
8274bed0d9a5SJiri Olsa 		return 0;
8275bed0d9a5SJiri Olsa 
8276eb1b2985SJiri Olsa 	args->addrs[idx] = addr;
8277eb1b2985SJiri Olsa 	args->found++;
8278bed0d9a5SJiri Olsa 	return args->found == args->cnt ? 1 : 0;
8279bed0d9a5SJiri Olsa }
8280bed0d9a5SJiri Olsa 
8281bed0d9a5SJiri Olsa /**
8282bed0d9a5SJiri Olsa  * ftrace_lookup_symbols - Lookup addresses for array of symbols
8283bed0d9a5SJiri Olsa  *
8284bed0d9a5SJiri Olsa  * @sorted_syms: array of symbols pointers symbols to resolve,
8285bed0d9a5SJiri Olsa  * must be alphabetically sorted
8286bed0d9a5SJiri Olsa  * @cnt: number of symbols/addresses in @syms/@addrs arrays
8287bed0d9a5SJiri Olsa  * @addrs: array for storing resulting addresses
8288bed0d9a5SJiri Olsa  *
8289bed0d9a5SJiri Olsa  * This function looks up addresses for array of symbols provided in
8290bed0d9a5SJiri Olsa  * @syms array (must be alphabetically sorted) and stores them in
8291bed0d9a5SJiri Olsa  * @addrs array, which needs to be big enough to store at least @cnt
8292bed0d9a5SJiri Olsa  * addresses.
8293bed0d9a5SJiri Olsa  *
8294bed0d9a5SJiri Olsa  * This function returns 0 if all provided symbols are found,
8295bed0d9a5SJiri Olsa  * -ESRCH otherwise.
8296bed0d9a5SJiri Olsa  */
8297bed0d9a5SJiri Olsa int ftrace_lookup_symbols(const char **sorted_syms, size_t cnt, unsigned long *addrs)
8298bed0d9a5SJiri Olsa {
8299bed0d9a5SJiri Olsa 	struct kallsyms_data args;
8300bed0d9a5SJiri Olsa 	int err;
8301bed0d9a5SJiri Olsa 
8302eb1b2985SJiri Olsa 	memset(addrs, 0, sizeof(*addrs) * cnt);
8303bed0d9a5SJiri Olsa 	args.addrs = addrs;
8304bed0d9a5SJiri Olsa 	args.syms = sorted_syms;
8305bed0d9a5SJiri Olsa 	args.cnt = cnt;
8306bed0d9a5SJiri Olsa 	args.found = 0;
8307bed0d9a5SJiri Olsa 	err = kallsyms_on_each_symbol(kallsyms_callback, &args);
8308bed0d9a5SJiri Olsa 	if (err < 0)
8309bed0d9a5SJiri Olsa 		return err;
8310bed0d9a5SJiri Olsa 	return args.found == args.cnt ? 0 : -ESRCH;
8311bed0d9a5SJiri Olsa }
831244d35720SLinus Torvalds 
83135d79fa0dSYueHaibing #ifdef CONFIG_SYSCTL
83148fd7c214SLuis Chamberlain 
83158fd7c214SLuis Chamberlain #ifdef CONFIG_DYNAMIC_FTRACE
8316f8b7d2b4SLuis Chamberlain static void ftrace_startup_sysctl(void)
8317f8b7d2b4SLuis Chamberlain {
8318f8b7d2b4SLuis Chamberlain 	int command;
8319f8b7d2b4SLuis Chamberlain 
8320f8b7d2b4SLuis Chamberlain 	if (unlikely(ftrace_disabled))
8321f8b7d2b4SLuis Chamberlain 		return;
8322f8b7d2b4SLuis Chamberlain 
8323f8b7d2b4SLuis Chamberlain 	/* Force update next time */
8324f8b7d2b4SLuis Chamberlain 	saved_ftrace_func = NULL;
8325f8b7d2b4SLuis Chamberlain 	/* ftrace_start_up is true if we want ftrace running */
8326f8b7d2b4SLuis Chamberlain 	if (ftrace_start_up) {
8327f8b7d2b4SLuis Chamberlain 		command = FTRACE_UPDATE_CALLS;
8328f8b7d2b4SLuis Chamberlain 		if (ftrace_graph_active)
8329f8b7d2b4SLuis Chamberlain 			command |= FTRACE_START_FUNC_RET;
8330f8b7d2b4SLuis Chamberlain 		ftrace_startup_enable(command);
8331f8b7d2b4SLuis Chamberlain 	}
8332f8b7d2b4SLuis Chamberlain }
8333f8b7d2b4SLuis Chamberlain 
8334f8b7d2b4SLuis Chamberlain static void ftrace_shutdown_sysctl(void)
8335f8b7d2b4SLuis Chamberlain {
8336f8b7d2b4SLuis Chamberlain 	int command;
8337f8b7d2b4SLuis Chamberlain 
8338f8b7d2b4SLuis Chamberlain 	if (unlikely(ftrace_disabled))
8339f8b7d2b4SLuis Chamberlain 		return;
8340f8b7d2b4SLuis Chamberlain 
8341f8b7d2b4SLuis Chamberlain 	/* ftrace_start_up is true if ftrace is running */
8342f8b7d2b4SLuis Chamberlain 	if (ftrace_start_up) {
8343f8b7d2b4SLuis Chamberlain 		command = FTRACE_DISABLE_CALLS;
8344f8b7d2b4SLuis Chamberlain 		if (ftrace_graph_active)
8345f8b7d2b4SLuis Chamberlain 			command |= FTRACE_STOP_FUNC_RET;
8346f8b7d2b4SLuis Chamberlain 		ftrace_run_update_code(command);
8347f8b7d2b4SLuis Chamberlain 	}
8348f8b7d2b4SLuis Chamberlain }
83498fd7c214SLuis Chamberlain #else
83508fd7c214SLuis Chamberlain # define ftrace_startup_sysctl()       do { } while (0)
83518fd7c214SLuis Chamberlain # define ftrace_shutdown_sysctl()      do { } while (0)
83528fd7c214SLuis Chamberlain #endif /* CONFIG_DYNAMIC_FTRACE */
8353f8b7d2b4SLuis Chamberlain 
83547162431dSMiroslav Benes static bool is_permanent_ops_registered(void)
83557162431dSMiroslav Benes {
83567162431dSMiroslav Benes 	struct ftrace_ops *op;
83577162431dSMiroslav Benes 
83587162431dSMiroslav Benes 	do_for_each_ftrace_op(op, ftrace_ops_list) {
83597162431dSMiroslav Benes 		if (op->flags & FTRACE_OPS_FL_PERMANENT)
83607162431dSMiroslav Benes 			return true;
83617162431dSMiroslav Benes 	} while_for_each_ftrace_op(op);
83627162431dSMiroslav Benes 
83637162431dSMiroslav Benes 	return false;
83647162431dSMiroslav Benes }
83657162431dSMiroslav Benes 
83668e4e83b2SWei Xiao static int
8367b0fc494fSSteven Rostedt ftrace_enable_sysctl(struct ctl_table *table, int write,
836854fa9ba5STobias Klauser 		     void *buffer, size_t *lenp, loff_t *ppos)
8369b0fc494fSSteven Rostedt {
837045a4a237SSteven Rostedt 	int ret = -ENODEV;
83714eebcc81SSteven Rostedt 
8372e6ea44e9SSteven Rostedt 	mutex_lock(&ftrace_lock);
8373b0fc494fSSteven Rostedt 
837445a4a237SSteven Rostedt 	if (unlikely(ftrace_disabled))
837545a4a237SSteven Rostedt 		goto out;
837645a4a237SSteven Rostedt 
83778d65af78SAlexey Dobriyan 	ret = proc_dointvec(table, write, buffer, lenp, ppos);
8378b0fc494fSSteven Rostedt 
8379a32c7765SLi Zefan 	if (ret || !write || (last_ftrace_enabled == !!ftrace_enabled))
8380b0fc494fSSteven Rostedt 		goto out;
8381b0fc494fSSteven Rostedt 
8382b0fc494fSSteven Rostedt 	if (ftrace_enabled) {
8383b0fc494fSSteven Rostedt 
8384b0fc494fSSteven Rostedt 		/* we are starting ftrace again */
8385f86f4180SChunyan Zhang 		if (rcu_dereference_protected(ftrace_ops_list,
8386f86f4180SChunyan Zhang 			lockdep_is_held(&ftrace_lock)) != &ftrace_list_end)
83875000c418SJan Kiszka 			update_ftrace_function();
8388b0fc494fSSteven Rostedt 
8389524a3868SSteven Rostedt (Red Hat) 		ftrace_startup_sysctl();
8390524a3868SSteven Rostedt (Red Hat) 
8391b0fc494fSSteven Rostedt 	} else {
83927162431dSMiroslav Benes 		if (is_permanent_ops_registered()) {
83937162431dSMiroslav Benes 			ftrace_enabled = true;
83947162431dSMiroslav Benes 			ret = -EBUSY;
83957162431dSMiroslav Benes 			goto out;
83967162431dSMiroslav Benes 		}
83977162431dSMiroslav Benes 
8398b0fc494fSSteven Rostedt 		/* stopping ftrace calls (just send to ftrace_stub) */
8399b0fc494fSSteven Rostedt 		ftrace_trace_function = ftrace_stub;
8400b0fc494fSSteven Rostedt 
8401b0fc494fSSteven Rostedt 		ftrace_shutdown_sysctl();
8402b0fc494fSSteven Rostedt 	}
8403b0fc494fSSteven Rostedt 
84047162431dSMiroslav Benes 	last_ftrace_enabled = !!ftrace_enabled;
8405b0fc494fSSteven Rostedt  out:
8406e6ea44e9SSteven Rostedt 	mutex_unlock(&ftrace_lock);
84073d083395SSteven Rostedt 	return ret;
840816444a8aSArnaldo Carvalho de Melo }
84098e4e83b2SWei Xiao 
84108e4e83b2SWei Xiao static struct ctl_table ftrace_sysctls[] = {
84118e4e83b2SWei Xiao 	{
84128e4e83b2SWei Xiao 		.procname       = "ftrace_enabled",
84138e4e83b2SWei Xiao 		.data           = &ftrace_enabled,
84148e4e83b2SWei Xiao 		.maxlen         = sizeof(int),
84158e4e83b2SWei Xiao 		.mode           = 0644,
84168e4e83b2SWei Xiao 		.proc_handler   = ftrace_enable_sysctl,
84178e4e83b2SWei Xiao 	},
84188e4e83b2SWei Xiao 	{}
84198e4e83b2SWei Xiao };
84208e4e83b2SWei Xiao 
84218e4e83b2SWei Xiao static int __init ftrace_sysctl_init(void)
84228e4e83b2SWei Xiao {
84238e4e83b2SWei Xiao 	register_sysctl_init("kernel", ftrace_sysctls);
84248e4e83b2SWei Xiao 	return 0;
84258e4e83b2SWei Xiao }
84268e4e83b2SWei Xiao late_initcall(ftrace_sysctl_init);
84278e4e83b2SWei Xiao #endif
8428