xref: /linux-6.15/kernel/trace/ftrace.c (revision 30f7d1ca)
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 
1647cf04f2d5SSteven Rostedt (Google) static bool skip_record(struct dyn_ftrace *rec)
1648cf04f2d5SSteven Rostedt (Google) {
1649cf04f2d5SSteven Rostedt (Google) 	/*
1650cf04f2d5SSteven Rostedt (Google) 	 * At boot up, weak functions are set to disable. Function tracing
1651cf04f2d5SSteven Rostedt (Google) 	 * can be enabled before they are, and they still need to be disabled now.
1652cf04f2d5SSteven Rostedt (Google) 	 * If the record is disabled, still continue if it is marked as already
1653cf04f2d5SSteven Rostedt (Google) 	 * enabled (this is needed to keep the accounting working).
1654cf04f2d5SSteven Rostedt (Google) 	 */
1655cf04f2d5SSteven Rostedt (Google) 	return rec->flags & FTRACE_FL_DISABLED &&
1656cf04f2d5SSteven Rostedt (Google) 		!(rec->flags & FTRACE_FL_ENABLED);
1657cf04f2d5SSteven Rostedt (Google) }
1658cf04f2d5SSteven Rostedt (Google) 
165984b6d3e6SJiri Olsa static bool __ftrace_hash_rec_update(struct ftrace_ops *ops,
1660ed926f9bSSteven Rostedt 				     int filter_hash,
1661ed926f9bSSteven Rostedt 				     bool inc)
1662ed926f9bSSteven Rostedt {
1663ed926f9bSSteven Rostedt 	struct ftrace_hash *hash;
1664ed926f9bSSteven Rostedt 	struct ftrace_hash *other_hash;
1665ed926f9bSSteven Rostedt 	struct ftrace_page *pg;
1666ed926f9bSSteven Rostedt 	struct dyn_ftrace *rec;
166784b6d3e6SJiri Olsa 	bool update = false;
1668ed926f9bSSteven Rostedt 	int count = 0;
16698c08f0d5SSteven Rostedt (VMware) 	int all = false;
1670ed926f9bSSteven Rostedt 
1671ed926f9bSSteven Rostedt 	/* Only update if the ops has been registered */
1672ed926f9bSSteven Rostedt 	if (!(ops->flags & FTRACE_OPS_FL_ENABLED))
167384b6d3e6SJiri Olsa 		return false;
1674ed926f9bSSteven Rostedt 
1675ed926f9bSSteven Rostedt 	/*
1676ed926f9bSSteven Rostedt 	 * In the filter_hash case:
1677ed926f9bSSteven Rostedt 	 *   If the count is zero, we update all records.
1678ed926f9bSSteven Rostedt 	 *   Otherwise we just update the items in the hash.
1679ed926f9bSSteven Rostedt 	 *
1680ed926f9bSSteven Rostedt 	 * In the notrace_hash case:
1681ed926f9bSSteven Rostedt 	 *   We enable the update in the hash.
1682ed926f9bSSteven Rostedt 	 *   As disabling notrace means enabling the tracing,
1683ed926f9bSSteven Rostedt 	 *   and enabling notrace means disabling, the inc variable
1684ed926f9bSSteven Rostedt 	 *   gets inversed.
1685ed926f9bSSteven Rostedt 	 */
1686ed926f9bSSteven Rostedt 	if (filter_hash) {
168733b7f99cSSteven Rostedt (Red Hat) 		hash = ops->func_hash->filter_hash;
168833b7f99cSSteven Rostedt (Red Hat) 		other_hash = ops->func_hash->notrace_hash;
168906a51d93SSteven Rostedt 		if (ftrace_hash_empty(hash))
16908c08f0d5SSteven Rostedt (VMware) 			all = true;
1691ed926f9bSSteven Rostedt 	} else {
1692ed926f9bSSteven Rostedt 		inc = !inc;
169333b7f99cSSteven Rostedt (Red Hat) 		hash = ops->func_hash->notrace_hash;
169433b7f99cSSteven Rostedt (Red Hat) 		other_hash = ops->func_hash->filter_hash;
1695ed926f9bSSteven Rostedt 		/*
1696ed926f9bSSteven Rostedt 		 * If the notrace hash has no items,
1697ed926f9bSSteven Rostedt 		 * then there's nothing to do.
1698ed926f9bSSteven Rostedt 		 */
169906a51d93SSteven Rostedt 		if (ftrace_hash_empty(hash))
170084b6d3e6SJiri Olsa 			return false;
1701ed926f9bSSteven Rostedt 	}
1702ed926f9bSSteven Rostedt 
1703ed926f9bSSteven Rostedt 	do_for_each_ftrace_rec(pg, rec) {
1704ed926f9bSSteven Rostedt 		int in_other_hash = 0;
1705ed926f9bSSteven Rostedt 		int in_hash = 0;
1706ed926f9bSSteven Rostedt 		int match = 0;
1707ed926f9bSSteven Rostedt 
1708cf04f2d5SSteven Rostedt (Google) 		if (skip_record(rec))
1709b7ffffbbSSteven Rostedt (Red Hat) 			continue;
1710b7ffffbbSSteven Rostedt (Red Hat) 
1711ed926f9bSSteven Rostedt 		if (all) {
1712ed926f9bSSteven Rostedt 			/*
1713ed926f9bSSteven Rostedt 			 * Only the filter_hash affects all records.
1714ed926f9bSSteven Rostedt 			 * Update if the record is not in the notrace hash.
1715ed926f9bSSteven Rostedt 			 */
1716b848914cSSteven Rostedt 			if (!other_hash || !ftrace_lookup_ip(other_hash, rec->ip))
1717ed926f9bSSteven Rostedt 				match = 1;
1718ed926f9bSSteven Rostedt 		} else {
171906a51d93SSteven Rostedt 			in_hash = !!ftrace_lookup_ip(hash, rec->ip);
172006a51d93SSteven Rostedt 			in_other_hash = !!ftrace_lookup_ip(other_hash, rec->ip);
1721ed926f9bSSteven Rostedt 
1722ed926f9bSSteven Rostedt 			/*
172319eab4a4SSteven Rostedt (Red Hat) 			 * If filter_hash is set, we want to match all functions
172419eab4a4SSteven Rostedt (Red Hat) 			 * that are in the hash but not in the other hash.
1725ed926f9bSSteven Rostedt 			 *
172619eab4a4SSteven Rostedt (Red Hat) 			 * If filter_hash is not set, then we are decrementing.
172719eab4a4SSteven Rostedt (Red Hat) 			 * That means we match anything that is in the hash
172819eab4a4SSteven Rostedt (Red Hat) 			 * and also in the other_hash. That is, we need to turn
172919eab4a4SSteven Rostedt (Red Hat) 			 * off functions in the other hash because they are disabled
173019eab4a4SSteven Rostedt (Red Hat) 			 * by this hash.
1731ed926f9bSSteven Rostedt 			 */
1732ed926f9bSSteven Rostedt 			if (filter_hash && in_hash && !in_other_hash)
1733ed926f9bSSteven Rostedt 				match = 1;
1734ed926f9bSSteven Rostedt 			else if (!filter_hash && in_hash &&
173506a51d93SSteven Rostedt 				 (in_other_hash || ftrace_hash_empty(other_hash)))
1736ed926f9bSSteven Rostedt 				match = 1;
1737ed926f9bSSteven Rostedt 		}
1738ed926f9bSSteven Rostedt 		if (!match)
1739ed926f9bSSteven Rostedt 			continue;
1740ed926f9bSSteven Rostedt 
1741ed926f9bSSteven Rostedt 		if (inc) {
1742ed926f9bSSteven Rostedt 			rec->flags++;
17430376bde1SSteven Rostedt (Red Hat) 			if (FTRACE_WARN_ON(ftrace_rec_count(rec) == FTRACE_REF_MAX))
174484b6d3e6SJiri Olsa 				return false;
174579922b80SSteven Rostedt (Red Hat) 
1746763e34e7SSteven Rostedt (VMware) 			if (ops->flags & FTRACE_OPS_FL_DIRECT)
1747763e34e7SSteven Rostedt (VMware) 				rec->flags |= FTRACE_FL_DIRECT;
1748763e34e7SSteven Rostedt (VMware) 
174979922b80SSteven Rostedt (Red Hat) 			/*
175079922b80SSteven Rostedt (Red Hat) 			 * If there's only a single callback registered to a
175179922b80SSteven Rostedt (Red Hat) 			 * function, and the ops has a trampoline registered
175279922b80SSteven Rostedt (Red Hat) 			 * for it, then we can call it directly.
175379922b80SSteven Rostedt (Red Hat) 			 */
1754fef5aeeeSSteven Rostedt (Red Hat) 			if (ftrace_rec_count(rec) == 1 && ops->trampoline)
175579922b80SSteven Rostedt (Red Hat) 				rec->flags |= FTRACE_FL_TRAMP;
1756fef5aeeeSSteven Rostedt (Red Hat) 			else
175779922b80SSteven Rostedt (Red Hat) 				/*
175879922b80SSteven Rostedt (Red Hat) 				 * If we are adding another function callback
175979922b80SSteven Rostedt (Red Hat) 				 * to this function, and the previous had a
1760bce0b6c5SSteven Rostedt (Red Hat) 				 * custom trampoline in use, then we need to go
1761bce0b6c5SSteven Rostedt (Red Hat) 				 * back to the default trampoline.
176279922b80SSteven Rostedt (Red Hat) 				 */
1763fef5aeeeSSteven Rostedt (Red Hat) 				rec->flags &= ~FTRACE_FL_TRAMP;
176479922b80SSteven Rostedt (Red Hat) 
176508f6fba5SSteven Rostedt 			/*
176608f6fba5SSteven Rostedt 			 * If any ops wants regs saved for this function
176708f6fba5SSteven Rostedt 			 * then all ops will get saved regs.
176808f6fba5SSteven Rostedt 			 */
176908f6fba5SSteven Rostedt 			if (ops->flags & FTRACE_OPS_FL_SAVE_REGS)
177008f6fba5SSteven Rostedt 				rec->flags |= FTRACE_FL_REGS;
1771ed926f9bSSteven Rostedt 		} else {
17720376bde1SSteven Rostedt (Red Hat) 			if (FTRACE_WARN_ON(ftrace_rec_count(rec) == 0))
177384b6d3e6SJiri Olsa 				return false;
1774ed926f9bSSteven Rostedt 			rec->flags--;
177579922b80SSteven Rostedt (Red Hat) 
17764fbb48cbSSteven Rostedt (Red Hat) 			/*
1777763e34e7SSteven Rostedt (VMware) 			 * Only the internal direct_ops should have the
1778763e34e7SSteven Rostedt (VMware) 			 * DIRECT flag set. Thus, if it is removing a
1779763e34e7SSteven Rostedt (VMware) 			 * function, then that function should no longer
1780763e34e7SSteven Rostedt (VMware) 			 * be direct.
1781763e34e7SSteven Rostedt (VMware) 			 */
1782763e34e7SSteven Rostedt (VMware) 			if (ops->flags & FTRACE_OPS_FL_DIRECT)
1783763e34e7SSteven Rostedt (VMware) 				rec->flags &= ~FTRACE_FL_DIRECT;
1784763e34e7SSteven Rostedt (VMware) 
1785763e34e7SSteven Rostedt (VMware) 			/*
17864fbb48cbSSteven Rostedt (Red Hat) 			 * If the rec had REGS enabled and the ops that is
17874fbb48cbSSteven Rostedt (Red Hat) 			 * being removed had REGS set, then see if there is
17884fbb48cbSSteven Rostedt (Red Hat) 			 * still any ops for this record that wants regs.
17894fbb48cbSSteven Rostedt (Red Hat) 			 * If not, we can stop recording them.
17904fbb48cbSSteven Rostedt (Red Hat) 			 */
17910376bde1SSteven Rostedt (Red Hat) 			if (ftrace_rec_count(rec) > 0 &&
17924fbb48cbSSteven Rostedt (Red Hat) 			    rec->flags & FTRACE_FL_REGS &&
17934fbb48cbSSteven Rostedt (Red Hat) 			    ops->flags & FTRACE_OPS_FL_SAVE_REGS) {
17944fbb48cbSSteven Rostedt (Red Hat) 				if (!test_rec_ops_needs_regs(rec))
17954fbb48cbSSteven Rostedt (Red Hat) 					rec->flags &= ~FTRACE_FL_REGS;
17964fbb48cbSSteven Rostedt (Red Hat) 			}
179779922b80SSteven Rostedt (Red Hat) 
179879922b80SSteven Rostedt (Red Hat) 			/*
1799a124692bSCheng Jian 			 * The TRAMP needs to be set only if rec count
1800a124692bSCheng Jian 			 * is decremented to one, and the ops that is
1801a124692bSCheng Jian 			 * left has a trampoline. As TRAMP can only be
1802a124692bSCheng Jian 			 * enabled if there is only a single ops attached
1803a124692bSCheng Jian 			 * to it.
1804fef5aeeeSSteven Rostedt (Red Hat) 			 */
1805a124692bSCheng Jian 			if (ftrace_rec_count(rec) == 1 &&
18064c75b0ffSNaveen N. Rao 			    ftrace_find_tramp_ops_any_other(rec, ops))
1807a124692bSCheng Jian 				rec->flags |= FTRACE_FL_TRAMP;
1808a124692bSCheng Jian 			else
1809fef5aeeeSSteven Rostedt (Red Hat) 				rec->flags &= ~FTRACE_FL_TRAMP;
1810fef5aeeeSSteven Rostedt (Red Hat) 
1811fef5aeeeSSteven Rostedt (Red Hat) 			/*
181279922b80SSteven Rostedt (Red Hat) 			 * flags will be cleared in ftrace_check_record()
181379922b80SSteven Rostedt (Red Hat) 			 * if rec count is zero.
181479922b80SSteven Rostedt (Red Hat) 			 */
1815ed926f9bSSteven Rostedt 		}
1816ed926f9bSSteven Rostedt 		count++;
181784b6d3e6SJiri Olsa 
181884b6d3e6SJiri Olsa 		/* Must match FTRACE_UPDATE_CALLS in ftrace_modify_all_code() */
18197375dca1SSteven Rostedt (VMware) 		update |= ftrace_test_record(rec, true) != FTRACE_UPDATE_IGNORE;
182084b6d3e6SJiri Olsa 
1821ed926f9bSSteven Rostedt 		/* Shortcut, if we handled all records, we are done. */
1822ed926f9bSSteven Rostedt 		if (!all && count == hash->count)
182384b6d3e6SJiri Olsa 			return update;
1824ed926f9bSSteven Rostedt 	} while_for_each_ftrace_rec();
182584b6d3e6SJiri Olsa 
182684b6d3e6SJiri Olsa 	return update;
1827ed926f9bSSteven Rostedt }
1828ed926f9bSSteven Rostedt 
182984b6d3e6SJiri Olsa static bool ftrace_hash_rec_disable(struct ftrace_ops *ops,
1830ed926f9bSSteven Rostedt 				    int filter_hash)
1831ed926f9bSSteven Rostedt {
183284b6d3e6SJiri Olsa 	return __ftrace_hash_rec_update(ops, filter_hash, 0);
1833ed926f9bSSteven Rostedt }
1834ed926f9bSSteven Rostedt 
183584b6d3e6SJiri Olsa static bool ftrace_hash_rec_enable(struct ftrace_ops *ops,
1836ed926f9bSSteven Rostedt 				   int filter_hash)
1837ed926f9bSSteven Rostedt {
183884b6d3e6SJiri Olsa 	return __ftrace_hash_rec_update(ops, filter_hash, 1);
1839ed926f9bSSteven Rostedt }
1840ed926f9bSSteven Rostedt 
184184261912SSteven Rostedt (Red Hat) static void ftrace_hash_rec_update_modify(struct ftrace_ops *ops,
184284261912SSteven Rostedt (Red Hat) 					  int filter_hash, int inc)
184384261912SSteven Rostedt (Red Hat) {
184484261912SSteven Rostedt (Red Hat) 	struct ftrace_ops *op;
184584261912SSteven Rostedt (Red Hat) 
184684261912SSteven Rostedt (Red Hat) 	__ftrace_hash_rec_update(ops, filter_hash, inc);
184784261912SSteven Rostedt (Red Hat) 
184884261912SSteven Rostedt (Red Hat) 	if (ops->func_hash != &global_ops.local_hash)
184984261912SSteven Rostedt (Red Hat) 		return;
185084261912SSteven Rostedt (Red Hat) 
185184261912SSteven Rostedt (Red Hat) 	/*
185284261912SSteven Rostedt (Red Hat) 	 * If the ops shares the global_ops hash, then we need to update
185384261912SSteven Rostedt (Red Hat) 	 * all ops that are enabled and use this hash.
185484261912SSteven Rostedt (Red Hat) 	 */
185584261912SSteven Rostedt (Red Hat) 	do_for_each_ftrace_op(op, ftrace_ops_list) {
185684261912SSteven Rostedt (Red Hat) 		/* Already done */
185784261912SSteven Rostedt (Red Hat) 		if (op == ops)
185884261912SSteven Rostedt (Red Hat) 			continue;
185984261912SSteven Rostedt (Red Hat) 		if (op->func_hash == &global_ops.local_hash)
186084261912SSteven Rostedt (Red Hat) 			__ftrace_hash_rec_update(op, filter_hash, inc);
186184261912SSteven Rostedt (Red Hat) 	} while_for_each_ftrace_op(op);
186284261912SSteven Rostedt (Red Hat) }
186384261912SSteven Rostedt (Red Hat) 
186484261912SSteven Rostedt (Red Hat) static void ftrace_hash_rec_disable_modify(struct ftrace_ops *ops,
186584261912SSteven Rostedt (Red Hat) 					   int filter_hash)
186684261912SSteven Rostedt (Red Hat) {
186784261912SSteven Rostedt (Red Hat) 	ftrace_hash_rec_update_modify(ops, filter_hash, 0);
186884261912SSteven Rostedt (Red Hat) }
186984261912SSteven Rostedt (Red Hat) 
187084261912SSteven Rostedt (Red Hat) static void ftrace_hash_rec_enable_modify(struct ftrace_ops *ops,
187184261912SSteven Rostedt (Red Hat) 					  int filter_hash)
187284261912SSteven Rostedt (Red Hat) {
187384261912SSteven Rostedt (Red Hat) 	ftrace_hash_rec_update_modify(ops, filter_hash, 1);
187484261912SSteven Rostedt (Red Hat) }
187584261912SSteven Rostedt (Red Hat) 
1876f8b8be8aSMasami Hiramatsu /*
1877f8b8be8aSMasami Hiramatsu  * Try to update IPMODIFY flag on each ftrace_rec. Return 0 if it is OK
1878f8b8be8aSMasami Hiramatsu  * or no-needed to update, -EBUSY if it detects a conflict of the flag
1879f8b8be8aSMasami Hiramatsu  * on a ftrace_rec, and -EINVAL if the new_hash tries to trace all recs.
1880f8b8be8aSMasami Hiramatsu  * Note that old_hash and new_hash has below meanings
1881f8b8be8aSMasami Hiramatsu  *  - If the hash is NULL, it hits all recs (if IPMODIFY is set, this is rejected)
1882f8b8be8aSMasami Hiramatsu  *  - If the hash is EMPTY_HASH, it hits nothing
1883f8b8be8aSMasami Hiramatsu  *  - Anything else hits the recs which match the hash entries.
188453cd885bSSong Liu  *
188553cd885bSSong Liu  * DIRECT ops does not have IPMODIFY flag, but we still need to check it
188653cd885bSSong Liu  * against functions with FTRACE_FL_IPMODIFY. If there is any overlap, call
188753cd885bSSong Liu  * ops_func(SHARE_IPMODIFY_SELF) to make sure current ops can share with
188853cd885bSSong Liu  * IPMODIFY. If ops_func(SHARE_IPMODIFY_SELF) returns non-zero, propagate
188953cd885bSSong Liu  * the return value to the caller and eventually to the owner of the DIRECT
189053cd885bSSong Liu  * ops.
1891f8b8be8aSMasami Hiramatsu  */
1892f8b8be8aSMasami Hiramatsu static int __ftrace_hash_update_ipmodify(struct ftrace_ops *ops,
1893f8b8be8aSMasami Hiramatsu 					 struct ftrace_hash *old_hash,
1894f8b8be8aSMasami Hiramatsu 					 struct ftrace_hash *new_hash)
1895f8b8be8aSMasami Hiramatsu {
1896f8b8be8aSMasami Hiramatsu 	struct ftrace_page *pg;
1897f8b8be8aSMasami Hiramatsu 	struct dyn_ftrace *rec, *end = NULL;
1898f8b8be8aSMasami Hiramatsu 	int in_old, in_new;
189953cd885bSSong Liu 	bool is_ipmodify, is_direct;
1900f8b8be8aSMasami Hiramatsu 
1901f8b8be8aSMasami Hiramatsu 	/* Only update if the ops has been registered */
1902f8b8be8aSMasami Hiramatsu 	if (!(ops->flags & FTRACE_OPS_FL_ENABLED))
1903f8b8be8aSMasami Hiramatsu 		return 0;
1904f8b8be8aSMasami Hiramatsu 
190553cd885bSSong Liu 	is_ipmodify = ops->flags & FTRACE_OPS_FL_IPMODIFY;
190653cd885bSSong Liu 	is_direct = ops->flags & FTRACE_OPS_FL_DIRECT;
190753cd885bSSong Liu 
190853cd885bSSong Liu 	/* neither IPMODIFY nor DIRECT, skip */
190953cd885bSSong Liu 	if (!is_ipmodify && !is_direct)
191053cd885bSSong Liu 		return 0;
191153cd885bSSong Liu 
191253cd885bSSong Liu 	if (WARN_ON_ONCE(is_ipmodify && is_direct))
1913f8b8be8aSMasami Hiramatsu 		return 0;
1914f8b8be8aSMasami Hiramatsu 
1915f8b8be8aSMasami Hiramatsu 	/*
191653cd885bSSong Liu 	 * Since the IPMODIFY and DIRECT are very address sensitive
191753cd885bSSong Liu 	 * actions, we do not allow ftrace_ops to set all functions to new
191853cd885bSSong Liu 	 * hash.
1919f8b8be8aSMasami Hiramatsu 	 */
1920f8b8be8aSMasami Hiramatsu 	if (!new_hash || !old_hash)
1921f8b8be8aSMasami Hiramatsu 		return -EINVAL;
1922f8b8be8aSMasami Hiramatsu 
1923f8b8be8aSMasami Hiramatsu 	/* Update rec->flags */
1924f8b8be8aSMasami Hiramatsu 	do_for_each_ftrace_rec(pg, rec) {
1925546fece4SSteven Rostedt (Red Hat) 
1926546fece4SSteven Rostedt (Red Hat) 		if (rec->flags & FTRACE_FL_DISABLED)
1927546fece4SSteven Rostedt (Red Hat) 			continue;
1928546fece4SSteven Rostedt (Red Hat) 
1929f8b8be8aSMasami Hiramatsu 		/* We need to update only differences of filter_hash */
1930f8b8be8aSMasami Hiramatsu 		in_old = !!ftrace_lookup_ip(old_hash, rec->ip);
1931f8b8be8aSMasami Hiramatsu 		in_new = !!ftrace_lookup_ip(new_hash, rec->ip);
1932f8b8be8aSMasami Hiramatsu 		if (in_old == in_new)
1933f8b8be8aSMasami Hiramatsu 			continue;
1934f8b8be8aSMasami Hiramatsu 
1935f8b8be8aSMasami Hiramatsu 		if (in_new) {
193653cd885bSSong Liu 			if (rec->flags & FTRACE_FL_IPMODIFY) {
193753cd885bSSong Liu 				int ret;
193853cd885bSSong Liu 
193953cd885bSSong Liu 				/* Cannot have two ipmodify on same rec */
194053cd885bSSong Liu 				if (is_ipmodify)
1941f8b8be8aSMasami Hiramatsu 					goto rollback;
194253cd885bSSong Liu 
194353cd885bSSong Liu 				FTRACE_WARN_ON(rec->flags & FTRACE_FL_DIRECT);
194453cd885bSSong Liu 
194553cd885bSSong Liu 				/*
194653cd885bSSong Liu 				 * Another ops with IPMODIFY is already
194753cd885bSSong Liu 				 * attached. We are now attaching a direct
194853cd885bSSong Liu 				 * ops. Run SHARE_IPMODIFY_SELF, to check
194953cd885bSSong Liu 				 * whether sharing is supported.
195053cd885bSSong Liu 				 */
195153cd885bSSong Liu 				if (!ops->ops_func)
195253cd885bSSong Liu 					return -EBUSY;
195353cd885bSSong Liu 				ret = ops->ops_func(ops, FTRACE_OPS_CMD_ENABLE_SHARE_IPMODIFY_SELF);
195453cd885bSSong Liu 				if (ret)
195553cd885bSSong Liu 					return ret;
195653cd885bSSong Liu 			} else if (is_ipmodify) {
1957f8b8be8aSMasami Hiramatsu 				rec->flags |= FTRACE_FL_IPMODIFY;
195853cd885bSSong Liu 			}
195953cd885bSSong Liu 		} else if (is_ipmodify) {
1960f8b8be8aSMasami Hiramatsu 			rec->flags &= ~FTRACE_FL_IPMODIFY;
196153cd885bSSong Liu 		}
1962f8b8be8aSMasami Hiramatsu 	} while_for_each_ftrace_rec();
1963f8b8be8aSMasami Hiramatsu 
1964f8b8be8aSMasami Hiramatsu 	return 0;
1965f8b8be8aSMasami Hiramatsu 
1966f8b8be8aSMasami Hiramatsu rollback:
1967f8b8be8aSMasami Hiramatsu 	end = rec;
1968f8b8be8aSMasami Hiramatsu 
1969f8b8be8aSMasami Hiramatsu 	/* Roll back what we did above */
1970f8b8be8aSMasami Hiramatsu 	do_for_each_ftrace_rec(pg, rec) {
1971546fece4SSteven Rostedt (Red Hat) 
1972546fece4SSteven Rostedt (Red Hat) 		if (rec->flags & FTRACE_FL_DISABLED)
1973546fece4SSteven Rostedt (Red Hat) 			continue;
1974546fece4SSteven Rostedt (Red Hat) 
1975f8b8be8aSMasami Hiramatsu 		if (rec == end)
1976f8b8be8aSMasami Hiramatsu 			goto err_out;
1977f8b8be8aSMasami Hiramatsu 
1978f8b8be8aSMasami Hiramatsu 		in_old = !!ftrace_lookup_ip(old_hash, rec->ip);
1979f8b8be8aSMasami Hiramatsu 		in_new = !!ftrace_lookup_ip(new_hash, rec->ip);
1980f8b8be8aSMasami Hiramatsu 		if (in_old == in_new)
1981f8b8be8aSMasami Hiramatsu 			continue;
1982f8b8be8aSMasami Hiramatsu 
1983f8b8be8aSMasami Hiramatsu 		if (in_new)
1984f8b8be8aSMasami Hiramatsu 			rec->flags &= ~FTRACE_FL_IPMODIFY;
1985f8b8be8aSMasami Hiramatsu 		else
1986f8b8be8aSMasami Hiramatsu 			rec->flags |= FTRACE_FL_IPMODIFY;
1987f8b8be8aSMasami Hiramatsu 	} while_for_each_ftrace_rec();
1988f8b8be8aSMasami Hiramatsu 
1989f8b8be8aSMasami Hiramatsu err_out:
1990f8b8be8aSMasami Hiramatsu 	return -EBUSY;
1991f8b8be8aSMasami Hiramatsu }
1992f8b8be8aSMasami Hiramatsu 
1993f8b8be8aSMasami Hiramatsu static int ftrace_hash_ipmodify_enable(struct ftrace_ops *ops)
1994f8b8be8aSMasami Hiramatsu {
1995f8b8be8aSMasami Hiramatsu 	struct ftrace_hash *hash = ops->func_hash->filter_hash;
1996f8b8be8aSMasami Hiramatsu 
1997f8b8be8aSMasami Hiramatsu 	if (ftrace_hash_empty(hash))
1998f8b8be8aSMasami Hiramatsu 		hash = NULL;
1999f8b8be8aSMasami Hiramatsu 
2000f8b8be8aSMasami Hiramatsu 	return __ftrace_hash_update_ipmodify(ops, EMPTY_HASH, hash);
2001f8b8be8aSMasami Hiramatsu }
2002f8b8be8aSMasami Hiramatsu 
2003f8b8be8aSMasami Hiramatsu /* Disabling always succeeds */
2004f8b8be8aSMasami Hiramatsu static void ftrace_hash_ipmodify_disable(struct ftrace_ops *ops)
2005f8b8be8aSMasami Hiramatsu {
2006f8b8be8aSMasami Hiramatsu 	struct ftrace_hash *hash = ops->func_hash->filter_hash;
2007f8b8be8aSMasami Hiramatsu 
2008f8b8be8aSMasami Hiramatsu 	if (ftrace_hash_empty(hash))
2009f8b8be8aSMasami Hiramatsu 		hash = NULL;
2010f8b8be8aSMasami Hiramatsu 
2011f8b8be8aSMasami Hiramatsu 	__ftrace_hash_update_ipmodify(ops, hash, EMPTY_HASH);
2012f8b8be8aSMasami Hiramatsu }
2013f8b8be8aSMasami Hiramatsu 
2014f8b8be8aSMasami Hiramatsu static int ftrace_hash_ipmodify_update(struct ftrace_ops *ops,
2015f8b8be8aSMasami Hiramatsu 				       struct ftrace_hash *new_hash)
2016f8b8be8aSMasami Hiramatsu {
2017f8b8be8aSMasami Hiramatsu 	struct ftrace_hash *old_hash = ops->func_hash->filter_hash;
2018f8b8be8aSMasami Hiramatsu 
2019f8b8be8aSMasami Hiramatsu 	if (ftrace_hash_empty(old_hash))
2020f8b8be8aSMasami Hiramatsu 		old_hash = NULL;
2021f8b8be8aSMasami Hiramatsu 
2022f8b8be8aSMasami Hiramatsu 	if (ftrace_hash_empty(new_hash))
2023f8b8be8aSMasami Hiramatsu 		new_hash = NULL;
2024f8b8be8aSMasami Hiramatsu 
2025f8b8be8aSMasami Hiramatsu 	return __ftrace_hash_update_ipmodify(ops, old_hash, new_hash);
2026f8b8be8aSMasami Hiramatsu }
2027f8b8be8aSMasami Hiramatsu 
2028b05086c7SSteven Rostedt (Red Hat) static void print_ip_ins(const char *fmt, const unsigned char *p)
202905736a42SSteven Rostedt {
20306c14133dSSteven Rostedt (VMware) 	char ins[MCOUNT_INSN_SIZE];
203105736a42SSteven Rostedt 
20326c14133dSSteven Rostedt (VMware) 	if (copy_from_kernel_nofault(ins, p, MCOUNT_INSN_SIZE)) {
20336c14133dSSteven Rostedt (VMware) 		printk(KERN_CONT "%s[FAULT] %px\n", fmt, p);
20346c14133dSSteven Rostedt (VMware) 		return;
20356c14133dSSteven Rostedt (VMware) 	}
20366c14133dSSteven Rostedt (VMware) 
203705736a42SSteven Rostedt 	printk(KERN_CONT "%s", fmt);
2038*30f7d1caSZheng Yejian 	pr_cont("%*phC", MCOUNT_INSN_SIZE, ins);
203905736a42SSteven Rostedt }
204005736a42SSteven Rostedt 
204102a392a0SSteven Rostedt (Red Hat) enum ftrace_bug_type ftrace_bug_type;
2042b05086c7SSteven Rostedt (Red Hat) const void *ftrace_expected;
204302a392a0SSteven Rostedt (Red Hat) 
204402a392a0SSteven Rostedt (Red Hat) static void print_bug_type(void)
204502a392a0SSteven Rostedt (Red Hat) {
204602a392a0SSteven Rostedt (Red Hat) 	switch (ftrace_bug_type) {
204702a392a0SSteven Rostedt (Red Hat) 	case FTRACE_BUG_UNKNOWN:
204802a392a0SSteven Rostedt (Red Hat) 		break;
204902a392a0SSteven Rostedt (Red Hat) 	case FTRACE_BUG_INIT:
205002a392a0SSteven Rostedt (Red Hat) 		pr_info("Initializing ftrace call sites\n");
205102a392a0SSteven Rostedt (Red Hat) 		break;
205202a392a0SSteven Rostedt (Red Hat) 	case FTRACE_BUG_NOP:
205302a392a0SSteven Rostedt (Red Hat) 		pr_info("Setting ftrace call site to NOP\n");
205402a392a0SSteven Rostedt (Red Hat) 		break;
205502a392a0SSteven Rostedt (Red Hat) 	case FTRACE_BUG_CALL:
205602a392a0SSteven Rostedt (Red Hat) 		pr_info("Setting ftrace call site to call ftrace function\n");
205702a392a0SSteven Rostedt (Red Hat) 		break;
205802a392a0SSteven Rostedt (Red Hat) 	case FTRACE_BUG_UPDATE:
205902a392a0SSteven Rostedt (Red Hat) 		pr_info("Updating ftrace call site to call a different ftrace function\n");
206002a392a0SSteven Rostedt (Red Hat) 		break;
206102a392a0SSteven Rostedt (Red Hat) 	}
206202a392a0SSteven Rostedt (Red Hat) }
206302a392a0SSteven Rostedt (Red Hat) 
2064c88fd863SSteven Rostedt /**
2065c88fd863SSteven Rostedt  * ftrace_bug - report and shutdown function tracer
2066c88fd863SSteven Rostedt  * @failed: The failed type (EFAULT, EINVAL, EPERM)
20674fd3279bSSteven Rostedt (Red Hat)  * @rec: The record that failed
2068c88fd863SSteven Rostedt  *
2069c88fd863SSteven Rostedt  * The arch code that enables or disables the function tracing
2070c88fd863SSteven Rostedt  * can call ftrace_bug() when it has detected a problem in
2071c88fd863SSteven Rostedt  * modifying the code. @failed should be one of either:
2072c88fd863SSteven Rostedt  * EFAULT - if the problem happens on reading the @ip address
2073c88fd863SSteven Rostedt  * EINVAL - if what is read at @ip is not what was expected
20749efb85c5SHariprasad Kelam  * EPERM - if the problem happens on writing to the @ip address
2075c88fd863SSteven Rostedt  */
20764fd3279bSSteven Rostedt (Red Hat) void ftrace_bug(int failed, struct dyn_ftrace *rec)
20773c1720f0SSteven Rostedt {
20784fd3279bSSteven Rostedt (Red Hat) 	unsigned long ip = rec ? rec->ip : 0;
20794fd3279bSSteven Rostedt (Red Hat) 
2080c143b775SCheng Jian 	pr_info("------------[ ftrace bug ]------------\n");
2081c143b775SCheng Jian 
2082b17e8a37SSteven Rostedt 	switch (failed) {
2083593eb8a2SSteven Rostedt 	case -EFAULT:
208405736a42SSteven Rostedt 		pr_info("ftrace faulted on modifying ");
20852062a4e8SDmitry Safonov 		print_ip_sym(KERN_INFO, ip);
208605736a42SSteven Rostedt 		break;
2087593eb8a2SSteven Rostedt 	case -EINVAL:
208805736a42SSteven Rostedt 		pr_info("ftrace failed to modify ");
20892062a4e8SDmitry Safonov 		print_ip_sym(KERN_INFO, ip);
209005736a42SSteven Rostedt 		print_ip_ins(" actual:   ", (unsigned char *)ip);
20914fd3279bSSteven Rostedt (Red Hat) 		pr_cont("\n");
2092b05086c7SSteven Rostedt (Red Hat) 		if (ftrace_expected) {
2093b05086c7SSteven Rostedt (Red Hat) 			print_ip_ins(" expected: ", ftrace_expected);
2094b05086c7SSteven Rostedt (Red Hat) 			pr_cont("\n");
2095b05086c7SSteven Rostedt (Red Hat) 		}
209605736a42SSteven Rostedt 		break;
2097593eb8a2SSteven Rostedt 	case -EPERM:
2098593eb8a2SSteven Rostedt 		pr_info("ftrace faulted on writing ");
20992062a4e8SDmitry Safonov 		print_ip_sym(KERN_INFO, ip);
2100593eb8a2SSteven Rostedt 		break;
2101593eb8a2SSteven Rostedt 	default:
2102593eb8a2SSteven Rostedt 		pr_info("ftrace faulted on unknown error ");
21032062a4e8SDmitry Safonov 		print_ip_sym(KERN_INFO, ip);
210405736a42SSteven Rostedt 	}
210502a392a0SSteven Rostedt (Red Hat) 	print_bug_type();
21064fd3279bSSteven Rostedt (Red Hat) 	if (rec) {
21074fd3279bSSteven Rostedt (Red Hat) 		struct ftrace_ops *ops = NULL;
21084fd3279bSSteven Rostedt (Red Hat) 
21094fd3279bSSteven Rostedt (Red Hat) 		pr_info("ftrace record flags: %lx\n", rec->flags);
21104fd3279bSSteven Rostedt (Red Hat) 		pr_cont(" (%ld)%s", ftrace_rec_count(rec),
21114fd3279bSSteven Rostedt (Red Hat) 			rec->flags & FTRACE_FL_REGS ? " R" : "  ");
21124fd3279bSSteven Rostedt (Red Hat) 		if (rec->flags & FTRACE_FL_TRAMP_EN) {
21134fd3279bSSteven Rostedt (Red Hat) 			ops = ftrace_find_tramp_ops_any(rec);
211439daa7b9SSteven Rostedt (Red Hat) 			if (ops) {
211539daa7b9SSteven Rostedt (Red Hat) 				do {
211639daa7b9SSteven Rostedt (Red Hat) 					pr_cont("\ttramp: %pS (%pS)",
211739daa7b9SSteven Rostedt (Red Hat) 						(void *)ops->trampoline,
211839daa7b9SSteven Rostedt (Red Hat) 						(void *)ops->func);
211939daa7b9SSteven Rostedt (Red Hat) 					ops = ftrace_find_tramp_ops_next(rec, ops);
212039daa7b9SSteven Rostedt (Red Hat) 				} while (ops);
212139daa7b9SSteven Rostedt (Red Hat) 			} else
21224fd3279bSSteven Rostedt (Red Hat) 				pr_cont("\ttramp: ERROR!");
21234fd3279bSSteven Rostedt (Red Hat) 
21244fd3279bSSteven Rostedt (Red Hat) 		}
21254fd3279bSSteven Rostedt (Red Hat) 		ip = ftrace_get_addr_curr(rec);
212639daa7b9SSteven Rostedt (Red Hat) 		pr_cont("\n expected tramp: %lx\n", ip);
21274fd3279bSSteven Rostedt (Red Hat) 	}
2128c143b775SCheng Jian 
2129c143b775SCheng Jian 	FTRACE_WARN_ON_ONCE(1);
2130b17e8a37SSteven Rostedt }
213105736a42SSteven Rostedt 
21327375dca1SSteven Rostedt (VMware) static int ftrace_check_record(struct dyn_ftrace *rec, bool enable, bool update)
21333d083395SSteven Rostedt {
213464fbcd16SXiao Guangrong 	unsigned long flag = 0UL;
2135e7d3737eSFrederic Weisbecker 
213602a392a0SSteven Rostedt (Red Hat) 	ftrace_bug_type = FTRACE_BUG_UNKNOWN;
213702a392a0SSteven Rostedt (Red Hat) 
2138cf04f2d5SSteven Rostedt (Google) 	if (skip_record(rec))
2139b7ffffbbSSteven Rostedt (Red Hat) 		return FTRACE_UPDATE_IGNORE;
2140b7ffffbbSSteven Rostedt (Red Hat) 
21413d083395SSteven Rostedt 	/*
214230fb6aa7SJiri Olsa 	 * If we are updating calls:
21433d083395SSteven Rostedt 	 *
2144ed926f9bSSteven Rostedt 	 *   If the record has a ref count, then we need to enable it
2145ed926f9bSSteven Rostedt 	 *   because someone is using it.
21463d083395SSteven Rostedt 	 *
2147ed926f9bSSteven Rostedt 	 *   Otherwise we make sure its disabled.
2148ed926f9bSSteven Rostedt 	 *
214930fb6aa7SJiri Olsa 	 * If we are disabling calls, then disable all records that
2150ed926f9bSSteven Rostedt 	 * are enabled.
21513d083395SSteven Rostedt 	 */
21520376bde1SSteven Rostedt (Red Hat) 	if (enable && ftrace_rec_count(rec))
215364fbcd16SXiao Guangrong 		flag = FTRACE_FL_ENABLED;
21543d083395SSteven Rostedt 
215508f6fba5SSteven Rostedt 	/*
215679922b80SSteven Rostedt (Red Hat) 	 * If enabling and the REGS flag does not match the REGS_EN, or
215779922b80SSteven Rostedt (Red Hat) 	 * the TRAMP flag doesn't match the TRAMP_EN, then do not ignore
215879922b80SSteven Rostedt (Red Hat) 	 * this record. Set flags to fail the compare against ENABLED.
2159763e34e7SSteven Rostedt (VMware) 	 * Same for direct calls.
216008f6fba5SSteven Rostedt 	 */
216179922b80SSteven Rostedt (Red Hat) 	if (flag) {
216279922b80SSteven Rostedt (Red Hat) 		if (!(rec->flags & FTRACE_FL_REGS) !=
216379922b80SSteven Rostedt (Red Hat) 		    !(rec->flags & FTRACE_FL_REGS_EN))
216408f6fba5SSteven Rostedt 			flag |= FTRACE_FL_REGS;
216508f6fba5SSteven Rostedt 
216679922b80SSteven Rostedt (Red Hat) 		if (!(rec->flags & FTRACE_FL_TRAMP) !=
216779922b80SSteven Rostedt (Red Hat) 		    !(rec->flags & FTRACE_FL_TRAMP_EN))
216879922b80SSteven Rostedt (Red Hat) 			flag |= FTRACE_FL_TRAMP;
2169763e34e7SSteven Rostedt (VMware) 
2170763e34e7SSteven Rostedt (VMware) 		/*
2171763e34e7SSteven Rostedt (VMware) 		 * Direct calls are special, as count matters.
2172763e34e7SSteven Rostedt (VMware) 		 * We must test the record for direct, if the
2173763e34e7SSteven Rostedt (VMware) 		 * DIRECT and DIRECT_EN do not match, but only
2174763e34e7SSteven Rostedt (VMware) 		 * if the count is 1. That's because, if the
2175763e34e7SSteven Rostedt (VMware) 		 * count is something other than one, we do not
2176763e34e7SSteven Rostedt (VMware) 		 * want the direct enabled (it will be done via the
2177763e34e7SSteven Rostedt (VMware) 		 * direct helper). But if DIRECT_EN is set, and
2178763e34e7SSteven Rostedt (VMware) 		 * the count is not one, we need to clear it.
2179763e34e7SSteven Rostedt (VMware) 		 */
2180763e34e7SSteven Rostedt (VMware) 		if (ftrace_rec_count(rec) == 1) {
2181763e34e7SSteven Rostedt (VMware) 			if (!(rec->flags & FTRACE_FL_DIRECT) !=
2182763e34e7SSteven Rostedt (VMware) 			    !(rec->flags & FTRACE_FL_DIRECT_EN))
2183763e34e7SSteven Rostedt (VMware) 				flag |= FTRACE_FL_DIRECT;
2184763e34e7SSteven Rostedt (VMware) 		} else if (rec->flags & FTRACE_FL_DIRECT_EN) {
2185763e34e7SSteven Rostedt (VMware) 			flag |= FTRACE_FL_DIRECT;
2186763e34e7SSteven Rostedt (VMware) 		}
218779922b80SSteven Rostedt (Red Hat) 	}
218879922b80SSteven Rostedt (Red Hat) 
218964fbcd16SXiao Guangrong 	/* If the state of this record hasn't changed, then do nothing */
219064fbcd16SXiao Guangrong 	if ((rec->flags & FTRACE_FL_ENABLED) == flag)
2191c88fd863SSteven Rostedt 		return FTRACE_UPDATE_IGNORE;
219264fbcd16SXiao Guangrong 
219364fbcd16SXiao Guangrong 	if (flag) {
219408f6fba5SSteven Rostedt 		/* Save off if rec is being enabled (for return value) */
219508f6fba5SSteven Rostedt 		flag ^= rec->flags & FTRACE_FL_ENABLED;
219608f6fba5SSteven Rostedt 
219708f6fba5SSteven Rostedt 		if (update) {
219864fbcd16SXiao Guangrong 			rec->flags |= FTRACE_FL_ENABLED;
219908f6fba5SSteven Rostedt 			if (flag & FTRACE_FL_REGS) {
220008f6fba5SSteven Rostedt 				if (rec->flags & FTRACE_FL_REGS)
220108f6fba5SSteven Rostedt 					rec->flags |= FTRACE_FL_REGS_EN;
220208f6fba5SSteven Rostedt 				else
220308f6fba5SSteven Rostedt 					rec->flags &= ~FTRACE_FL_REGS_EN;
220408f6fba5SSteven Rostedt 			}
220579922b80SSteven Rostedt (Red Hat) 			if (flag & FTRACE_FL_TRAMP) {
220679922b80SSteven Rostedt (Red Hat) 				if (rec->flags & FTRACE_FL_TRAMP)
220779922b80SSteven Rostedt (Red Hat) 					rec->flags |= FTRACE_FL_TRAMP_EN;
220879922b80SSteven Rostedt (Red Hat) 				else
220979922b80SSteven Rostedt (Red Hat) 					rec->flags &= ~FTRACE_FL_TRAMP_EN;
221079922b80SSteven Rostedt (Red Hat) 			}
2211d19ad077SSteven Rostedt (VMware) 
2212763e34e7SSteven Rostedt (VMware) 			if (flag & FTRACE_FL_DIRECT) {
2213763e34e7SSteven Rostedt (VMware) 				/*
2214763e34e7SSteven Rostedt (VMware) 				 * If there's only one user (direct_ops helper)
2215763e34e7SSteven Rostedt (VMware) 				 * then we can call the direct function
2216763e34e7SSteven Rostedt (VMware) 				 * directly (no ftrace trampoline).
2217763e34e7SSteven Rostedt (VMware) 				 */
2218763e34e7SSteven Rostedt (VMware) 				if (ftrace_rec_count(rec) == 1) {
2219763e34e7SSteven Rostedt (VMware) 					if (rec->flags & FTRACE_FL_DIRECT)
2220763e34e7SSteven Rostedt (VMware) 						rec->flags |= FTRACE_FL_DIRECT_EN;
2221763e34e7SSteven Rostedt (VMware) 					else
2222763e34e7SSteven Rostedt (VMware) 						rec->flags &= ~FTRACE_FL_DIRECT_EN;
2223763e34e7SSteven Rostedt (VMware) 				} else {
2224763e34e7SSteven Rostedt (VMware) 					/*
2225763e34e7SSteven Rostedt (VMware) 					 * Can only call directly if there's
2226763e34e7SSteven Rostedt (VMware) 					 * only one callback to the function.
2227763e34e7SSteven Rostedt (VMware) 					 */
2228763e34e7SSteven Rostedt (VMware) 					rec->flags &= ~FTRACE_FL_DIRECT_EN;
2229763e34e7SSteven Rostedt (VMware) 				}
2230763e34e7SSteven Rostedt (VMware) 			}
223164fbcd16SXiao Guangrong 		}
223264fbcd16SXiao Guangrong 
223308f6fba5SSteven Rostedt 		/*
223408f6fba5SSteven Rostedt 		 * If this record is being updated from a nop, then
223508f6fba5SSteven Rostedt 		 *   return UPDATE_MAKE_CALL.
223608f6fba5SSteven Rostedt 		 * Otherwise,
223708f6fba5SSteven Rostedt 		 *   return UPDATE_MODIFY_CALL to tell the caller to convert
2238f1b2f2bdSSteven Rostedt (Red Hat) 		 *   from the save regs, to a non-save regs function or
223979922b80SSteven Rostedt (Red Hat) 		 *   vice versa, or from a trampoline call.
224008f6fba5SSteven Rostedt 		 */
224102a392a0SSteven Rostedt (Red Hat) 		if (flag & FTRACE_FL_ENABLED) {
224202a392a0SSteven Rostedt (Red Hat) 			ftrace_bug_type = FTRACE_BUG_CALL;
224308f6fba5SSteven Rostedt 			return FTRACE_UPDATE_MAKE_CALL;
224402a392a0SSteven Rostedt (Red Hat) 		}
2245f1b2f2bdSSteven Rostedt (Red Hat) 
224602a392a0SSteven Rostedt (Red Hat) 		ftrace_bug_type = FTRACE_BUG_UPDATE;
224708f6fba5SSteven Rostedt 		return FTRACE_UPDATE_MODIFY_CALL;
224808f6fba5SSteven Rostedt 	}
224908f6fba5SSteven Rostedt 
225008f6fba5SSteven Rostedt 	if (update) {
225108f6fba5SSteven Rostedt 		/* If there's no more users, clear all flags */
22520376bde1SSteven Rostedt (Red Hat) 		if (!ftrace_rec_count(rec))
2253cf04f2d5SSteven Rostedt (Google) 			rec->flags &= FTRACE_FL_DISABLED;
225408f6fba5SSteven Rostedt 		else
2255b24d443bSSteven Rostedt (Red Hat) 			/*
2256b24d443bSSteven Rostedt (Red Hat) 			 * Just disable the record, but keep the ops TRAMP
2257b24d443bSSteven Rostedt (Red Hat) 			 * and REGS states. The _EN flags must be disabled though.
2258b24d443bSSteven Rostedt (Red Hat) 			 */
2259b24d443bSSteven Rostedt (Red Hat) 			rec->flags &= ~(FTRACE_FL_ENABLED | FTRACE_FL_TRAMP_EN |
2260763e34e7SSteven Rostedt (VMware) 					FTRACE_FL_REGS_EN | FTRACE_FL_DIRECT_EN);
226108f6fba5SSteven Rostedt 	}
2262c88fd863SSteven Rostedt 
226302a392a0SSteven Rostedt (Red Hat) 	ftrace_bug_type = FTRACE_BUG_NOP;
2264c88fd863SSteven Rostedt 	return FTRACE_UPDATE_MAKE_NOP;
2265c88fd863SSteven Rostedt }
2266c88fd863SSteven Rostedt 
2267c88fd863SSteven Rostedt /**
22686130722fSSteven Rostedt (VMware)  * ftrace_update_record - set a record that now is tracing or not
2269c88fd863SSteven Rostedt  * @rec: the record to update
22707375dca1SSteven Rostedt (VMware)  * @enable: set to true if the record is tracing, false to force disable
2271c88fd863SSteven Rostedt  *
2272c88fd863SSteven Rostedt  * The records that represent all functions that can be traced need
2273c88fd863SSteven Rostedt  * to be updated when tracing has been enabled.
2274c88fd863SSteven Rostedt  */
22757375dca1SSteven Rostedt (VMware) int ftrace_update_record(struct dyn_ftrace *rec, bool enable)
2276c88fd863SSteven Rostedt {
22777375dca1SSteven Rostedt (VMware) 	return ftrace_check_record(rec, enable, true);
2278c88fd863SSteven Rostedt }
2279c88fd863SSteven Rostedt 
2280c88fd863SSteven Rostedt /**
22816130722fSSteven Rostedt (VMware)  * ftrace_test_record - check if the record has been enabled or not
2282c88fd863SSteven Rostedt  * @rec: the record to test
22837375dca1SSteven Rostedt (VMware)  * @enable: set to true to check if enabled, false if it is disabled
2284c88fd863SSteven Rostedt  *
2285c88fd863SSteven Rostedt  * The arch code may need to test if a record is already set to
2286c88fd863SSteven Rostedt  * tracing to determine how to modify the function code that it
2287c88fd863SSteven Rostedt  * represents.
2288c88fd863SSteven Rostedt  */
22897375dca1SSteven Rostedt (VMware) int ftrace_test_record(struct dyn_ftrace *rec, bool enable)
2290c88fd863SSteven Rostedt {
22917375dca1SSteven Rostedt (VMware) 	return ftrace_check_record(rec, enable, false);
2292c88fd863SSteven Rostedt }
2293c88fd863SSteven Rostedt 
229479922b80SSteven Rostedt (Red Hat) static struct ftrace_ops *
22955fecaa04SSteven Rostedt (Red Hat) ftrace_find_tramp_ops_any(struct dyn_ftrace *rec)
22965fecaa04SSteven Rostedt (Red Hat) {
22975fecaa04SSteven Rostedt (Red Hat) 	struct ftrace_ops *op;
2298fef5aeeeSSteven Rostedt (Red Hat) 	unsigned long ip = rec->ip;
22995fecaa04SSteven Rostedt (Red Hat) 
23005fecaa04SSteven Rostedt (Red Hat) 	do_for_each_ftrace_op(op, ftrace_ops_list) {
23015fecaa04SSteven Rostedt (Red Hat) 
23025fecaa04SSteven Rostedt (Red Hat) 		if (!op->trampoline)
23035fecaa04SSteven Rostedt (Red Hat) 			continue;
23045fecaa04SSteven Rostedt (Red Hat) 
2305fef5aeeeSSteven Rostedt (Red Hat) 		if (hash_contains_ip(ip, op->func_hash))
23065fecaa04SSteven Rostedt (Red Hat) 			return op;
23075fecaa04SSteven Rostedt (Red Hat) 	} while_for_each_ftrace_op(op);
23085fecaa04SSteven Rostedt (Red Hat) 
23095fecaa04SSteven Rostedt (Red Hat) 	return NULL;
23105fecaa04SSteven Rostedt (Red Hat) }
23115fecaa04SSteven Rostedt (Red Hat) 
23125fecaa04SSteven Rostedt (Red Hat) static struct ftrace_ops *
23134c75b0ffSNaveen N. Rao ftrace_find_tramp_ops_any_other(struct dyn_ftrace *rec, struct ftrace_ops *op_exclude)
23144c75b0ffSNaveen N. Rao {
23154c75b0ffSNaveen N. Rao 	struct ftrace_ops *op;
23164c75b0ffSNaveen N. Rao 	unsigned long ip = rec->ip;
23174c75b0ffSNaveen N. Rao 
23184c75b0ffSNaveen N. Rao 	do_for_each_ftrace_op(op, ftrace_ops_list) {
23194c75b0ffSNaveen N. Rao 
23204c75b0ffSNaveen N. Rao 		if (op == op_exclude || !op->trampoline)
23214c75b0ffSNaveen N. Rao 			continue;
23224c75b0ffSNaveen N. Rao 
23234c75b0ffSNaveen N. Rao 		if (hash_contains_ip(ip, op->func_hash))
23244c75b0ffSNaveen N. Rao 			return op;
23254c75b0ffSNaveen N. Rao 	} while_for_each_ftrace_op(op);
23264c75b0ffSNaveen N. Rao 
23274c75b0ffSNaveen N. Rao 	return NULL;
23284c75b0ffSNaveen N. Rao }
23294c75b0ffSNaveen N. Rao 
23304c75b0ffSNaveen N. Rao static struct ftrace_ops *
233139daa7b9SSteven Rostedt (Red Hat) ftrace_find_tramp_ops_next(struct dyn_ftrace *rec,
233239daa7b9SSteven Rostedt (Red Hat) 			   struct ftrace_ops *op)
233339daa7b9SSteven Rostedt (Red Hat) {
233439daa7b9SSteven Rostedt (Red Hat) 	unsigned long ip = rec->ip;
233539daa7b9SSteven Rostedt (Red Hat) 
233639daa7b9SSteven Rostedt (Red Hat) 	while_for_each_ftrace_op(op) {
233739daa7b9SSteven Rostedt (Red Hat) 
233839daa7b9SSteven Rostedt (Red Hat) 		if (!op->trampoline)
233939daa7b9SSteven Rostedt (Red Hat) 			continue;
234039daa7b9SSteven Rostedt (Red Hat) 
234139daa7b9SSteven Rostedt (Red Hat) 		if (hash_contains_ip(ip, op->func_hash))
234239daa7b9SSteven Rostedt (Red Hat) 			return op;
234339daa7b9SSteven Rostedt (Red Hat) 	}
234439daa7b9SSteven Rostedt (Red Hat) 
234539daa7b9SSteven Rostedt (Red Hat) 	return NULL;
234639daa7b9SSteven Rostedt (Red Hat) }
234739daa7b9SSteven Rostedt (Red Hat) 
234839daa7b9SSteven Rostedt (Red Hat) static struct ftrace_ops *
234979922b80SSteven Rostedt (Red Hat) ftrace_find_tramp_ops_curr(struct dyn_ftrace *rec)
235079922b80SSteven Rostedt (Red Hat) {
235179922b80SSteven Rostedt (Red Hat) 	struct ftrace_ops *op;
2352fef5aeeeSSteven Rostedt (Red Hat) 	unsigned long ip = rec->ip;
235379922b80SSteven Rostedt (Red Hat) 
2354fef5aeeeSSteven Rostedt (Red Hat) 	/*
2355fef5aeeeSSteven Rostedt (Red Hat) 	 * Need to check removed ops first.
2356fef5aeeeSSteven Rostedt (Red Hat) 	 * If they are being removed, and this rec has a tramp,
2357fef5aeeeSSteven Rostedt (Red Hat) 	 * and this rec is in the ops list, then it would be the
2358fef5aeeeSSteven Rostedt (Red Hat) 	 * one with the tramp.
2359fef5aeeeSSteven Rostedt (Red Hat) 	 */
2360fef5aeeeSSteven Rostedt (Red Hat) 	if (removed_ops) {
2361fef5aeeeSSteven Rostedt (Red Hat) 		if (hash_contains_ip(ip, &removed_ops->old_hash))
236279922b80SSteven Rostedt (Red Hat) 			return removed_ops;
236379922b80SSteven Rostedt (Red Hat) 	}
236479922b80SSteven Rostedt (Red Hat) 
2365fef5aeeeSSteven Rostedt (Red Hat) 	/*
2366fef5aeeeSSteven Rostedt (Red Hat) 	 * Need to find the current trampoline for a rec.
2367fef5aeeeSSteven Rostedt (Red Hat) 	 * Now, a trampoline is only attached to a rec if there
2368fef5aeeeSSteven Rostedt (Red Hat) 	 * was a single 'ops' attached to it. But this can be called
2369fef5aeeeSSteven Rostedt (Red Hat) 	 * when we are adding another op to the rec or removing the
2370fef5aeeeSSteven Rostedt (Red Hat) 	 * current one. Thus, if the op is being added, we can
2371fef5aeeeSSteven Rostedt (Red Hat) 	 * ignore it because it hasn't attached itself to the rec
23724fc40904SSteven Rostedt (Red Hat) 	 * yet.
23734fc40904SSteven Rostedt (Red Hat) 	 *
23744fc40904SSteven Rostedt (Red Hat) 	 * If an ops is being modified (hooking to different functions)
23754fc40904SSteven Rostedt (Red Hat) 	 * then we don't care about the new functions that are being
23764fc40904SSteven Rostedt (Red Hat) 	 * added, just the old ones (that are probably being removed).
23774fc40904SSteven Rostedt (Red Hat) 	 *
23784fc40904SSteven Rostedt (Red Hat) 	 * If we are adding an ops to a function that already is using
23794fc40904SSteven Rostedt (Red Hat) 	 * a trampoline, it needs to be removed (trampolines are only
23804fc40904SSteven Rostedt (Red Hat) 	 * for single ops connected), then an ops that is not being
23814fc40904SSteven Rostedt (Red Hat) 	 * modified also needs to be checked.
2382fef5aeeeSSteven Rostedt (Red Hat) 	 */
238379922b80SSteven Rostedt (Red Hat) 	do_for_each_ftrace_op(op, ftrace_ops_list) {
2384fef5aeeeSSteven Rostedt (Red Hat) 
2385fef5aeeeSSteven Rostedt (Red Hat) 		if (!op->trampoline)
238679922b80SSteven Rostedt (Red Hat) 			continue;
238779922b80SSteven Rostedt (Red Hat) 
2388fef5aeeeSSteven Rostedt (Red Hat) 		/*
2389fef5aeeeSSteven Rostedt (Red Hat) 		 * If the ops is being added, it hasn't gotten to
2390fef5aeeeSSteven Rostedt (Red Hat) 		 * the point to be removed from this tree yet.
2391fef5aeeeSSteven Rostedt (Red Hat) 		 */
2392fef5aeeeSSteven Rostedt (Red Hat) 		if (op->flags & FTRACE_OPS_FL_ADDING)
2393fef5aeeeSSteven Rostedt (Red Hat) 			continue;
2394fef5aeeeSSteven Rostedt (Red Hat) 
2395fef5aeeeSSteven Rostedt (Red Hat) 
23964fc40904SSteven Rostedt (Red Hat) 		/*
23974fc40904SSteven Rostedt (Red Hat) 		 * If the ops is being modified and is in the old
23984fc40904SSteven Rostedt (Red Hat) 		 * hash, then it is probably being removed from this
23994fc40904SSteven Rostedt (Red Hat) 		 * function.
24004fc40904SSteven Rostedt (Red Hat) 		 */
2401fef5aeeeSSteven Rostedt (Red Hat) 		if ((op->flags & FTRACE_OPS_FL_MODIFYING) &&
2402fef5aeeeSSteven Rostedt (Red Hat) 		    hash_contains_ip(ip, &op->old_hash))
240379922b80SSteven Rostedt (Red Hat) 			return op;
24044fc40904SSteven Rostedt (Red Hat) 		/*
24054fc40904SSteven Rostedt (Red Hat) 		 * If the ops is not being added or modified, and it's
24064fc40904SSteven Rostedt (Red Hat) 		 * in its normal filter hash, then this must be the one
24074fc40904SSteven Rostedt (Red Hat) 		 * we want!
24084fc40904SSteven Rostedt (Red Hat) 		 */
24094fc40904SSteven Rostedt (Red Hat) 		if (!(op->flags & FTRACE_OPS_FL_MODIFYING) &&
24104fc40904SSteven Rostedt (Red Hat) 		    hash_contains_ip(ip, op->func_hash))
24114fc40904SSteven Rostedt (Red Hat) 			return op;
241279922b80SSteven Rostedt (Red Hat) 
241379922b80SSteven Rostedt (Red Hat) 	} while_for_each_ftrace_op(op);
241479922b80SSteven Rostedt (Red Hat) 
241579922b80SSteven Rostedt (Red Hat) 	return NULL;
241679922b80SSteven Rostedt (Red Hat) }
241779922b80SSteven Rostedt (Red Hat) 
241879922b80SSteven Rostedt (Red Hat) static struct ftrace_ops *
241979922b80SSteven Rostedt (Red Hat) ftrace_find_tramp_ops_new(struct dyn_ftrace *rec)
242079922b80SSteven Rostedt (Red Hat) {
242179922b80SSteven Rostedt (Red Hat) 	struct ftrace_ops *op;
2422fef5aeeeSSteven Rostedt (Red Hat) 	unsigned long ip = rec->ip;
242379922b80SSteven Rostedt (Red Hat) 
242479922b80SSteven Rostedt (Red Hat) 	do_for_each_ftrace_op(op, ftrace_ops_list) {
242579922b80SSteven Rostedt (Red Hat) 		/* pass rec in as regs to have non-NULL val */
2426fef5aeeeSSteven Rostedt (Red Hat) 		if (hash_contains_ip(ip, op->func_hash))
242779922b80SSteven Rostedt (Red Hat) 			return op;
242879922b80SSteven Rostedt (Red Hat) 	} while_for_each_ftrace_op(op);
242979922b80SSteven Rostedt (Red Hat) 
243079922b80SSteven Rostedt (Red Hat) 	return NULL;
243179922b80SSteven Rostedt (Red Hat) }
243279922b80SSteven Rostedt (Red Hat) 
2433763e34e7SSteven Rostedt (VMware) #ifdef CONFIG_DYNAMIC_FTRACE_WITH_DIRECT_CALLS
2434763e34e7SSteven Rostedt (VMware) /* Protected by rcu_tasks for reading, and direct_mutex for writing */
2435763e34e7SSteven Rostedt (VMware) static struct ftrace_hash *direct_functions = EMPTY_HASH;
2436763e34e7SSteven Rostedt (VMware) static DEFINE_MUTEX(direct_mutex);
2437a3ad1a7eSSteven Rostedt (VMware) int ftrace_direct_func_count;
2438763e34e7SSteven Rostedt (VMware) 
2439763e34e7SSteven Rostedt (VMware) /*
2440763e34e7SSteven Rostedt (VMware)  * Search the direct_functions hash to see if the given instruction pointer
2441763e34e7SSteven Rostedt (VMware)  * has a direct caller attached to it.
2442763e34e7SSteven Rostedt (VMware)  */
2443ff205766SAlexei Starovoitov unsigned long ftrace_find_rec_direct(unsigned long ip)
2444763e34e7SSteven Rostedt (VMware) {
2445763e34e7SSteven Rostedt (VMware) 	struct ftrace_func_entry *entry;
2446763e34e7SSteven Rostedt (VMware) 
2447763e34e7SSteven Rostedt (VMware) 	entry = __ftrace_lookup_ip(direct_functions, ip);
2448763e34e7SSteven Rostedt (VMware) 	if (!entry)
2449763e34e7SSteven Rostedt (VMware) 		return 0;
2450763e34e7SSteven Rostedt (VMware) 
2451763e34e7SSteven Rostedt (VMware) 	return entry->direct;
2452763e34e7SSteven Rostedt (VMware) }
2453763e34e7SSteven Rostedt (VMware) 
24541904a814SJiri Olsa static struct ftrace_func_entry*
24551904a814SJiri Olsa ftrace_add_rec_direct(unsigned long ip, unsigned long addr,
24561904a814SJiri Olsa 		      struct ftrace_hash **free_hash)
24571904a814SJiri Olsa {
24581904a814SJiri Olsa 	struct ftrace_func_entry *entry;
24591904a814SJiri Olsa 
24601904a814SJiri Olsa 	if (ftrace_hash_empty(direct_functions) ||
24611904a814SJiri Olsa 	    direct_functions->count > 2 * (1 << direct_functions->size_bits)) {
24621904a814SJiri Olsa 		struct ftrace_hash *new_hash;
24631904a814SJiri Olsa 		int size = ftrace_hash_empty(direct_functions) ? 0 :
24641904a814SJiri Olsa 			direct_functions->count + 1;
24651904a814SJiri Olsa 
24661904a814SJiri Olsa 		if (size < 32)
24671904a814SJiri Olsa 			size = 32;
24681904a814SJiri Olsa 
24691904a814SJiri Olsa 		new_hash = dup_hash(direct_functions, size);
24701904a814SJiri Olsa 		if (!new_hash)
24711904a814SJiri Olsa 			return NULL;
24721904a814SJiri Olsa 
24731904a814SJiri Olsa 		*free_hash = direct_functions;
24741904a814SJiri Olsa 		direct_functions = new_hash;
24751904a814SJiri Olsa 	}
24761904a814SJiri Olsa 
24771904a814SJiri Olsa 	entry = kmalloc(sizeof(*entry), GFP_KERNEL);
24781904a814SJiri Olsa 	if (!entry)
24791904a814SJiri Olsa 		return NULL;
24801904a814SJiri Olsa 
24811904a814SJiri Olsa 	entry->ip = ip;
24821904a814SJiri Olsa 	entry->direct = addr;
24831904a814SJiri Olsa 	__add_hash_entry(direct_functions, entry);
24841904a814SJiri Olsa 	return entry;
24851904a814SJiri Olsa }
24861904a814SJiri Olsa 
2487763e34e7SSteven Rostedt (VMware) static void call_direct_funcs(unsigned long ip, unsigned long pip,
2488d19ad077SSteven Rostedt (VMware) 			      struct ftrace_ops *ops, struct ftrace_regs *fregs)
2489763e34e7SSteven Rostedt (VMware) {
2490d19ad077SSteven Rostedt (VMware) 	struct pt_regs *regs = ftrace_get_regs(fregs);
2491763e34e7SSteven Rostedt (VMware) 	unsigned long addr;
2492763e34e7SSteven Rostedt (VMware) 
2493ff205766SAlexei Starovoitov 	addr = ftrace_find_rec_direct(ip);
2494763e34e7SSteven Rostedt (VMware) 	if (!addr)
2495763e34e7SSteven Rostedt (VMware) 		return;
2496763e34e7SSteven Rostedt (VMware) 
2497763e34e7SSteven Rostedt (VMware) 	arch_ftrace_set_direct_caller(regs, addr);
2498763e34e7SSteven Rostedt (VMware) }
2499763e34e7SSteven Rostedt (VMware) 
2500763e34e7SSteven Rostedt (VMware) struct ftrace_ops direct_ops = {
2501763e34e7SSteven Rostedt (VMware) 	.func		= call_direct_funcs,
250253cd885bSSong Liu 	.flags		= FTRACE_OPS_FL_DIRECT | FTRACE_OPS_FL_SAVE_REGS
2503763e34e7SSteven Rostedt (VMware) 			  | FTRACE_OPS_FL_PERMANENT,
25045da7cd11SSteven Rostedt (VMware) 	/*
25055da7cd11SSteven Rostedt (VMware) 	 * By declaring the main trampoline as this trampoline
25065da7cd11SSteven Rostedt (VMware) 	 * it will never have one allocated for it. Allocated
25075da7cd11SSteven Rostedt (VMware) 	 * trampolines should not call direct functions.
25085da7cd11SSteven Rostedt (VMware) 	 * The direct_ops should only be called by the builtin
25095da7cd11SSteven Rostedt (VMware) 	 * ftrace_regs_caller trampoline.
25105da7cd11SSteven Rostedt (VMware) 	 */
25115da7cd11SSteven Rostedt (VMware) 	.trampoline	= FTRACE_REGS_ADDR,
2512763e34e7SSteven Rostedt (VMware) };
2513763e34e7SSteven Rostedt (VMware) #endif /* CONFIG_DYNAMIC_FTRACE_WITH_DIRECT_CALLS */
2514763e34e7SSteven Rostedt (VMware) 
25157413af1fSSteven Rostedt (Red Hat) /**
25167413af1fSSteven Rostedt (Red Hat)  * ftrace_get_addr_new - Get the call address to set to
25177413af1fSSteven Rostedt (Red Hat)  * @rec:  The ftrace record descriptor
25187413af1fSSteven Rostedt (Red Hat)  *
25197413af1fSSteven Rostedt (Red Hat)  * If the record has the FTRACE_FL_REGS set, that means that it
25207413af1fSSteven Rostedt (Red Hat)  * wants to convert to a callback that saves all regs. If FTRACE_FL_REGS
25215c8c206eSRandy Dunlap  * is not set, then it wants to convert to the normal callback.
25227413af1fSSteven Rostedt (Red Hat)  *
25237413af1fSSteven Rostedt (Red Hat)  * Returns the address of the trampoline to set to
25247413af1fSSteven Rostedt (Red Hat)  */
25257413af1fSSteven Rostedt (Red Hat) unsigned long ftrace_get_addr_new(struct dyn_ftrace *rec)
25267413af1fSSteven Rostedt (Red Hat) {
252779922b80SSteven Rostedt (Red Hat) 	struct ftrace_ops *ops;
2528763e34e7SSteven Rostedt (VMware) 	unsigned long addr;
2529763e34e7SSteven Rostedt (VMware) 
2530763e34e7SSteven Rostedt (VMware) 	if ((rec->flags & FTRACE_FL_DIRECT) &&
2531763e34e7SSteven Rostedt (VMware) 	    (ftrace_rec_count(rec) == 1)) {
2532ff205766SAlexei Starovoitov 		addr = ftrace_find_rec_direct(rec->ip);
2533763e34e7SSteven Rostedt (VMware) 		if (addr)
2534763e34e7SSteven Rostedt (VMware) 			return addr;
2535763e34e7SSteven Rostedt (VMware) 		WARN_ON_ONCE(1);
2536763e34e7SSteven Rostedt (VMware) 	}
253779922b80SSteven Rostedt (Red Hat) 
253879922b80SSteven Rostedt (Red Hat) 	/* Trampolines take precedence over regs */
253979922b80SSteven Rostedt (Red Hat) 	if (rec->flags & FTRACE_FL_TRAMP) {
254079922b80SSteven Rostedt (Red Hat) 		ops = ftrace_find_tramp_ops_new(rec);
254179922b80SSteven Rostedt (Red Hat) 		if (FTRACE_WARN_ON(!ops || !ops->trampoline)) {
2542bce0b6c5SSteven Rostedt (Red Hat) 			pr_warn("Bad trampoline accounting at: %p (%pS) (%lx)\n",
2543bce0b6c5SSteven Rostedt (Red Hat) 				(void *)rec->ip, (void *)rec->ip, rec->flags);
254479922b80SSteven Rostedt (Red Hat) 			/* Ftrace is shutting down, return anything */
254579922b80SSteven Rostedt (Red Hat) 			return (unsigned long)FTRACE_ADDR;
254679922b80SSteven Rostedt (Red Hat) 		}
254779922b80SSteven Rostedt (Red Hat) 		return ops->trampoline;
254879922b80SSteven Rostedt (Red Hat) 	}
254979922b80SSteven Rostedt (Red Hat) 
25507413af1fSSteven Rostedt (Red Hat) 	if (rec->flags & FTRACE_FL_REGS)
25517413af1fSSteven Rostedt (Red Hat) 		return (unsigned long)FTRACE_REGS_ADDR;
25527413af1fSSteven Rostedt (Red Hat) 	else
25537413af1fSSteven Rostedt (Red Hat) 		return (unsigned long)FTRACE_ADDR;
25547413af1fSSteven Rostedt (Red Hat) }
25557413af1fSSteven Rostedt (Red Hat) 
25567413af1fSSteven Rostedt (Red Hat) /**
25577413af1fSSteven Rostedt (Red Hat)  * ftrace_get_addr_curr - Get the call address that is already there
25587413af1fSSteven Rostedt (Red Hat)  * @rec:  The ftrace record descriptor
25597413af1fSSteven Rostedt (Red Hat)  *
25607413af1fSSteven Rostedt (Red Hat)  * The FTRACE_FL_REGS_EN is set when the record already points to
25617413af1fSSteven Rostedt (Red Hat)  * a function that saves all the regs. Basically the '_EN' version
25627413af1fSSteven Rostedt (Red Hat)  * represents the current state of the function.
25637413af1fSSteven Rostedt (Red Hat)  *
25647413af1fSSteven Rostedt (Red Hat)  * Returns the address of the trampoline that is currently being called
25657413af1fSSteven Rostedt (Red Hat)  */
25667413af1fSSteven Rostedt (Red Hat) unsigned long ftrace_get_addr_curr(struct dyn_ftrace *rec)
25677413af1fSSteven Rostedt (Red Hat) {
256879922b80SSteven Rostedt (Red Hat) 	struct ftrace_ops *ops;
2569763e34e7SSteven Rostedt (VMware) 	unsigned long addr;
2570763e34e7SSteven Rostedt (VMware) 
2571763e34e7SSteven Rostedt (VMware) 	/* Direct calls take precedence over trampolines */
2572763e34e7SSteven Rostedt (VMware) 	if (rec->flags & FTRACE_FL_DIRECT_EN) {
2573ff205766SAlexei Starovoitov 		addr = ftrace_find_rec_direct(rec->ip);
2574763e34e7SSteven Rostedt (VMware) 		if (addr)
2575763e34e7SSteven Rostedt (VMware) 			return addr;
2576763e34e7SSteven Rostedt (VMware) 		WARN_ON_ONCE(1);
2577763e34e7SSteven Rostedt (VMware) 	}
257879922b80SSteven Rostedt (Red Hat) 
257979922b80SSteven Rostedt (Red Hat) 	/* Trampolines take precedence over regs */
258079922b80SSteven Rostedt (Red Hat) 	if (rec->flags & FTRACE_FL_TRAMP_EN) {
258179922b80SSteven Rostedt (Red Hat) 		ops = ftrace_find_tramp_ops_curr(rec);
258279922b80SSteven Rostedt (Red Hat) 		if (FTRACE_WARN_ON(!ops)) {
2583a395d6a7SJoe Perches 			pr_warn("Bad trampoline accounting at: %p (%pS)\n",
258479922b80SSteven Rostedt (Red Hat) 				(void *)rec->ip, (void *)rec->ip);
258579922b80SSteven Rostedt (Red Hat) 			/* Ftrace is shutting down, return anything */
258679922b80SSteven Rostedt (Red Hat) 			return (unsigned long)FTRACE_ADDR;
258779922b80SSteven Rostedt (Red Hat) 		}
258879922b80SSteven Rostedt (Red Hat) 		return ops->trampoline;
258979922b80SSteven Rostedt (Red Hat) 	}
259079922b80SSteven Rostedt (Red Hat) 
25917413af1fSSteven Rostedt (Red Hat) 	if (rec->flags & FTRACE_FL_REGS_EN)
25927413af1fSSteven Rostedt (Red Hat) 		return (unsigned long)FTRACE_REGS_ADDR;
25937413af1fSSteven Rostedt (Red Hat) 	else
25947413af1fSSteven Rostedt (Red Hat) 		return (unsigned long)FTRACE_ADDR;
25957413af1fSSteven Rostedt (Red Hat) }
25967413af1fSSteven Rostedt (Red Hat) 
2597c88fd863SSteven Rostedt static int
25987375dca1SSteven Rostedt (VMware) __ftrace_replace_code(struct dyn_ftrace *rec, bool enable)
2599c88fd863SSteven Rostedt {
260008f6fba5SSteven Rostedt 	unsigned long ftrace_old_addr;
2601c88fd863SSteven Rostedt 	unsigned long ftrace_addr;
2602c88fd863SSteven Rostedt 	int ret;
2603c88fd863SSteven Rostedt 
26047c0868e0SSteven Rostedt (Red Hat) 	ftrace_addr = ftrace_get_addr_new(rec);
2605c88fd863SSteven Rostedt 
26067c0868e0SSteven Rostedt (Red Hat) 	/* This needs to be done before we call ftrace_update_record */
26077c0868e0SSteven Rostedt (Red Hat) 	ftrace_old_addr = ftrace_get_addr_curr(rec);
26087c0868e0SSteven Rostedt (Red Hat) 
26097c0868e0SSteven Rostedt (Red Hat) 	ret = ftrace_update_record(rec, enable);
261008f6fba5SSteven Rostedt 
261102a392a0SSteven Rostedt (Red Hat) 	ftrace_bug_type = FTRACE_BUG_UNKNOWN;
261202a392a0SSteven Rostedt (Red Hat) 
2613c88fd863SSteven Rostedt 	switch (ret) {
2614c88fd863SSteven Rostedt 	case FTRACE_UPDATE_IGNORE:
2615c88fd863SSteven Rostedt 		return 0;
2616c88fd863SSteven Rostedt 
2617c88fd863SSteven Rostedt 	case FTRACE_UPDATE_MAKE_CALL:
261802a392a0SSteven Rostedt (Red Hat) 		ftrace_bug_type = FTRACE_BUG_CALL;
2619c88fd863SSteven Rostedt 		return ftrace_make_call(rec, ftrace_addr);
2620c88fd863SSteven Rostedt 
2621c88fd863SSteven Rostedt 	case FTRACE_UPDATE_MAKE_NOP:
262202a392a0SSteven Rostedt (Red Hat) 		ftrace_bug_type = FTRACE_BUG_NOP;
262339b5552cSSteven Rostedt (Red Hat) 		return ftrace_make_nop(NULL, rec, ftrace_old_addr);
262408f6fba5SSteven Rostedt 
262508f6fba5SSteven Rostedt 	case FTRACE_UPDATE_MODIFY_CALL:
262602a392a0SSteven Rostedt (Red Hat) 		ftrace_bug_type = FTRACE_BUG_UPDATE;
262708f6fba5SSteven Rostedt 		return ftrace_modify_call(rec, ftrace_old_addr, ftrace_addr);
26283d083395SSteven Rostedt 	}
26293d083395SSteven Rostedt 
26309efb85c5SHariprasad Kelam 	return -1; /* unknown ftrace bug */
2631c88fd863SSteven Rostedt }
2632c88fd863SSteven Rostedt 
2633a0572f68SSteven Rostedt (VMware) void __weak ftrace_replace_code(int mod_flags)
26343d083395SSteven Rostedt {
26353d083395SSteven Rostedt 	struct dyn_ftrace *rec;
26363d083395SSteven Rostedt 	struct ftrace_page *pg;
26377375dca1SSteven Rostedt (VMware) 	bool enable = mod_flags & FTRACE_MODIFY_ENABLE_FL;
2638a0572f68SSteven Rostedt (VMware) 	int schedulable = mod_flags & FTRACE_MODIFY_MAY_SLEEP_FL;
26396a24a244SSteven Rostedt 	int failed;
26403d083395SSteven Rostedt 
264145a4a237SSteven Rostedt 	if (unlikely(ftrace_disabled))
264245a4a237SSteven Rostedt 		return;
264345a4a237SSteven Rostedt 
2644265c831cSSteven Rostedt 	do_for_each_ftrace_rec(pg, rec) {
2645546fece4SSteven Rostedt (Red Hat) 
2646cf04f2d5SSteven Rostedt (Google) 		if (skip_record(rec))
2647546fece4SSteven Rostedt (Red Hat) 			continue;
2648546fece4SSteven Rostedt (Red Hat) 
2649e4f5d544SSteven Rostedt 		failed = __ftrace_replace_code(rec, enable);
2650fa9d13cfSZhaolei 		if (failed) {
26514fd3279bSSteven Rostedt (Red Hat) 			ftrace_bug(failed, rec);
26524377245aSSteven Rostedt 			/* Stop processing */
26534377245aSSteven Rostedt 			return;
26544377245aSSteven Rostedt 		}
2655a0572f68SSteven Rostedt (VMware) 		if (schedulable)
2656a0572f68SSteven Rostedt (VMware) 			cond_resched();
2657265c831cSSteven Rostedt 	} while_for_each_ftrace_rec();
26583d083395SSteven Rostedt }
26593c1720f0SSteven Rostedt 
2660c88fd863SSteven Rostedt struct ftrace_rec_iter {
2661c88fd863SSteven Rostedt 	struct ftrace_page	*pg;
2662c88fd863SSteven Rostedt 	int			index;
2663c88fd863SSteven Rostedt };
2664c88fd863SSteven Rostedt 
2665c88fd863SSteven Rostedt /**
26666130722fSSteven Rostedt (VMware)  * ftrace_rec_iter_start - start up iterating over traced functions
2667c88fd863SSteven Rostedt  *
2668c88fd863SSteven Rostedt  * Returns an iterator handle that is used to iterate over all
2669c88fd863SSteven Rostedt  * the records that represent address locations where functions
2670c88fd863SSteven Rostedt  * are traced.
2671c88fd863SSteven Rostedt  *
2672c88fd863SSteven Rostedt  * May return NULL if no records are available.
2673c88fd863SSteven Rostedt  */
2674c88fd863SSteven Rostedt struct ftrace_rec_iter *ftrace_rec_iter_start(void)
2675c88fd863SSteven Rostedt {
2676c88fd863SSteven Rostedt 	/*
2677c88fd863SSteven Rostedt 	 * We only use a single iterator.
2678c88fd863SSteven Rostedt 	 * Protected by the ftrace_lock mutex.
2679c88fd863SSteven Rostedt 	 */
2680c88fd863SSteven Rostedt 	static struct ftrace_rec_iter ftrace_rec_iter;
2681c88fd863SSteven Rostedt 	struct ftrace_rec_iter *iter = &ftrace_rec_iter;
2682c88fd863SSteven Rostedt 
2683c88fd863SSteven Rostedt 	iter->pg = ftrace_pages_start;
2684c88fd863SSteven Rostedt 	iter->index = 0;
2685c88fd863SSteven Rostedt 
2686c88fd863SSteven Rostedt 	/* Could have empty pages */
2687c88fd863SSteven Rostedt 	while (iter->pg && !iter->pg->index)
2688c88fd863SSteven Rostedt 		iter->pg = iter->pg->next;
2689c88fd863SSteven Rostedt 
2690c88fd863SSteven Rostedt 	if (!iter->pg)
2691c88fd863SSteven Rostedt 		return NULL;
2692c88fd863SSteven Rostedt 
2693c88fd863SSteven Rostedt 	return iter;
2694c88fd863SSteven Rostedt }
2695c88fd863SSteven Rostedt 
2696c88fd863SSteven Rostedt /**
26976130722fSSteven Rostedt (VMware)  * ftrace_rec_iter_next - get the next record to process.
2698c88fd863SSteven Rostedt  * @iter: The handle to the iterator.
2699c88fd863SSteven Rostedt  *
2700c88fd863SSteven Rostedt  * Returns the next iterator after the given iterator @iter.
2701c88fd863SSteven Rostedt  */
2702c88fd863SSteven Rostedt struct ftrace_rec_iter *ftrace_rec_iter_next(struct ftrace_rec_iter *iter)
2703c88fd863SSteven Rostedt {
2704c88fd863SSteven Rostedt 	iter->index++;
2705c88fd863SSteven Rostedt 
2706c88fd863SSteven Rostedt 	if (iter->index >= iter->pg->index) {
2707c88fd863SSteven Rostedt 		iter->pg = iter->pg->next;
2708c88fd863SSteven Rostedt 		iter->index = 0;
2709c88fd863SSteven Rostedt 
2710c88fd863SSteven Rostedt 		/* Could have empty pages */
2711c88fd863SSteven Rostedt 		while (iter->pg && !iter->pg->index)
2712c88fd863SSteven Rostedt 			iter->pg = iter->pg->next;
2713c88fd863SSteven Rostedt 	}
2714c88fd863SSteven Rostedt 
2715c88fd863SSteven Rostedt 	if (!iter->pg)
2716c88fd863SSteven Rostedt 		return NULL;
2717c88fd863SSteven Rostedt 
2718c88fd863SSteven Rostedt 	return iter;
2719c88fd863SSteven Rostedt }
2720c88fd863SSteven Rostedt 
2721c88fd863SSteven Rostedt /**
27226130722fSSteven Rostedt (VMware)  * ftrace_rec_iter_record - get the record at the iterator location
2723c88fd863SSteven Rostedt  * @iter: The current iterator location
2724c88fd863SSteven Rostedt  *
2725c88fd863SSteven Rostedt  * Returns the record that the current @iter is at.
2726c88fd863SSteven Rostedt  */
2727c88fd863SSteven Rostedt struct dyn_ftrace *ftrace_rec_iter_record(struct ftrace_rec_iter *iter)
2728c88fd863SSteven Rostedt {
2729c88fd863SSteven Rostedt 	return &iter->pg->records[iter->index];
2730c88fd863SSteven Rostedt }
2731c88fd863SSteven Rostedt 
27323b47bfc1SSteven Rostedt static int
2733fbf6c73cSMark Rutland ftrace_nop_initialize(struct module *mod, struct dyn_ftrace *rec)
27343c1720f0SSteven Rostedt {
2735492a7ea5SAbhishek Sagar 	int ret;
273637ad5084SSteven Rostedt 
273745a4a237SSteven Rostedt 	if (unlikely(ftrace_disabled))
273845a4a237SSteven Rostedt 		return 0;
273945a4a237SSteven Rostedt 
2740fbf6c73cSMark Rutland 	ret = ftrace_init_nop(mod, rec);
27413d083395SSteven Rostedt 	if (ret) {
274202a392a0SSteven Rostedt (Red Hat) 		ftrace_bug_type = FTRACE_BUG_INIT;
27434fd3279bSSteven Rostedt (Red Hat) 		ftrace_bug(ret, rec);
27443d083395SSteven Rostedt 		return 0;
2745d61f82d0SSteven Rostedt 	}
2746d61f82d0SSteven Rostedt 	return 1;
27473d083395SSteven Rostedt }
27483d083395SSteven Rostedt 
2749000ab691SSteven Rostedt /*
2750000ab691SSteven Rostedt  * archs can override this function if they must do something
2751000ab691SSteven Rostedt  * before the modifying code is performed.
2752000ab691SSteven Rostedt  */
27533a2bfec0SLi kunyu void __weak ftrace_arch_code_modify_prepare(void)
2754000ab691SSteven Rostedt {
2755000ab691SSteven Rostedt }
2756000ab691SSteven Rostedt 
2757000ab691SSteven Rostedt /*
2758000ab691SSteven Rostedt  * archs can override this function if they must do something
2759000ab691SSteven Rostedt  * after the modifying code is performed.
2760000ab691SSteven Rostedt  */
27613a2bfec0SLi kunyu void __weak ftrace_arch_code_modify_post_process(void)
2762000ab691SSteven Rostedt {
2763000ab691SSteven Rostedt }
2764000ab691SSteven Rostedt 
27658ed3e2cfSSteven Rostedt void ftrace_modify_all_code(int command)
27668ed3e2cfSSteven Rostedt {
276759338f75SSteven Rostedt (Red Hat) 	int update = command & FTRACE_UPDATE_TRACE_FUNC;
2768a0572f68SSteven Rostedt (VMware) 	int mod_flags = 0;
2769cd21067fSPetr Mladek 	int err = 0;
277059338f75SSteven Rostedt (Red Hat) 
2771a0572f68SSteven Rostedt (VMware) 	if (command & FTRACE_MAY_SLEEP)
2772a0572f68SSteven Rostedt (VMware) 		mod_flags = FTRACE_MODIFY_MAY_SLEEP_FL;
2773a0572f68SSteven Rostedt (VMware) 
277459338f75SSteven Rostedt (Red Hat) 	/*
277559338f75SSteven Rostedt (Red Hat) 	 * If the ftrace_caller calls a ftrace_ops func directly,
277659338f75SSteven Rostedt (Red Hat) 	 * we need to make sure that it only traces functions it
277759338f75SSteven Rostedt (Red Hat) 	 * expects to trace. When doing the switch of functions,
277859338f75SSteven Rostedt (Red Hat) 	 * we need to update to the ftrace_ops_list_func first
277959338f75SSteven Rostedt (Red Hat) 	 * before the transition between old and new calls are set,
278059338f75SSteven Rostedt (Red Hat) 	 * as the ftrace_ops_list_func will check the ops hashes
278159338f75SSteven Rostedt (Red Hat) 	 * to make sure the ops are having the right functions
278259338f75SSteven Rostedt (Red Hat) 	 * traced.
278359338f75SSteven Rostedt (Red Hat) 	 */
2784cd21067fSPetr Mladek 	if (update) {
2785cd21067fSPetr Mladek 		err = ftrace_update_ftrace_func(ftrace_ops_list_func);
2786cd21067fSPetr Mladek 		if (FTRACE_WARN_ON(err))
2787cd21067fSPetr Mladek 			return;
2788cd21067fSPetr Mladek 	}
278959338f75SSteven Rostedt (Red Hat) 
27908ed3e2cfSSteven Rostedt 	if (command & FTRACE_UPDATE_CALLS)
2791a0572f68SSteven Rostedt (VMware) 		ftrace_replace_code(mod_flags | FTRACE_MODIFY_ENABLE_FL);
27928ed3e2cfSSteven Rostedt 	else if (command & FTRACE_DISABLE_CALLS)
2793a0572f68SSteven Rostedt (VMware) 		ftrace_replace_code(mod_flags);
27948ed3e2cfSSteven Rostedt 
2795405e1d83SSteven Rostedt (Red Hat) 	if (update && ftrace_trace_function != ftrace_ops_list_func) {
2796405e1d83SSteven Rostedt (Red Hat) 		function_trace_op = set_function_trace_op;
2797405e1d83SSteven Rostedt (Red Hat) 		smp_wmb();
2798405e1d83SSteven Rostedt (Red Hat) 		/* If irqs are disabled, we are in stop machine */
2799405e1d83SSteven Rostedt (Red Hat) 		if (!irqs_disabled())
2800405e1d83SSteven Rostedt (Red Hat) 			smp_call_function(ftrace_sync_ipi, NULL, 1);
2801cd21067fSPetr Mladek 		err = ftrace_update_ftrace_func(ftrace_trace_function);
2802cd21067fSPetr Mladek 		if (FTRACE_WARN_ON(err))
2803cd21067fSPetr Mladek 			return;
2804405e1d83SSteven Rostedt (Red Hat) 	}
28058ed3e2cfSSteven Rostedt 
28068ed3e2cfSSteven Rostedt 	if (command & FTRACE_START_FUNC_RET)
2807cd21067fSPetr Mladek 		err = ftrace_enable_ftrace_graph_caller();
28088ed3e2cfSSteven Rostedt 	else if (command & FTRACE_STOP_FUNC_RET)
2809cd21067fSPetr Mladek 		err = ftrace_disable_ftrace_graph_caller();
2810cd21067fSPetr Mladek 	FTRACE_WARN_ON(err);
28118ed3e2cfSSteven Rostedt }
28128ed3e2cfSSteven Rostedt 
28133d083395SSteven Rostedt static int __ftrace_modify_code(void *data)
28143d083395SSteven Rostedt {
28153d083395SSteven Rostedt 	int *command = data;
28163d083395SSteven Rostedt 
28178ed3e2cfSSteven Rostedt 	ftrace_modify_all_code(*command);
28185a45cfe1SSteven Rostedt 
2819c88fd863SSteven Rostedt 	return 0;
2820c88fd863SSteven Rostedt }
2821c88fd863SSteven Rostedt 
2822c88fd863SSteven Rostedt /**
28236130722fSSteven Rostedt (VMware)  * ftrace_run_stop_machine - go back to the stop machine method
2824c88fd863SSteven Rostedt  * @command: The command to tell ftrace what to do
2825c88fd863SSteven Rostedt  *
2826c88fd863SSteven Rostedt  * If an arch needs to fall back to the stop machine method, the
2827c88fd863SSteven Rostedt  * it can call this function.
2828c88fd863SSteven Rostedt  */
2829c88fd863SSteven Rostedt void ftrace_run_stop_machine(int command)
2830c88fd863SSteven Rostedt {
2831c88fd863SSteven Rostedt 	stop_machine(__ftrace_modify_code, &command, NULL);
2832c88fd863SSteven Rostedt }
2833c88fd863SSteven Rostedt 
2834c88fd863SSteven Rostedt /**
28356130722fSSteven Rostedt (VMware)  * arch_ftrace_update_code - modify the code to trace or not trace
2836c88fd863SSteven Rostedt  * @command: The command that needs to be done
2837c88fd863SSteven Rostedt  *
2838c88fd863SSteven Rostedt  * Archs can override this function if it does not need to
2839c88fd863SSteven Rostedt  * run stop_machine() to modify code.
2840c88fd863SSteven Rostedt  */
2841c88fd863SSteven Rostedt void __weak arch_ftrace_update_code(int command)
2842c88fd863SSteven Rostedt {
2843c88fd863SSteven Rostedt 	ftrace_run_stop_machine(command);
2844c88fd863SSteven Rostedt }
2845c88fd863SSteven Rostedt 
2846c88fd863SSteven Rostedt static void ftrace_run_update_code(int command)
2847c88fd863SSteven Rostedt {
28483a2bfec0SLi kunyu 	ftrace_arch_code_modify_prepare();
2849c88fd863SSteven Rostedt 
2850c88fd863SSteven Rostedt 	/*
2851c88fd863SSteven Rostedt 	 * By default we use stop_machine() to modify the code.
2852c88fd863SSteven Rostedt 	 * But archs can do what ever they want as long as it
2853c88fd863SSteven Rostedt 	 * is safe. The stop_machine() is the safest, but also
2854c88fd863SSteven Rostedt 	 * produces the most overhead.
2855c88fd863SSteven Rostedt 	 */
2856c88fd863SSteven Rostedt 	arch_ftrace_update_code(command);
2857c88fd863SSteven Rostedt 
28583a2bfec0SLi kunyu 	ftrace_arch_code_modify_post_process();
28593d083395SSteven Rostedt }
28603d083395SSteven Rostedt 
28618252ecf3SSteven Rostedt (Red Hat) static void ftrace_run_modify_code(struct ftrace_ops *ops, int command,
28627485058eSSteven Rostedt (Red Hat) 				   struct ftrace_ops_hash *old_hash)
2863e1effa01SSteven Rostedt (Red Hat) {
2864e1effa01SSteven Rostedt (Red Hat) 	ops->flags |= FTRACE_OPS_FL_MODIFYING;
28657485058eSSteven Rostedt (Red Hat) 	ops->old_hash.filter_hash = old_hash->filter_hash;
28667485058eSSteven Rostedt (Red Hat) 	ops->old_hash.notrace_hash = old_hash->notrace_hash;
2867e1effa01SSteven Rostedt (Red Hat) 	ftrace_run_update_code(command);
28688252ecf3SSteven Rostedt (Red Hat) 	ops->old_hash.filter_hash = NULL;
28697485058eSSteven Rostedt (Red Hat) 	ops->old_hash.notrace_hash = NULL;
2870e1effa01SSteven Rostedt (Red Hat) 	ops->flags &= ~FTRACE_OPS_FL_MODIFYING;
2871e1effa01SSteven Rostedt (Red Hat) }
2872e1effa01SSteven Rostedt (Red Hat) 
28733d083395SSteven Rostedt static ftrace_func_t saved_ftrace_func;
287460a7ecf4SSteven Rostedt static int ftrace_start_up;
2875df4fc315SSteven Rostedt 
287612cce594SSteven Rostedt (Red Hat) void __weak arch_ftrace_trampoline_free(struct ftrace_ops *ops)
287712cce594SSteven Rostedt (Red Hat) {
287812cce594SSteven Rostedt (Red Hat) }
287912cce594SSteven Rostedt (Red Hat) 
2880fc0ea795SAdrian Hunter /* List of trace_ops that have allocated trampolines */
2881fc0ea795SAdrian Hunter static LIST_HEAD(ftrace_ops_trampoline_list);
2882fc0ea795SAdrian Hunter 
2883fc0ea795SAdrian Hunter static void ftrace_add_trampoline_to_kallsyms(struct ftrace_ops *ops)
2884fc0ea795SAdrian Hunter {
2885fc0ea795SAdrian Hunter 	lockdep_assert_held(&ftrace_lock);
2886fc0ea795SAdrian Hunter 	list_add_rcu(&ops->list, &ftrace_ops_trampoline_list);
2887fc0ea795SAdrian Hunter }
2888fc0ea795SAdrian Hunter 
2889fc0ea795SAdrian Hunter static void ftrace_remove_trampoline_from_kallsyms(struct ftrace_ops *ops)
2890fc0ea795SAdrian Hunter {
2891fc0ea795SAdrian Hunter 	lockdep_assert_held(&ftrace_lock);
2892fc0ea795SAdrian Hunter 	list_del_rcu(&ops->list);
2893478ece95SAdrian Hunter 	synchronize_rcu();
2894fc0ea795SAdrian Hunter }
2895fc0ea795SAdrian Hunter 
2896fc0ea795SAdrian Hunter /*
2897fc0ea795SAdrian Hunter  * "__builtin__ftrace" is used as a module name in /proc/kallsyms for symbols
2898fc0ea795SAdrian Hunter  * for pages allocated for ftrace purposes, even though "__builtin__ftrace" is
2899fc0ea795SAdrian Hunter  * not a module.
2900fc0ea795SAdrian Hunter  */
2901fc0ea795SAdrian Hunter #define FTRACE_TRAMPOLINE_MOD "__builtin__ftrace"
2902fc0ea795SAdrian Hunter #define FTRACE_TRAMPOLINE_SYM "ftrace_trampoline"
2903fc0ea795SAdrian Hunter 
2904fc0ea795SAdrian Hunter static void ftrace_trampoline_free(struct ftrace_ops *ops)
2905fc0ea795SAdrian Hunter {
2906fc0ea795SAdrian Hunter 	if (ops && (ops->flags & FTRACE_OPS_FL_ALLOC_TRAMP) &&
2907dd9ddf46SAdrian Hunter 	    ops->trampoline) {
2908548e1f6cSAdrian Hunter 		/*
2909548e1f6cSAdrian Hunter 		 * Record the text poke event before the ksymbol unregister
2910548e1f6cSAdrian Hunter 		 * event.
2911548e1f6cSAdrian Hunter 		 */
2912548e1f6cSAdrian Hunter 		perf_event_text_poke((void *)ops->trampoline,
2913548e1f6cSAdrian Hunter 				     (void *)ops->trampoline,
2914548e1f6cSAdrian Hunter 				     ops->trampoline_size, NULL, 0);
2915dd9ddf46SAdrian Hunter 		perf_event_ksymbol(PERF_RECORD_KSYMBOL_TYPE_OOL,
2916dd9ddf46SAdrian Hunter 				   ops->trampoline, ops->trampoline_size,
2917dd9ddf46SAdrian Hunter 				   true, FTRACE_TRAMPOLINE_SYM);
2918dd9ddf46SAdrian Hunter 		/* Remove from kallsyms after the perf events */
2919fc0ea795SAdrian Hunter 		ftrace_remove_trampoline_from_kallsyms(ops);
2920dd9ddf46SAdrian Hunter 	}
2921fc0ea795SAdrian Hunter 
2922fc0ea795SAdrian Hunter 	arch_ftrace_trampoline_free(ops);
2923fc0ea795SAdrian Hunter }
2924fc0ea795SAdrian Hunter 
2925df4fc315SSteven Rostedt static void ftrace_startup_enable(int command)
2926df4fc315SSteven Rostedt {
2927df4fc315SSteven Rostedt 	if (saved_ftrace_func != ftrace_trace_function) {
2928df4fc315SSteven Rostedt 		saved_ftrace_func = ftrace_trace_function;
2929df4fc315SSteven Rostedt 		command |= FTRACE_UPDATE_TRACE_FUNC;
2930df4fc315SSteven Rostedt 	}
2931df4fc315SSteven Rostedt 
2932df4fc315SSteven Rostedt 	if (!command || !ftrace_enabled)
2933df4fc315SSteven Rostedt 		return;
2934df4fc315SSteven Rostedt 
2935df4fc315SSteven Rostedt 	ftrace_run_update_code(command);
2936df4fc315SSteven Rostedt }
29373d083395SSteven Rostedt 
2938e1effa01SSteven Rostedt (Red Hat) static void ftrace_startup_all(int command)
2939e1effa01SSteven Rostedt (Red Hat) {
2940e1effa01SSteven Rostedt (Red Hat) 	update_all_ops = true;
2941e1effa01SSteven Rostedt (Red Hat) 	ftrace_startup_enable(command);
2942e1effa01SSteven Rostedt (Red Hat) 	update_all_ops = false;
2943e1effa01SSteven Rostedt (Red Hat) }
2944e1effa01SSteven Rostedt (Red Hat) 
29453306fc4aSSteven Rostedt (VMware) int ftrace_startup(struct ftrace_ops *ops, int command)
29463d083395SSteven Rostedt {
29478a56d776SSteven Rostedt (Red Hat) 	int ret;
2948b848914cSSteven Rostedt 
29494eebcc81SSteven Rostedt 	if (unlikely(ftrace_disabled))
2950a1cd6173SSteven Rostedt 		return -ENODEV;
29514eebcc81SSteven Rostedt 
29528a56d776SSteven Rostedt (Red Hat) 	ret = __register_ftrace_function(ops);
29538a56d776SSteven Rostedt (Red Hat) 	if (ret)
29548a56d776SSteven Rostedt (Red Hat) 		return ret;
29558a56d776SSteven Rostedt (Red Hat) 
295660a7ecf4SSteven Rostedt 	ftrace_start_up++;
29573d083395SSteven Rostedt 
2958e1effa01SSteven Rostedt (Red Hat) 	/*
2959e1effa01SSteven Rostedt (Red Hat) 	 * Note that ftrace probes uses this to start up
2960e1effa01SSteven Rostedt (Red Hat) 	 * and modify functions it will probe. But we still
2961e1effa01SSteven Rostedt (Red Hat) 	 * set the ADDING flag for modification, as probes
2962e1effa01SSteven Rostedt (Red Hat) 	 * do not have trampolines. If they add them in the
2963e1effa01SSteven Rostedt (Red Hat) 	 * future, then the probes will need to distinguish
2964e1effa01SSteven Rostedt (Red Hat) 	 * between adding and updating probes.
2965e1effa01SSteven Rostedt (Red Hat) 	 */
2966e1effa01SSteven Rostedt (Red Hat) 	ops->flags |= FTRACE_OPS_FL_ENABLED | FTRACE_OPS_FL_ADDING;
296766209a5bSSteven Rostedt (Red Hat) 
2968f8b8be8aSMasami Hiramatsu 	ret = ftrace_hash_ipmodify_enable(ops);
2969f8b8be8aSMasami Hiramatsu 	if (ret < 0) {
2970f8b8be8aSMasami Hiramatsu 		/* Rollback registration process */
2971f8b8be8aSMasami Hiramatsu 		__unregister_ftrace_function(ops);
2972f8b8be8aSMasami Hiramatsu 		ftrace_start_up--;
2973f8b8be8aSMasami Hiramatsu 		ops->flags &= ~FTRACE_OPS_FL_ENABLED;
2974d5e47505SMiroslav Benes 		if (ops->flags & FTRACE_OPS_FL_DYNAMIC)
2975d5e47505SMiroslav Benes 			ftrace_trampoline_free(ops);
2976f8b8be8aSMasami Hiramatsu 		return ret;
2977f8b8be8aSMasami Hiramatsu 	}
2978f8b8be8aSMasami Hiramatsu 
29797f50d06bSJiri Olsa 	if (ftrace_hash_rec_enable(ops, 1))
29807f50d06bSJiri Olsa 		command |= FTRACE_UPDATE_CALLS;
2981ed926f9bSSteven Rostedt 
2982df4fc315SSteven Rostedt 	ftrace_startup_enable(command);
2983a1cd6173SSteven Rostedt 
2984c3b0f72eSYang Jihong 	/*
2985c3b0f72eSYang Jihong 	 * If ftrace is in an undefined state, we just remove ops from list
2986c3b0f72eSYang Jihong 	 * to prevent the NULL pointer, instead of totally rolling it back and
2987c3b0f72eSYang Jihong 	 * free trampoline, because those actions could cause further damage.
2988c3b0f72eSYang Jihong 	 */
2989c3b0f72eSYang Jihong 	if (unlikely(ftrace_disabled)) {
2990c3b0f72eSYang Jihong 		__unregister_ftrace_function(ops);
2991c3b0f72eSYang Jihong 		return -ENODEV;
2992c3b0f72eSYang Jihong 	}
2993c3b0f72eSYang Jihong 
2994e1effa01SSteven Rostedt (Red Hat) 	ops->flags &= ~FTRACE_OPS_FL_ADDING;
2995e1effa01SSteven Rostedt (Red Hat) 
2996a1cd6173SSteven Rostedt 	return 0;
29973d083395SSteven Rostedt }
29983d083395SSteven Rostedt 
29993306fc4aSSteven Rostedt (VMware) int ftrace_shutdown(struct ftrace_ops *ops, int command)
30003d083395SSteven Rostedt {
30018a56d776SSteven Rostedt (Red Hat) 	int ret;
3002b848914cSSteven Rostedt 
30034eebcc81SSteven Rostedt 	if (unlikely(ftrace_disabled))
30048a56d776SSteven Rostedt (Red Hat) 		return -ENODEV;
30058a56d776SSteven Rostedt (Red Hat) 
30068a56d776SSteven Rostedt (Red Hat) 	ret = __unregister_ftrace_function(ops);
30078a56d776SSteven Rostedt (Red Hat) 	if (ret)
30088a56d776SSteven Rostedt (Red Hat) 		return ret;
30094eebcc81SSteven Rostedt 
301060a7ecf4SSteven Rostedt 	ftrace_start_up--;
30119ea1a153SFrederic Weisbecker 	/*
30129ea1a153SFrederic Weisbecker 	 * Just warn in case of unbalance, no need to kill ftrace, it's not
30139ea1a153SFrederic Weisbecker 	 * critical but the ftrace_call callers may be never nopped again after
30149ea1a153SFrederic Weisbecker 	 * further ftrace uses.
30159ea1a153SFrederic Weisbecker 	 */
30169ea1a153SFrederic Weisbecker 	WARN_ON_ONCE(ftrace_start_up < 0);
30179ea1a153SFrederic Weisbecker 
3018f8b8be8aSMasami Hiramatsu 	/* Disabling ipmodify never fails */
3019f8b8be8aSMasami Hiramatsu 	ftrace_hash_ipmodify_disable(ops);
30207f50d06bSJiri Olsa 
30217f50d06bSJiri Olsa 	if (ftrace_hash_rec_disable(ops, 1))
30227f50d06bSJiri Olsa 		command |= FTRACE_UPDATE_CALLS;
3023ed926f9bSSteven Rostedt 
3024ed926f9bSSteven Rostedt 	ops->flags &= ~FTRACE_OPS_FL_ENABLED;
3025b848914cSSteven Rostedt 
3026d61f82d0SSteven Rostedt 	if (saved_ftrace_func != ftrace_trace_function) {
3027d61f82d0SSteven Rostedt 		saved_ftrace_func = ftrace_trace_function;
3028d61f82d0SSteven Rostedt 		command |= FTRACE_UPDATE_TRACE_FUNC;
3029d61f82d0SSteven Rostedt 	}
3030d61f82d0SSteven Rostedt 
3031a4c35ed2SSteven Rostedt (Red Hat) 	if (!command || !ftrace_enabled) {
3032a4c35ed2SSteven Rostedt (Red Hat) 		/*
3033edb096e0SSteven Rostedt (VMware) 		 * If these are dynamic or per_cpu ops, they still
3034edb096e0SSteven Rostedt (VMware) 		 * need their data freed. Since, function tracing is
3035a4c35ed2SSteven Rostedt (Red Hat) 		 * not currently active, we can just free them
3036a4c35ed2SSteven Rostedt (Red Hat) 		 * without synchronizing all CPUs.
3037a4c35ed2SSteven Rostedt (Red Hat) 		 */
3038b3a88803SPeter Zijlstra 		if (ops->flags & FTRACE_OPS_FL_DYNAMIC)
3039edb096e0SSteven Rostedt (VMware) 			goto free_ops;
3040edb096e0SSteven Rostedt (VMware) 
30418a56d776SSteven Rostedt (Red Hat) 		return 0;
3042a4c35ed2SSteven Rostedt (Red Hat) 	}
30433d083395SSteven Rostedt 
304479922b80SSteven Rostedt (Red Hat) 	/*
304579922b80SSteven Rostedt (Red Hat) 	 * If the ops uses a trampoline, then it needs to be
304679922b80SSteven Rostedt (Red Hat) 	 * tested first on update.
304779922b80SSteven Rostedt (Red Hat) 	 */
3048e1effa01SSteven Rostedt (Red Hat) 	ops->flags |= FTRACE_OPS_FL_REMOVING;
304979922b80SSteven Rostedt (Red Hat) 	removed_ops = ops;
305079922b80SSteven Rostedt (Red Hat) 
3051fef5aeeeSSteven Rostedt (Red Hat) 	/* The trampoline logic checks the old hashes */
3052fef5aeeeSSteven Rostedt (Red Hat) 	ops->old_hash.filter_hash = ops->func_hash->filter_hash;
3053fef5aeeeSSteven Rostedt (Red Hat) 	ops->old_hash.notrace_hash = ops->func_hash->notrace_hash;
3054fef5aeeeSSteven Rostedt (Red Hat) 
3055d61f82d0SSteven Rostedt 	ftrace_run_update_code(command);
3056a4c35ed2SSteven Rostedt (Red Hat) 
305784bde62cSSteven Rostedt (Red Hat) 	/*
305884bde62cSSteven Rostedt (Red Hat) 	 * If there's no more ops registered with ftrace, run a
305984bde62cSSteven Rostedt (Red Hat) 	 * sanity check to make sure all rec flags are cleared.
306084bde62cSSteven Rostedt (Red Hat) 	 */
3061f86f4180SChunyan Zhang 	if (rcu_dereference_protected(ftrace_ops_list,
3062f86f4180SChunyan Zhang 			lockdep_is_held(&ftrace_lock)) == &ftrace_list_end) {
306384bde62cSSteven Rostedt (Red Hat) 		struct ftrace_page *pg;
306484bde62cSSteven Rostedt (Red Hat) 		struct dyn_ftrace *rec;
306584bde62cSSteven Rostedt (Red Hat) 
306684bde62cSSteven Rostedt (Red Hat) 		do_for_each_ftrace_rec(pg, rec) {
3067977c1f9cSAlexei Starovoitov 			if (FTRACE_WARN_ON_ONCE(rec->flags & ~FTRACE_FL_DISABLED))
306884bde62cSSteven Rostedt (Red Hat) 				pr_warn("  %pS flags:%lx\n",
306984bde62cSSteven Rostedt (Red Hat) 					(void *)rec->ip, rec->flags);
307084bde62cSSteven Rostedt (Red Hat) 		} while_for_each_ftrace_rec();
307184bde62cSSteven Rostedt (Red Hat) 	}
307284bde62cSSteven Rostedt (Red Hat) 
3073fef5aeeeSSteven Rostedt (Red Hat) 	ops->old_hash.filter_hash = NULL;
3074fef5aeeeSSteven Rostedt (Red Hat) 	ops->old_hash.notrace_hash = NULL;
3075fef5aeeeSSteven Rostedt (Red Hat) 
3076fef5aeeeSSteven Rostedt (Red Hat) 	removed_ops = NULL;
3077e1effa01SSteven Rostedt (Red Hat) 	ops->flags &= ~FTRACE_OPS_FL_REMOVING;
307879922b80SSteven Rostedt (Red Hat) 
3079a4c35ed2SSteven Rostedt (Red Hat) 	/*
3080a4c35ed2SSteven Rostedt (Red Hat) 	 * Dynamic ops may be freed, we must make sure that all
3081a4c35ed2SSteven Rostedt (Red Hat) 	 * callers are done before leaving this function.
3082ba27f2bcSSteven Rostedt (Red Hat) 	 * The same goes for freeing the per_cpu data of the per_cpu
3083a4c35ed2SSteven Rostedt (Red Hat) 	 * ops.
30840598e4f0SSteven Rostedt (VMware) 	 */
3085b3a88803SPeter Zijlstra 	if (ops->flags & FTRACE_OPS_FL_DYNAMIC) {
30860598e4f0SSteven Rostedt (VMware) 		/*
3087a4c35ed2SSteven Rostedt (Red Hat) 		 * We need to do a hard force of sched synchronization.
3088a4c35ed2SSteven Rostedt (Red Hat) 		 * This is because we use preempt_disable() to do RCU, but
3089a4c35ed2SSteven Rostedt (Red Hat) 		 * the function tracers can be called where RCU is not watching
3090a4c35ed2SSteven Rostedt (Red Hat) 		 * (like before user_exit()). We can not rely on the RCU
3091a4c35ed2SSteven Rostedt (Red Hat) 		 * infrastructure to do the synchronization, thus we must do it
3092a4c35ed2SSteven Rostedt (Red Hat) 		 * ourselves.
3093a4c35ed2SSteven Rostedt (Red Hat) 		 */
3094e5a971d7SPaul E. McKenney 		synchronize_rcu_tasks_rude();
3095a4c35ed2SSteven Rostedt (Red Hat) 
30960598e4f0SSteven Rostedt (VMware) 		/*
3097fdda88d3SQiujun Huang 		 * When the kernel is preemptive, tasks can be preempted
30980598e4f0SSteven Rostedt (VMware) 		 * while on a ftrace trampoline. Just scheduling a task on
30990598e4f0SSteven Rostedt (VMware) 		 * a CPU is not good enough to flush them. Calling
3100f2cc020dSIngo Molnar 		 * synchronize_rcu_tasks() will wait for those tasks to
31010598e4f0SSteven Rostedt (VMware) 		 * execute and either schedule voluntarily or enter user space.
31020598e4f0SSteven Rostedt (VMware) 		 */
310330c93704SThomas Gleixner 		if (IS_ENABLED(CONFIG_PREEMPTION))
31040598e4f0SSteven Rostedt (VMware) 			synchronize_rcu_tasks();
31050598e4f0SSteven Rostedt (VMware) 
3106edb096e0SSteven Rostedt (VMware)  free_ops:
3107fc0ea795SAdrian Hunter 		ftrace_trampoline_free(ops);
3108a4c35ed2SSteven Rostedt (Red Hat) 	}
3109a4c35ed2SSteven Rostedt (Red Hat) 
31108a56d776SSteven Rostedt (Red Hat) 	return 0;
31113d083395SSteven Rostedt }
31123d083395SSteven Rostedt 
3113a5a1d1c2SThomas Gleixner static u64		ftrace_update_time;
31143d083395SSteven Rostedt unsigned long		ftrace_update_tot_cnt;
3115da537f0aSSteven Rostedt (VMware) unsigned long		ftrace_number_of_pages;
3116da537f0aSSteven Rostedt (VMware) unsigned long		ftrace_number_of_groups;
31173d083395SSteven Rostedt 
31188c4f3c3fSSteven Rostedt (Red Hat) static inline int ops_traces_mod(struct ftrace_ops *ops)
3119f7bc8b61SSteven Rostedt {
31208c4f3c3fSSteven Rostedt (Red Hat) 	/*
31218c4f3c3fSSteven Rostedt (Red Hat) 	 * Filter_hash being empty will default to trace module.
31228c4f3c3fSSteven Rostedt (Red Hat) 	 * But notrace hash requires a test of individual module functions.
31238c4f3c3fSSteven Rostedt (Red Hat) 	 */
312433b7f99cSSteven Rostedt (Red Hat) 	return ftrace_hash_empty(ops->func_hash->filter_hash) &&
312533b7f99cSSteven Rostedt (Red Hat) 		ftrace_hash_empty(ops->func_hash->notrace_hash);
31268c4f3c3fSSteven Rostedt (Red Hat) }
3127f7bc8b61SSteven Rostedt 
31281dc43cf0SJiri Slaby static int ftrace_update_code(struct module *mod, struct ftrace_page *new_pgs)
31293d083395SSteven Rostedt {
313067ccddf8SIlya Leoshkevich 	bool init_nop = ftrace_need_init_nop();
313185ae32aeSSteven Rostedt 	struct ftrace_page *pg;
3132e94142a6SLai Jiangshan 	struct dyn_ftrace *p;
3133a5a1d1c2SThomas Gleixner 	u64 start, stop;
31341dc43cf0SJiri Slaby 	unsigned long update_cnt = 0;
3135b7ffffbbSSteven Rostedt (Red Hat) 	unsigned long rec_flags = 0;
313685ae32aeSSteven Rostedt 	int i;
3137f7bc8b61SSteven Rostedt 
3138750ed1a4SIngo Molnar 	start = ftrace_now(raw_smp_processor_id());
31393d083395SSteven Rostedt 
3140b7ffffbbSSteven Rostedt (Red Hat) 	/*
3141b7ffffbbSSteven Rostedt (Red Hat) 	 * When a module is loaded, this function is called to convert
3142b7ffffbbSSteven Rostedt (Red Hat) 	 * the calls to mcount in its text to nops, and also to create
3143b7ffffbbSSteven Rostedt (Red Hat) 	 * an entry in the ftrace data. Now, if ftrace is activated
3144b7ffffbbSSteven Rostedt (Red Hat) 	 * after this call, but before the module sets its text to
3145b7ffffbbSSteven Rostedt (Red Hat) 	 * read-only, the modification of enabling ftrace can fail if
3146b7ffffbbSSteven Rostedt (Red Hat) 	 * the read-only is done while ftrace is converting the calls.
3147b7ffffbbSSteven Rostedt (Red Hat) 	 * To prevent this, the module's records are set as disabled
3148b7ffffbbSSteven Rostedt (Red Hat) 	 * and will be enabled after the call to set the module's text
3149b7ffffbbSSteven Rostedt (Red Hat) 	 * to read-only.
3150b7ffffbbSSteven Rostedt (Red Hat) 	 */
3151b7ffffbbSSteven Rostedt (Red Hat) 	if (mod)
3152b7ffffbbSSteven Rostedt (Red Hat) 		rec_flags |= FTRACE_FL_DISABLED;
3153b7ffffbbSSteven Rostedt (Red Hat) 
31541dc43cf0SJiri Slaby 	for (pg = new_pgs; pg; pg = pg->next) {
3155f22f9a89SAbhishek Sagar 
315685ae32aeSSteven Rostedt 		for (i = 0; i < pg->index; i++) {
31578c4f3c3fSSteven Rostedt (Red Hat) 
315808f5ac90SSteven Rostedt 			/* If something went wrong, bail without enabling anything */
315908f5ac90SSteven Rostedt 			if (unlikely(ftrace_disabled))
316008f5ac90SSteven Rostedt 				return -1;
31613d083395SSteven Rostedt 
316285ae32aeSSteven Rostedt 			p = &pg->records[i];
3163b7ffffbbSSteven Rostedt (Red Hat) 			p->flags = rec_flags;
3164f22f9a89SAbhishek Sagar 
31655cb084bbSJiri Olsa 			/*
316625985edcSLucas De Marchi 			 * Do the initial record conversion from mcount jump
31675cb084bbSJiri Olsa 			 * to the NOP instructions.
31685cb084bbSJiri Olsa 			 */
316967ccddf8SIlya Leoshkevich 			if (init_nop && !ftrace_nop_initialize(mod, p))
3170d2c8c3eaSSteven Rostedt 				break;
31715cb084bbSJiri Olsa 
31721dc43cf0SJiri Slaby 			update_cnt++;
31735cb084bbSJiri Olsa 		}
317485ae32aeSSteven Rostedt 	}
317585ae32aeSSteven Rostedt 
3176750ed1a4SIngo Molnar 	stop = ftrace_now(raw_smp_processor_id());
31773d083395SSteven Rostedt 	ftrace_update_time = stop - start;
31781dc43cf0SJiri Slaby 	ftrace_update_tot_cnt += update_cnt;
31793d083395SSteven Rostedt 
318016444a8aSArnaldo Carvalho de Melo 	return 0;
318116444a8aSArnaldo Carvalho de Melo }
318216444a8aSArnaldo Carvalho de Melo 
3183a7900875SSteven Rostedt static int ftrace_allocate_records(struct ftrace_page *pg, int count)
31843c1720f0SSteven Rostedt {
3185a7900875SSteven Rostedt 	int order;
31867ba031e8SSteven Rostedt (VMware) 	int pages;
31873c1720f0SSteven Rostedt 	int cnt;
31883c1720f0SSteven Rostedt 
3189a7900875SSteven Rostedt 	if (WARN_ON(!count))
3190a7900875SSteven Rostedt 		return -EINVAL;
3191a7900875SSteven Rostedt 
3192ceaaa129SSteven Rostedt (VMware) 	/* We want to fill as much as possible, with no empty pages */
3193b40c6eabSWei Yang 	pages = DIV_ROUND_UP(count, ENTRIES_PER_PAGE);
3194ceaaa129SSteven Rostedt (VMware) 	order = fls(pages) - 1;
31953c1720f0SSteven Rostedt 
3196a7900875SSteven Rostedt  again:
3197a7900875SSteven Rostedt 	pg->records = (void *)__get_free_pages(GFP_KERNEL | __GFP_ZERO, order);
3198a7900875SSteven Rostedt 
3199a7900875SSteven Rostedt 	if (!pg->records) {
3200a7900875SSteven Rostedt 		/* if we can't allocate this size, try something smaller */
3201a7900875SSteven Rostedt 		if (!order)
3202a7900875SSteven Rostedt 			return -ENOMEM;
3203a7900875SSteven Rostedt 		order >>= 1;
3204a7900875SSteven Rostedt 		goto again;
3205a7900875SSteven Rostedt 	}
3206a7900875SSteven Rostedt 
3207da537f0aSSteven Rostedt (VMware) 	ftrace_number_of_pages += 1 << order;
3208da537f0aSSteven Rostedt (VMware) 	ftrace_number_of_groups++;
3209da537f0aSSteven Rostedt (VMware) 
3210a7900875SSteven Rostedt 	cnt = (PAGE_SIZE << order) / ENTRY_SIZE;
3211db42523bSLinus Torvalds 	pg->order = order;
3212a7900875SSteven Rostedt 
3213a7900875SSteven Rostedt 	if (cnt > count)
3214a7900875SSteven Rostedt 		cnt = count;
3215a7900875SSteven Rostedt 
3216a7900875SSteven Rostedt 	return cnt;
3217a7900875SSteven Rostedt }
3218a7900875SSteven Rostedt 
3219a7900875SSteven Rostedt static struct ftrace_page *
3220a7900875SSteven Rostedt ftrace_allocate_pages(unsigned long num_to_init)
3221a7900875SSteven Rostedt {
3222a7900875SSteven Rostedt 	struct ftrace_page *start_pg;
3223a7900875SSteven Rostedt 	struct ftrace_page *pg;
3224a7900875SSteven Rostedt 	int cnt;
3225a7900875SSteven Rostedt 
3226a7900875SSteven Rostedt 	if (!num_to_init)
32279efb85c5SHariprasad Kelam 		return NULL;
3228a7900875SSteven Rostedt 
3229a7900875SSteven Rostedt 	start_pg = pg = kzalloc(sizeof(*pg), GFP_KERNEL);
3230a7900875SSteven Rostedt 	if (!pg)
3231a7900875SSteven Rostedt 		return NULL;
3232a7900875SSteven Rostedt 
3233a7900875SSteven Rostedt 	/*
3234a7900875SSteven Rostedt 	 * Try to allocate as much as possible in one continues
3235a7900875SSteven Rostedt 	 * location that fills in all of the space. We want to
3236a7900875SSteven Rostedt 	 * waste as little space as possible.
3237a7900875SSteven Rostedt 	 */
3238a7900875SSteven Rostedt 	for (;;) {
3239a7900875SSteven Rostedt 		cnt = ftrace_allocate_records(pg, num_to_init);
3240a7900875SSteven Rostedt 		if (cnt < 0)
3241a7900875SSteven Rostedt 			goto free_pages;
3242a7900875SSteven Rostedt 
3243a7900875SSteven Rostedt 		num_to_init -= cnt;
3244a7900875SSteven Rostedt 		if (!num_to_init)
3245a7900875SSteven Rostedt 			break;
3246a7900875SSteven Rostedt 
3247a7900875SSteven Rostedt 		pg->next = kzalloc(sizeof(*pg), GFP_KERNEL);
3248a7900875SSteven Rostedt 		if (!pg->next)
3249a7900875SSteven Rostedt 			goto free_pages;
3250a7900875SSteven Rostedt 
3251a7900875SSteven Rostedt 		pg = pg->next;
3252a7900875SSteven Rostedt 	}
3253a7900875SSteven Rostedt 
3254a7900875SSteven Rostedt 	return start_pg;
3255a7900875SSteven Rostedt 
3256a7900875SSteven Rostedt  free_pages:
32571f61be00SNamhyung Kim 	pg = start_pg;
32581f61be00SNamhyung Kim 	while (pg) {
3259db42523bSLinus Torvalds 		if (pg->records) {
3260db42523bSLinus Torvalds 			free_pages((unsigned long)pg->records, pg->order);
3261db42523bSLinus Torvalds 			ftrace_number_of_pages -= 1 << pg->order;
3262db42523bSLinus Torvalds 		}
3263a7900875SSteven Rostedt 		start_pg = pg->next;
3264a7900875SSteven Rostedt 		kfree(pg);
3265a7900875SSteven Rostedt 		pg = start_pg;
3266da537f0aSSteven Rostedt (VMware) 		ftrace_number_of_groups--;
3267a7900875SSteven Rostedt 	}
3268a7900875SSteven Rostedt 	pr_info("ftrace: FAILED to allocate memory for functions\n");
3269a7900875SSteven Rostedt 	return NULL;
3270a7900875SSteven Rostedt }
3271a7900875SSteven Rostedt 
32725072c59fSSteven Rostedt #define FTRACE_BUFF_MAX (KSYM_SYMBOL_LEN+4) /* room for wildcards */
32735072c59fSSteven Rostedt 
32745072c59fSSteven Rostedt struct ftrace_iterator {
327598c4fd04SSteven Rostedt 	loff_t				pos;
32762bccfffdSSteven Rostedt 	loff_t				func_pos;
32775985ea8bSSteven Rostedt (VMware) 	loff_t				mod_pos;
32785072c59fSSteven Rostedt 	struct ftrace_page		*pg;
32794aeb6967SSteven Rostedt 	struct dyn_ftrace		*func;
32804aeb6967SSteven Rostedt 	struct ftrace_func_probe	*probe;
3281eee8ded1SSteven Rostedt (VMware) 	struct ftrace_func_entry	*probe_entry;
32824aeb6967SSteven Rostedt 	struct trace_parser		parser;
32831cf41dd7SSteven Rostedt 	struct ftrace_hash		*hash;
328433dc9b12SSteven Rostedt 	struct ftrace_ops		*ops;
32855985ea8bSSteven Rostedt (VMware) 	struct trace_array		*tr;
32865985ea8bSSteven Rostedt (VMware) 	struct list_head		*mod_list;
3287eee8ded1SSteven Rostedt (VMware) 	int				pidx;
3288431aa3fbSSteven Rostedt 	int				idx;
32895072c59fSSteven Rostedt 	unsigned			flags;
32905072c59fSSteven Rostedt };
32915072c59fSSteven Rostedt 
3292e309b41dSIngo Molnar static void *
3293eee8ded1SSteven Rostedt (VMware) t_probe_next(struct seq_file *m, loff_t *pos)
32948fc0c701SSteven Rostedt {
32958fc0c701SSteven Rostedt 	struct ftrace_iterator *iter = m->private;
3296d2afd57aSSteven Rostedt (VMware) 	struct trace_array *tr = iter->ops->private;
329704ec7bb6SSteven Rostedt (VMware) 	struct list_head *func_probes;
3298eee8ded1SSteven Rostedt (VMware) 	struct ftrace_hash *hash;
3299eee8ded1SSteven Rostedt (VMware) 	struct list_head *next;
33004aeb6967SSteven Rostedt 	struct hlist_node *hnd = NULL;
33018fc0c701SSteven Rostedt 	struct hlist_head *hhd;
3302eee8ded1SSteven Rostedt (VMware) 	int size;
33038fc0c701SSteven Rostedt 
33048fc0c701SSteven Rostedt 	(*pos)++;
330598c4fd04SSteven Rostedt 	iter->pos = *pos;
33068fc0c701SSteven Rostedt 
330704ec7bb6SSteven Rostedt (VMware) 	if (!tr)
33088fc0c701SSteven Rostedt 		return NULL;
33098fc0c701SSteven Rostedt 
331004ec7bb6SSteven Rostedt (VMware) 	func_probes = &tr->func_probes;
331104ec7bb6SSteven Rostedt (VMware) 	if (list_empty(func_probes))
33128fc0c701SSteven Rostedt 		return NULL;
33138fc0c701SSteven Rostedt 
3314eee8ded1SSteven Rostedt (VMware) 	if (!iter->probe) {
331504ec7bb6SSteven Rostedt (VMware) 		next = func_probes->next;
33167b60f3d8SSteven Rostedt (VMware) 		iter->probe = list_entry(next, struct ftrace_func_probe, list);
3317eee8ded1SSteven Rostedt (VMware) 	}
3318eee8ded1SSteven Rostedt (VMware) 
3319eee8ded1SSteven Rostedt (VMware) 	if (iter->probe_entry)
3320eee8ded1SSteven Rostedt (VMware) 		hnd = &iter->probe_entry->hlist;
3321eee8ded1SSteven Rostedt (VMware) 
3322eee8ded1SSteven Rostedt (VMware) 	hash = iter->probe->ops.func_hash->filter_hash;
33237bd46644SNaveen N. Rao 
3324372e0d01SSteven Rostedt (VMware) 	/*
3325372e0d01SSteven Rostedt (VMware) 	 * A probe being registered may temporarily have an empty hash
3326372e0d01SSteven Rostedt (VMware) 	 * and it's at the end of the func_probes list.
3327372e0d01SSteven Rostedt (VMware) 	 */
3328372e0d01SSteven Rostedt (VMware) 	if (!hash || hash == EMPTY_HASH)
33297bd46644SNaveen N. Rao 		return NULL;
33307bd46644SNaveen N. Rao 
3331eee8ded1SSteven Rostedt (VMware) 	size = 1 << hash->size_bits;
3332eee8ded1SSteven Rostedt (VMware) 
3333eee8ded1SSteven Rostedt (VMware)  retry:
3334eee8ded1SSteven Rostedt (VMware) 	if (iter->pidx >= size) {
333504ec7bb6SSteven Rostedt (VMware) 		if (iter->probe->list.next == func_probes)
3336eee8ded1SSteven Rostedt (VMware) 			return NULL;
3337eee8ded1SSteven Rostedt (VMware) 		next = iter->probe->list.next;
33387b60f3d8SSteven Rostedt (VMware) 		iter->probe = list_entry(next, struct ftrace_func_probe, list);
3339eee8ded1SSteven Rostedt (VMware) 		hash = iter->probe->ops.func_hash->filter_hash;
3340eee8ded1SSteven Rostedt (VMware) 		size = 1 << hash->size_bits;
3341eee8ded1SSteven Rostedt (VMware) 		iter->pidx = 0;
3342eee8ded1SSteven Rostedt (VMware) 	}
3343eee8ded1SSteven Rostedt (VMware) 
3344eee8ded1SSteven Rostedt (VMware) 	hhd = &hash->buckets[iter->pidx];
33458fc0c701SSteven Rostedt 
33468fc0c701SSteven Rostedt 	if (hlist_empty(hhd)) {
3347eee8ded1SSteven Rostedt (VMware) 		iter->pidx++;
33488fc0c701SSteven Rostedt 		hnd = NULL;
33498fc0c701SSteven Rostedt 		goto retry;
33508fc0c701SSteven Rostedt 	}
33518fc0c701SSteven Rostedt 
33528fc0c701SSteven Rostedt 	if (!hnd)
33538fc0c701SSteven Rostedt 		hnd = hhd->first;
33548fc0c701SSteven Rostedt 	else {
33558fc0c701SSteven Rostedt 		hnd = hnd->next;
33568fc0c701SSteven Rostedt 		if (!hnd) {
3357eee8ded1SSteven Rostedt (VMware) 			iter->pidx++;
33588fc0c701SSteven Rostedt 			goto retry;
33598fc0c701SSteven Rostedt 		}
33608fc0c701SSteven Rostedt 	}
33618fc0c701SSteven Rostedt 
33624aeb6967SSteven Rostedt 	if (WARN_ON_ONCE(!hnd))
33634aeb6967SSteven Rostedt 		return NULL;
33644aeb6967SSteven Rostedt 
3365eee8ded1SSteven Rostedt (VMware) 	iter->probe_entry = hlist_entry(hnd, struct ftrace_func_entry, hlist);
33664aeb6967SSteven Rostedt 
33674aeb6967SSteven Rostedt 	return iter;
33688fc0c701SSteven Rostedt }
33698fc0c701SSteven Rostedt 
3370eee8ded1SSteven Rostedt (VMware) static void *t_probe_start(struct seq_file *m, loff_t *pos)
33718fc0c701SSteven Rostedt {
33728fc0c701SSteven Rostedt 	struct ftrace_iterator *iter = m->private;
33738fc0c701SSteven Rostedt 	void *p = NULL;
3374d82d6244SLi Zefan 	loff_t l;
3375d82d6244SLi Zefan 
3376eee8ded1SSteven Rostedt (VMware) 	if (!(iter->flags & FTRACE_ITER_DO_PROBES))
337769a3083cSSteven Rostedt 		return NULL;
337869a3083cSSteven Rostedt 
33795985ea8bSSteven Rostedt (VMware) 	if (iter->mod_pos > *pos)
33802bccfffdSSteven Rostedt 		return NULL;
33818fc0c701SSteven Rostedt 
3382eee8ded1SSteven Rostedt (VMware) 	iter->probe = NULL;
3383eee8ded1SSteven Rostedt (VMware) 	iter->probe_entry = NULL;
3384eee8ded1SSteven Rostedt (VMware) 	iter->pidx = 0;
33855985ea8bSSteven Rostedt (VMware) 	for (l = 0; l <= (*pos - iter->mod_pos); ) {
3386eee8ded1SSteven Rostedt (VMware) 		p = t_probe_next(m, &l);
3387d82d6244SLi Zefan 		if (!p)
3388d82d6244SLi Zefan 			break;
3389d82d6244SLi Zefan 	}
33904aeb6967SSteven Rostedt 	if (!p)
33914aeb6967SSteven Rostedt 		return NULL;
33924aeb6967SSteven Rostedt 
339398c4fd04SSteven Rostedt 	/* Only set this if we have an item */
3394eee8ded1SSteven Rostedt (VMware) 	iter->flags |= FTRACE_ITER_PROBE;
339598c4fd04SSteven Rostedt 
33964aeb6967SSteven Rostedt 	return iter;
33978fc0c701SSteven Rostedt }
33988fc0c701SSteven Rostedt 
33994aeb6967SSteven Rostedt static int
3400eee8ded1SSteven Rostedt (VMware) t_probe_show(struct seq_file *m, struct ftrace_iterator *iter)
34018fc0c701SSteven Rostedt {
3402eee8ded1SSteven Rostedt (VMware) 	struct ftrace_func_entry *probe_entry;
34037b60f3d8SSteven Rostedt (VMware) 	struct ftrace_probe_ops *probe_ops;
34047b60f3d8SSteven Rostedt (VMware) 	struct ftrace_func_probe *probe;
34058fc0c701SSteven Rostedt 
3406eee8ded1SSteven Rostedt (VMware) 	probe = iter->probe;
3407eee8ded1SSteven Rostedt (VMware) 	probe_entry = iter->probe_entry;
3408eee8ded1SSteven Rostedt (VMware) 
3409eee8ded1SSteven Rostedt (VMware) 	if (WARN_ON_ONCE(!probe || !probe_entry))
34104aeb6967SSteven Rostedt 		return -EIO;
34118fc0c701SSteven Rostedt 
34127b60f3d8SSteven Rostedt (VMware) 	probe_ops = probe->probe_ops;
3413809dcf29SSteven Rostedt 
34147b60f3d8SSteven Rostedt (VMware) 	if (probe_ops->print)
34156e444319SSteven Rostedt (VMware) 		return probe_ops->print(m, probe_entry->ip, probe_ops, probe->data);
34168fc0c701SSteven Rostedt 
34177b60f3d8SSteven Rostedt (VMware) 	seq_printf(m, "%ps:%ps\n", (void *)probe_entry->ip,
34187b60f3d8SSteven Rostedt (VMware) 		   (void *)probe_ops->func);
34198fc0c701SSteven Rostedt 
34208fc0c701SSteven Rostedt 	return 0;
34218fc0c701SSteven Rostedt }
34228fc0c701SSteven Rostedt 
34238fc0c701SSteven Rostedt static void *
34245985ea8bSSteven Rostedt (VMware) t_mod_next(struct seq_file *m, loff_t *pos)
34255985ea8bSSteven Rostedt (VMware) {
34265985ea8bSSteven Rostedt (VMware) 	struct ftrace_iterator *iter = m->private;
34275985ea8bSSteven Rostedt (VMware) 	struct trace_array *tr = iter->tr;
34285985ea8bSSteven Rostedt (VMware) 
34295985ea8bSSteven Rostedt (VMware) 	(*pos)++;
34305985ea8bSSteven Rostedt (VMware) 	iter->pos = *pos;
34315985ea8bSSteven Rostedt (VMware) 
34325985ea8bSSteven Rostedt (VMware) 	iter->mod_list = iter->mod_list->next;
34335985ea8bSSteven Rostedt (VMware) 
34345985ea8bSSteven Rostedt (VMware) 	if (iter->mod_list == &tr->mod_trace ||
34355985ea8bSSteven Rostedt (VMware) 	    iter->mod_list == &tr->mod_notrace) {
34365985ea8bSSteven Rostedt (VMware) 		iter->flags &= ~FTRACE_ITER_MOD;
34375985ea8bSSteven Rostedt (VMware) 		return NULL;
34385985ea8bSSteven Rostedt (VMware) 	}
34395985ea8bSSteven Rostedt (VMware) 
34405985ea8bSSteven Rostedt (VMware) 	iter->mod_pos = *pos;
34415985ea8bSSteven Rostedt (VMware) 
34425985ea8bSSteven Rostedt (VMware) 	return iter;
34435985ea8bSSteven Rostedt (VMware) }
34445985ea8bSSteven Rostedt (VMware) 
34455985ea8bSSteven Rostedt (VMware) static void *t_mod_start(struct seq_file *m, loff_t *pos)
34465985ea8bSSteven Rostedt (VMware) {
34475985ea8bSSteven Rostedt (VMware) 	struct ftrace_iterator *iter = m->private;
34485985ea8bSSteven Rostedt (VMware) 	void *p = NULL;
34495985ea8bSSteven Rostedt (VMware) 	loff_t l;
34505985ea8bSSteven Rostedt (VMware) 
34515985ea8bSSteven Rostedt (VMware) 	if (iter->func_pos > *pos)
34525985ea8bSSteven Rostedt (VMware) 		return NULL;
34535985ea8bSSteven Rostedt (VMware) 
34545985ea8bSSteven Rostedt (VMware) 	iter->mod_pos = iter->func_pos;
34555985ea8bSSteven Rostedt (VMware) 
34565985ea8bSSteven Rostedt (VMware) 	/* probes are only available if tr is set */
34575985ea8bSSteven Rostedt (VMware) 	if (!iter->tr)
34585985ea8bSSteven Rostedt (VMware) 		return NULL;
34595985ea8bSSteven Rostedt (VMware) 
34605985ea8bSSteven Rostedt (VMware) 	for (l = 0; l <= (*pos - iter->func_pos); ) {
34615985ea8bSSteven Rostedt (VMware) 		p = t_mod_next(m, &l);
34625985ea8bSSteven Rostedt (VMware) 		if (!p)
34635985ea8bSSteven Rostedt (VMware) 			break;
34645985ea8bSSteven Rostedt (VMware) 	}
34655985ea8bSSteven Rostedt (VMware) 	if (!p) {
34665985ea8bSSteven Rostedt (VMware) 		iter->flags &= ~FTRACE_ITER_MOD;
34675985ea8bSSteven Rostedt (VMware) 		return t_probe_start(m, pos);
34685985ea8bSSteven Rostedt (VMware) 	}
34695985ea8bSSteven Rostedt (VMware) 
34705985ea8bSSteven Rostedt (VMware) 	/* Only set this if we have an item */
34715985ea8bSSteven Rostedt (VMware) 	iter->flags |= FTRACE_ITER_MOD;
34725985ea8bSSteven Rostedt (VMware) 
34735985ea8bSSteven Rostedt (VMware) 	return iter;
34745985ea8bSSteven Rostedt (VMware) }
34755985ea8bSSteven Rostedt (VMware) 
34765985ea8bSSteven Rostedt (VMware) static int
34775985ea8bSSteven Rostedt (VMware) t_mod_show(struct seq_file *m, struct ftrace_iterator *iter)
34785985ea8bSSteven Rostedt (VMware) {
34795985ea8bSSteven Rostedt (VMware) 	struct ftrace_mod_load *ftrace_mod;
34805985ea8bSSteven Rostedt (VMware) 	struct trace_array *tr = iter->tr;
34815985ea8bSSteven Rostedt (VMware) 
34825985ea8bSSteven Rostedt (VMware) 	if (WARN_ON_ONCE(!iter->mod_list) ||
34835985ea8bSSteven Rostedt (VMware) 			 iter->mod_list == &tr->mod_trace ||
34845985ea8bSSteven Rostedt (VMware) 			 iter->mod_list == &tr->mod_notrace)
34855985ea8bSSteven Rostedt (VMware) 		return -EIO;
34865985ea8bSSteven Rostedt (VMware) 
34875985ea8bSSteven Rostedt (VMware) 	ftrace_mod = list_entry(iter->mod_list, struct ftrace_mod_load, list);
34885985ea8bSSteven Rostedt (VMware) 
34895985ea8bSSteven Rostedt (VMware) 	if (ftrace_mod->func)
34905985ea8bSSteven Rostedt (VMware) 		seq_printf(m, "%s", ftrace_mod->func);
34915985ea8bSSteven Rostedt (VMware) 	else
34925985ea8bSSteven Rostedt (VMware) 		seq_putc(m, '*');
34935985ea8bSSteven Rostedt (VMware) 
34945985ea8bSSteven Rostedt (VMware) 	seq_printf(m, ":mod:%s\n", ftrace_mod->module);
34955985ea8bSSteven Rostedt (VMware) 
34965985ea8bSSteven Rostedt (VMware) 	return 0;
34975985ea8bSSteven Rostedt (VMware) }
34985985ea8bSSteven Rostedt (VMware) 
34995985ea8bSSteven Rostedt (VMware) static void *
35005bd84629SSteven Rostedt (VMware) t_func_next(struct seq_file *m, loff_t *pos)
35015072c59fSSteven Rostedt {
35025072c59fSSteven Rostedt 	struct ftrace_iterator *iter = m->private;
35035072c59fSSteven Rostedt 	struct dyn_ftrace *rec = NULL;
35045072c59fSSteven Rostedt 
35055072c59fSSteven Rostedt 	(*pos)++;
35060c75a3edSSteven Rostedt 
35075072c59fSSteven Rostedt  retry:
35085072c59fSSteven Rostedt 	if (iter->idx >= iter->pg->index) {
35095072c59fSSteven Rostedt 		if (iter->pg->next) {
35105072c59fSSteven Rostedt 			iter->pg = iter->pg->next;
35115072c59fSSteven Rostedt 			iter->idx = 0;
35125072c59fSSteven Rostedt 			goto retry;
35135072c59fSSteven Rostedt 		}
35145072c59fSSteven Rostedt 	} else {
35155072c59fSSteven Rostedt 		rec = &iter->pg->records[iter->idx++];
3516c20489daSSteven Rostedt (VMware) 		if (((iter->flags & (FTRACE_ITER_FILTER | FTRACE_ITER_NOTRACE)) &&
3517c20489daSSteven Rostedt (VMware) 		     !ftrace_lookup_ip(iter->hash, rec->ip)) ||
3518647bcd03SSteven Rostedt 
3519647bcd03SSteven Rostedt 		    ((iter->flags & FTRACE_ITER_ENABLED) &&
352023ea9c4dSSteven Rostedt (Red Hat) 		     !(rec->flags & FTRACE_FL_ENABLED))) {
3521647bcd03SSteven Rostedt 
35225072c59fSSteven Rostedt 			rec = NULL;
35235072c59fSSteven Rostedt 			goto retry;
35245072c59fSSteven Rostedt 		}
35255072c59fSSteven Rostedt 	}
35265072c59fSSteven Rostedt 
35274aeb6967SSteven Rostedt 	if (!rec)
35285bd84629SSteven Rostedt (VMware) 		return NULL;
35294aeb6967SSteven Rostedt 
35305bd84629SSteven Rostedt (VMware) 	iter->pos = iter->func_pos = *pos;
35314aeb6967SSteven Rostedt 	iter->func = rec;
35324aeb6967SSteven Rostedt 
35334aeb6967SSteven Rostedt 	return iter;
35345072c59fSSteven Rostedt }
35355072c59fSSteven Rostedt 
35365bd84629SSteven Rostedt (VMware) static void *
35375bd84629SSteven Rostedt (VMware) t_next(struct seq_file *m, void *v, loff_t *pos)
35385bd84629SSteven Rostedt (VMware) {
35395bd84629SSteven Rostedt (VMware) 	struct ftrace_iterator *iter = m->private;
35405985ea8bSSteven Rostedt (VMware) 	loff_t l = *pos; /* t_probe_start() must use original pos */
35415bd84629SSteven Rostedt (VMware) 	void *ret;
35425bd84629SSteven Rostedt (VMware) 
35435bd84629SSteven Rostedt (VMware) 	if (unlikely(ftrace_disabled))
35445bd84629SSteven Rostedt (VMware) 		return NULL;
35455bd84629SSteven Rostedt (VMware) 
3546eee8ded1SSteven Rostedt (VMware) 	if (iter->flags & FTRACE_ITER_PROBE)
3547eee8ded1SSteven Rostedt (VMware) 		return t_probe_next(m, pos);
35485bd84629SSteven Rostedt (VMware) 
35495985ea8bSSteven Rostedt (VMware) 	if (iter->flags & FTRACE_ITER_MOD)
35505985ea8bSSteven Rostedt (VMware) 		return t_mod_next(m, pos);
35515985ea8bSSteven Rostedt (VMware) 
35525bd84629SSteven Rostedt (VMware) 	if (iter->flags & FTRACE_ITER_PRINTALL) {
3553eee8ded1SSteven Rostedt (VMware) 		/* next must increment pos, and t_probe_start does not */
35545bd84629SSteven Rostedt (VMware) 		(*pos)++;
35555985ea8bSSteven Rostedt (VMware) 		return t_mod_start(m, &l);
35565bd84629SSteven Rostedt (VMware) 	}
35575bd84629SSteven Rostedt (VMware) 
35585bd84629SSteven Rostedt (VMware) 	ret = t_func_next(m, pos);
35595bd84629SSteven Rostedt (VMware) 
35605bd84629SSteven Rostedt (VMware) 	if (!ret)
35615985ea8bSSteven Rostedt (VMware) 		return t_mod_start(m, &l);
35625bd84629SSteven Rostedt (VMware) 
35635bd84629SSteven Rostedt (VMware) 	return ret;
35645bd84629SSteven Rostedt (VMware) }
35655bd84629SSteven Rostedt (VMware) 
356698c4fd04SSteven Rostedt static void reset_iter_read(struct ftrace_iterator *iter)
356798c4fd04SSteven Rostedt {
356898c4fd04SSteven Rostedt 	iter->pos = 0;
356998c4fd04SSteven Rostedt 	iter->func_pos = 0;
35705985ea8bSSteven Rostedt (VMware) 	iter->flags &= ~(FTRACE_ITER_PRINTALL | FTRACE_ITER_PROBE | FTRACE_ITER_MOD);
35715072c59fSSteven Rostedt }
35725072c59fSSteven Rostedt 
35735072c59fSSteven Rostedt static void *t_start(struct seq_file *m, loff_t *pos)
35745072c59fSSteven Rostedt {
35755072c59fSSteven Rostedt 	struct ftrace_iterator *iter = m->private;
35765072c59fSSteven Rostedt 	void *p = NULL;
3577694ce0a5SLi Zefan 	loff_t l;
35785072c59fSSteven Rostedt 
35798fc0c701SSteven Rostedt 	mutex_lock(&ftrace_lock);
358045a4a237SSteven Rostedt 
358145a4a237SSteven Rostedt 	if (unlikely(ftrace_disabled))
358245a4a237SSteven Rostedt 		return NULL;
358345a4a237SSteven Rostedt 
35840c75a3edSSteven Rostedt 	/*
358598c4fd04SSteven Rostedt 	 * If an lseek was done, then reset and start from beginning.
358698c4fd04SSteven Rostedt 	 */
358798c4fd04SSteven Rostedt 	if (*pos < iter->pos)
358898c4fd04SSteven Rostedt 		reset_iter_read(iter);
358998c4fd04SSteven Rostedt 
359098c4fd04SSteven Rostedt 	/*
35910c75a3edSSteven Rostedt 	 * For set_ftrace_filter reading, if we have the filter
35920c75a3edSSteven Rostedt 	 * off, we can short cut and just print out that all
35930c75a3edSSteven Rostedt 	 * functions are enabled.
35940c75a3edSSteven Rostedt 	 */
3595c20489daSSteven Rostedt (VMware) 	if ((iter->flags & (FTRACE_ITER_FILTER | FTRACE_ITER_NOTRACE)) &&
3596c20489daSSteven Rostedt (VMware) 	    ftrace_hash_empty(iter->hash)) {
359743ff926aSSteven Rostedt (VMware) 		iter->func_pos = 1; /* Account for the message */
35980c75a3edSSteven Rostedt 		if (*pos > 0)
35995985ea8bSSteven Rostedt (VMware) 			return t_mod_start(m, pos);
36000c75a3edSSteven Rostedt 		iter->flags |= FTRACE_ITER_PRINTALL;
3601df091625SChris Wright 		/* reset in case of seek/pread */
3602eee8ded1SSteven Rostedt (VMware) 		iter->flags &= ~FTRACE_ITER_PROBE;
36030c75a3edSSteven Rostedt 		return iter;
36040c75a3edSSteven Rostedt 	}
36050c75a3edSSteven Rostedt 
36065985ea8bSSteven Rostedt (VMware) 	if (iter->flags & FTRACE_ITER_MOD)
36075985ea8bSSteven Rostedt (VMware) 		return t_mod_start(m, pos);
36088fc0c701SSteven Rostedt 
360998c4fd04SSteven Rostedt 	/*
361098c4fd04SSteven Rostedt 	 * Unfortunately, we need to restart at ftrace_pages_start
361198c4fd04SSteven Rostedt 	 * every time we let go of the ftrace_mutex. This is because
361298c4fd04SSteven Rostedt 	 * those pointers can change without the lock.
361398c4fd04SSteven Rostedt 	 */
3614694ce0a5SLi Zefan 	iter->pg = ftrace_pages_start;
3615694ce0a5SLi Zefan 	iter->idx = 0;
3616694ce0a5SLi Zefan 	for (l = 0; l <= *pos; ) {
36175bd84629SSteven Rostedt (VMware) 		p = t_func_next(m, &l);
3618694ce0a5SLi Zefan 		if (!p)
3619694ce0a5SLi Zefan 			break;
362050cdaf08SLiming Wang 	}
36215821e1b7Swalimis 
362269a3083cSSteven Rostedt 	if (!p)
36235985ea8bSSteven Rostedt (VMware) 		return t_mod_start(m, pos);
36248fc0c701SSteven Rostedt 
36254aeb6967SSteven Rostedt 	return iter;
36265072c59fSSteven Rostedt }
36275072c59fSSteven Rostedt 
36285072c59fSSteven Rostedt static void t_stop(struct seq_file *m, void *p)
36295072c59fSSteven Rostedt {
36308fc0c701SSteven Rostedt 	mutex_unlock(&ftrace_lock);
36315072c59fSSteven Rostedt }
36325072c59fSSteven Rostedt 
363315d5b02cSSteven Rostedt (Red Hat) void * __weak
363415d5b02cSSteven Rostedt (Red Hat) arch_ftrace_trampoline_func(struct ftrace_ops *ops, struct dyn_ftrace *rec)
363515d5b02cSSteven Rostedt (Red Hat) {
363615d5b02cSSteven Rostedt (Red Hat) 	return NULL;
363715d5b02cSSteven Rostedt (Red Hat) }
363815d5b02cSSteven Rostedt (Red Hat) 
363915d5b02cSSteven Rostedt (Red Hat) static void add_trampoline_func(struct seq_file *m, struct ftrace_ops *ops,
364015d5b02cSSteven Rostedt (Red Hat) 				struct dyn_ftrace *rec)
364115d5b02cSSteven Rostedt (Red Hat) {
364215d5b02cSSteven Rostedt (Red Hat) 	void *ptr;
364315d5b02cSSteven Rostedt (Red Hat) 
364415d5b02cSSteven Rostedt (Red Hat) 	ptr = arch_ftrace_trampoline_func(ops, rec);
364515d5b02cSSteven Rostedt (Red Hat) 	if (ptr)
364615d5b02cSSteven Rostedt (Red Hat) 		seq_printf(m, " ->%pS", ptr);
364715d5b02cSSteven Rostedt (Red Hat) }
364815d5b02cSSteven Rostedt (Red Hat) 
3649b39181f7SSteven Rostedt (Google) #ifdef FTRACE_MCOUNT_MAX_OFFSET
3650b39181f7SSteven Rostedt (Google) /*
3651b39181f7SSteven Rostedt (Google)  * Weak functions can still have an mcount/fentry that is saved in
3652b39181f7SSteven Rostedt (Google)  * the __mcount_loc section. These can be detected by having a
3653b39181f7SSteven Rostedt (Google)  * symbol offset of greater than FTRACE_MCOUNT_MAX_OFFSET, as the
3654b39181f7SSteven Rostedt (Google)  * symbol found by kallsyms is not the function that the mcount/fentry
3655b39181f7SSteven Rostedt (Google)  * is part of. The offset is much greater in these cases.
3656b39181f7SSteven Rostedt (Google)  *
3657b39181f7SSteven Rostedt (Google)  * Test the record to make sure that the ip points to a valid kallsyms
3658b39181f7SSteven Rostedt (Google)  * and if not, mark it disabled.
3659b39181f7SSteven Rostedt (Google)  */
3660b39181f7SSteven Rostedt (Google) static int test_for_valid_rec(struct dyn_ftrace *rec)
3661b39181f7SSteven Rostedt (Google) {
3662b39181f7SSteven Rostedt (Google) 	char str[KSYM_SYMBOL_LEN];
3663b39181f7SSteven Rostedt (Google) 	unsigned long offset;
3664b39181f7SSteven Rostedt (Google) 	const char *ret;
3665b39181f7SSteven Rostedt (Google) 
3666b39181f7SSteven Rostedt (Google) 	ret = kallsyms_lookup(rec->ip, NULL, &offset, NULL, str);
3667b39181f7SSteven Rostedt (Google) 
3668b39181f7SSteven Rostedt (Google) 	/* Weak functions can cause invalid addresses */
3669b39181f7SSteven Rostedt (Google) 	if (!ret || offset > FTRACE_MCOUNT_MAX_OFFSET) {
3670b39181f7SSteven Rostedt (Google) 		rec->flags |= FTRACE_FL_DISABLED;
3671b39181f7SSteven Rostedt (Google) 		return 0;
3672b39181f7SSteven Rostedt (Google) 	}
3673b39181f7SSteven Rostedt (Google) 	return 1;
3674b39181f7SSteven Rostedt (Google) }
3675b39181f7SSteven Rostedt (Google) 
3676b39181f7SSteven Rostedt (Google) static struct workqueue_struct *ftrace_check_wq __initdata;
3677b39181f7SSteven Rostedt (Google) static struct work_struct ftrace_check_work __initdata;
3678b39181f7SSteven Rostedt (Google) 
3679b39181f7SSteven Rostedt (Google) /*
3680b39181f7SSteven Rostedt (Google)  * Scan all the mcount/fentry entries to make sure they are valid.
3681b39181f7SSteven Rostedt (Google)  */
3682b39181f7SSteven Rostedt (Google) static __init void ftrace_check_work_func(struct work_struct *work)
3683b39181f7SSteven Rostedt (Google) {
3684b39181f7SSteven Rostedt (Google) 	struct ftrace_page *pg;
3685b39181f7SSteven Rostedt (Google) 	struct dyn_ftrace *rec;
3686b39181f7SSteven Rostedt (Google) 
3687b39181f7SSteven Rostedt (Google) 	mutex_lock(&ftrace_lock);
3688b39181f7SSteven Rostedt (Google) 	do_for_each_ftrace_rec(pg, rec) {
3689b39181f7SSteven Rostedt (Google) 		test_for_valid_rec(rec);
3690b39181f7SSteven Rostedt (Google) 	} while_for_each_ftrace_rec();
3691b39181f7SSteven Rostedt (Google) 	mutex_unlock(&ftrace_lock);
3692b39181f7SSteven Rostedt (Google) }
3693b39181f7SSteven Rostedt (Google) 
3694b39181f7SSteven Rostedt (Google) static int __init ftrace_check_for_weak_functions(void)
3695b39181f7SSteven Rostedt (Google) {
3696b39181f7SSteven Rostedt (Google) 	INIT_WORK(&ftrace_check_work, ftrace_check_work_func);
3697b39181f7SSteven Rostedt (Google) 
3698b39181f7SSteven Rostedt (Google) 	ftrace_check_wq = alloc_workqueue("ftrace_check_wq", WQ_UNBOUND, 0);
3699b39181f7SSteven Rostedt (Google) 
3700b39181f7SSteven Rostedt (Google) 	queue_work(ftrace_check_wq, &ftrace_check_work);
3701b39181f7SSteven Rostedt (Google) 	return 0;
3702b39181f7SSteven Rostedt (Google) }
3703b39181f7SSteven Rostedt (Google) 
3704b39181f7SSteven Rostedt (Google) static int __init ftrace_check_sync(void)
3705b39181f7SSteven Rostedt (Google) {
3706b39181f7SSteven Rostedt (Google) 	/* Make sure the ftrace_check updates are finished */
3707b39181f7SSteven Rostedt (Google) 	if (ftrace_check_wq)
3708b39181f7SSteven Rostedt (Google) 		destroy_workqueue(ftrace_check_wq);
3709b39181f7SSteven Rostedt (Google) 	return 0;
3710b39181f7SSteven Rostedt (Google) }
3711b39181f7SSteven Rostedt (Google) 
3712b39181f7SSteven Rostedt (Google) late_initcall_sync(ftrace_check_sync);
3713b39181f7SSteven Rostedt (Google) subsys_initcall(ftrace_check_for_weak_functions);
3714b39181f7SSteven Rostedt (Google) 
3715b39181f7SSteven Rostedt (Google) static int print_rec(struct seq_file *m, unsigned long ip)
3716b39181f7SSteven Rostedt (Google) {
3717b39181f7SSteven Rostedt (Google) 	unsigned long offset;
3718b39181f7SSteven Rostedt (Google) 	char str[KSYM_SYMBOL_LEN];
3719b39181f7SSteven Rostedt (Google) 	char *modname;
3720b39181f7SSteven Rostedt (Google) 	const char *ret;
3721b39181f7SSteven Rostedt (Google) 
3722b39181f7SSteven Rostedt (Google) 	ret = kallsyms_lookup(ip, NULL, &offset, &modname, str);
3723b39181f7SSteven Rostedt (Google) 	/* Weak functions can cause invalid addresses */
3724b39181f7SSteven Rostedt (Google) 	if (!ret || offset > FTRACE_MCOUNT_MAX_OFFSET) {
3725b39181f7SSteven Rostedt (Google) 		snprintf(str, KSYM_SYMBOL_LEN, "%s_%ld",
3726b39181f7SSteven Rostedt (Google) 			 FTRACE_INVALID_FUNCTION, offset);
3727b39181f7SSteven Rostedt (Google) 		ret = NULL;
3728b39181f7SSteven Rostedt (Google) 	}
3729b39181f7SSteven Rostedt (Google) 
3730b39181f7SSteven Rostedt (Google) 	seq_puts(m, str);
3731b39181f7SSteven Rostedt (Google) 	if (modname)
3732b39181f7SSteven Rostedt (Google) 		seq_printf(m, " [%s]", modname);
3733b39181f7SSteven Rostedt (Google) 	return ret == NULL ? -1 : 0;
3734b39181f7SSteven Rostedt (Google) }
3735b39181f7SSteven Rostedt (Google) #else
3736b39181f7SSteven Rostedt (Google) static inline int test_for_valid_rec(struct dyn_ftrace *rec)
3737b39181f7SSteven Rostedt (Google) {
3738b39181f7SSteven Rostedt (Google) 	return 1;
3739b39181f7SSteven Rostedt (Google) }
3740b39181f7SSteven Rostedt (Google) 
3741b39181f7SSteven Rostedt (Google) static inline int print_rec(struct seq_file *m, unsigned long ip)
3742b39181f7SSteven Rostedt (Google) {
3743b39181f7SSteven Rostedt (Google) 	seq_printf(m, "%ps", (void *)ip);
3744b39181f7SSteven Rostedt (Google) 	return 0;
3745b39181f7SSteven Rostedt (Google) }
3746b39181f7SSteven Rostedt (Google) #endif
3747b39181f7SSteven Rostedt (Google) 
37485072c59fSSteven Rostedt static int t_show(struct seq_file *m, void *v)
37495072c59fSSteven Rostedt {
37500c75a3edSSteven Rostedt 	struct ftrace_iterator *iter = m->private;
37514aeb6967SSteven Rostedt 	struct dyn_ftrace *rec;
37525072c59fSSteven Rostedt 
3753eee8ded1SSteven Rostedt (VMware) 	if (iter->flags & FTRACE_ITER_PROBE)
3754eee8ded1SSteven Rostedt (VMware) 		return t_probe_show(m, iter);
37558fc0c701SSteven Rostedt 
37565985ea8bSSteven Rostedt (VMware) 	if (iter->flags & FTRACE_ITER_MOD)
37575985ea8bSSteven Rostedt (VMware) 		return t_mod_show(m, iter);
37585985ea8bSSteven Rostedt (VMware) 
37590c75a3edSSteven Rostedt 	if (iter->flags & FTRACE_ITER_PRINTALL) {
37608c006cf7SNamhyung Kim 		if (iter->flags & FTRACE_ITER_NOTRACE)
3761fa6f0cc7SRasmus Villemoes 			seq_puts(m, "#### no functions disabled ####\n");
37628c006cf7SNamhyung Kim 		else
3763fa6f0cc7SRasmus Villemoes 			seq_puts(m, "#### all functions enabled ####\n");
37640c75a3edSSteven Rostedt 		return 0;
37650c75a3edSSteven Rostedt 	}
37660c75a3edSSteven Rostedt 
37674aeb6967SSteven Rostedt 	rec = iter->func;
37684aeb6967SSteven Rostedt 
37695072c59fSSteven Rostedt 	if (!rec)
37705072c59fSSteven Rostedt 		return 0;
37715072c59fSSteven Rostedt 
3772b39181f7SSteven Rostedt (Google) 	if (print_rec(m, rec->ip)) {
3773b39181f7SSteven Rostedt (Google) 		/* This should only happen when a rec is disabled */
3774b39181f7SSteven Rostedt (Google) 		WARN_ON_ONCE(!(rec->flags & FTRACE_FL_DISABLED));
3775b39181f7SSteven Rostedt (Google) 		seq_putc(m, '\n');
3776b39181f7SSteven Rostedt (Google) 		return 0;
3777b39181f7SSteven Rostedt (Google) 	}
3778b39181f7SSteven Rostedt (Google) 
37799674b2faSSteven Rostedt (Red Hat) 	if (iter->flags & FTRACE_ITER_ENABLED) {
3780030f4e1cSSteven Rostedt (Red Hat) 		struct ftrace_ops *ops;
378115d5b02cSSteven Rostedt (Red Hat) 
3782763e34e7SSteven Rostedt (VMware) 		seq_printf(m, " (%ld)%s%s%s",
37830376bde1SSteven Rostedt (Red Hat) 			   ftrace_rec_count(rec),
3784f8b8be8aSMasami Hiramatsu 			   rec->flags & FTRACE_FL_REGS ? " R" : "  ",
3785763e34e7SSteven Rostedt (VMware) 			   rec->flags & FTRACE_FL_IPMODIFY ? " I" : "  ",
3786763e34e7SSteven Rostedt (VMware) 			   rec->flags & FTRACE_FL_DIRECT ? " D" : "  ");
37879674b2faSSteven Rostedt (Red Hat) 		if (rec->flags & FTRACE_FL_TRAMP_EN) {
37885fecaa04SSteven Rostedt (Red Hat) 			ops = ftrace_find_tramp_ops_any(rec);
378939daa7b9SSteven Rostedt (Red Hat) 			if (ops) {
379039daa7b9SSteven Rostedt (Red Hat) 				do {
379139daa7b9SSteven Rostedt (Red Hat) 					seq_printf(m, "\ttramp: %pS (%pS)",
379239daa7b9SSteven Rostedt (Red Hat) 						   (void *)ops->trampoline,
379339daa7b9SSteven Rostedt (Red Hat) 						   (void *)ops->func);
3794030f4e1cSSteven Rostedt (Red Hat) 					add_trampoline_func(m, ops, rec);
379539daa7b9SSteven Rostedt (Red Hat) 					ops = ftrace_find_tramp_ops_next(rec, ops);
379639daa7b9SSteven Rostedt (Red Hat) 				} while (ops);
379739daa7b9SSteven Rostedt (Red Hat) 			} else
3798fa6f0cc7SRasmus Villemoes 				seq_puts(m, "\ttramp: ERROR!");
3799030f4e1cSSteven Rostedt (Red Hat) 		} else {
3800030f4e1cSSteven Rostedt (Red Hat) 			add_trampoline_func(m, NULL, rec);
38019674b2faSSteven Rostedt (Red Hat) 		}
3802763e34e7SSteven Rostedt (VMware) 		if (rec->flags & FTRACE_FL_DIRECT) {
3803763e34e7SSteven Rostedt (VMware) 			unsigned long direct;
3804763e34e7SSteven Rostedt (VMware) 
3805ff205766SAlexei Starovoitov 			direct = ftrace_find_rec_direct(rec->ip);
3806763e34e7SSteven Rostedt (VMware) 			if (direct)
3807763e34e7SSteven Rostedt (VMware) 				seq_printf(m, "\n\tdirect-->%pS", (void *)direct);
3808763e34e7SSteven Rostedt (VMware) 		}
38099674b2faSSteven Rostedt (Red Hat) 	}
38109674b2faSSteven Rostedt (Red Hat) 
3811fa6f0cc7SRasmus Villemoes 	seq_putc(m, '\n');
38125072c59fSSteven Rostedt 
38135072c59fSSteven Rostedt 	return 0;
38145072c59fSSteven Rostedt }
38155072c59fSSteven Rostedt 
381688e9d34cSJames Morris static const struct seq_operations show_ftrace_seq_ops = {
38175072c59fSSteven Rostedt 	.start = t_start,
38185072c59fSSteven Rostedt 	.next = t_next,
38195072c59fSSteven Rostedt 	.stop = t_stop,
38205072c59fSSteven Rostedt 	.show = t_show,
38215072c59fSSteven Rostedt };
38225072c59fSSteven Rostedt 
3823e309b41dSIngo Molnar static int
38245072c59fSSteven Rostedt ftrace_avail_open(struct inode *inode, struct file *file)
38255072c59fSSteven Rostedt {
38265072c59fSSteven Rostedt 	struct ftrace_iterator *iter;
382717911ff3SSteven Rostedt (VMware) 	int ret;
382817911ff3SSteven Rostedt (VMware) 
382917911ff3SSteven Rostedt (VMware) 	ret = security_locked_down(LOCKDOWN_TRACEFS);
383017911ff3SSteven Rostedt (VMware) 	if (ret)
383117911ff3SSteven Rostedt (VMware) 		return ret;
38325072c59fSSteven Rostedt 
38334eebcc81SSteven Rostedt 	if (unlikely(ftrace_disabled))
38344eebcc81SSteven Rostedt 		return -ENODEV;
38354eebcc81SSteven Rostedt 
383650e18b94SJiri Olsa 	iter = __seq_open_private(file, &show_ftrace_seq_ops, sizeof(*iter));
3837c1bc5919SSteven Rostedt (VMware) 	if (!iter)
3838c1bc5919SSteven Rostedt (VMware) 		return -ENOMEM;
3839c1bc5919SSteven Rostedt (VMware) 
38405072c59fSSteven Rostedt 	iter->pg = ftrace_pages_start;
3841fc13cb0cSSteven Rostedt 	iter->ops = &global_ops;
38425072c59fSSteven Rostedt 
3843c1bc5919SSteven Rostedt (VMware) 	return 0;
38445072c59fSSteven Rostedt }
38455072c59fSSteven Rostedt 
3846647bcd03SSteven Rostedt static int
3847647bcd03SSteven Rostedt ftrace_enabled_open(struct inode *inode, struct file *file)
3848647bcd03SSteven Rostedt {
3849647bcd03SSteven Rostedt 	struct ftrace_iterator *iter;
3850647bcd03SSteven Rostedt 
385117911ff3SSteven Rostedt (VMware) 	/*
385217911ff3SSteven Rostedt (VMware) 	 * This shows us what functions are currently being
385317911ff3SSteven Rostedt (VMware) 	 * traced and by what. Not sure if we want lockdown
385417911ff3SSteven Rostedt (VMware) 	 * to hide such critical information for an admin.
385517911ff3SSteven Rostedt (VMware) 	 * Although, perhaps it can show information we don't
385617911ff3SSteven Rostedt (VMware) 	 * want people to see, but if something is tracing
385717911ff3SSteven Rostedt (VMware) 	 * something, we probably want to know about it.
385817911ff3SSteven Rostedt (VMware) 	 */
385917911ff3SSteven Rostedt (VMware) 
386050e18b94SJiri Olsa 	iter = __seq_open_private(file, &show_ftrace_seq_ops, sizeof(*iter));
3861c1bc5919SSteven Rostedt (VMware) 	if (!iter)
3862c1bc5919SSteven Rostedt (VMware) 		return -ENOMEM;
3863c1bc5919SSteven Rostedt (VMware) 
3864647bcd03SSteven Rostedt 	iter->pg = ftrace_pages_start;
3865647bcd03SSteven Rostedt 	iter->flags = FTRACE_ITER_ENABLED;
3866fc13cb0cSSteven Rostedt 	iter->ops = &global_ops;
3867647bcd03SSteven Rostedt 
3868c1bc5919SSteven Rostedt (VMware) 	return 0;
3869647bcd03SSteven Rostedt }
3870647bcd03SSteven Rostedt 
3871fc13cb0cSSteven Rostedt /**
3872fc13cb0cSSteven Rostedt  * ftrace_regex_open - initialize function tracer filter files
3873fc13cb0cSSteven Rostedt  * @ops: The ftrace_ops that hold the hash filters
3874fc13cb0cSSteven Rostedt  * @flag: The type of filter to process
3875fc13cb0cSSteven Rostedt  * @inode: The inode, usually passed in to your open routine
3876fc13cb0cSSteven Rostedt  * @file: The file, usually passed in to your open routine
3877fc13cb0cSSteven Rostedt  *
3878fc13cb0cSSteven Rostedt  * ftrace_regex_open() initializes the filter files for the
3879fc13cb0cSSteven Rostedt  * @ops. Depending on @flag it may process the filter hash or
3880fc13cb0cSSteven Rostedt  * the notrace hash of @ops. With this called from the open
3881fc13cb0cSSteven Rostedt  * routine, you can use ftrace_filter_write() for the write
3882fc13cb0cSSteven Rostedt  * routine if @flag has FTRACE_ITER_FILTER set, or
3883fc13cb0cSSteven Rostedt  * ftrace_notrace_write() if @flag has FTRACE_ITER_NOTRACE set.
3884098c879eSSteven Rostedt (Red Hat)  * tracing_lseek() should be used as the lseek routine, and
3885fc13cb0cSSteven Rostedt  * release must call ftrace_regex_release().
3886fc13cb0cSSteven Rostedt  */
3887fc13cb0cSSteven Rostedt int
3888f45948e8SSteven Rostedt ftrace_regex_open(struct ftrace_ops *ops, int flag,
38891cf41dd7SSteven Rostedt 		  struct inode *inode, struct file *file)
38905072c59fSSteven Rostedt {
38915072c59fSSteven Rostedt 	struct ftrace_iterator *iter;
3892f45948e8SSteven Rostedt 	struct ftrace_hash *hash;
3893673feb9dSSteven Rostedt (VMware) 	struct list_head *mod_head;
3894673feb9dSSteven Rostedt (VMware) 	struct trace_array *tr = ops->private;
38959ef16693SSteven Rostedt (VMware) 	int ret = -ENOMEM;
38965072c59fSSteven Rostedt 
3897f04f24fbSMasami Hiramatsu 	ftrace_ops_init(ops);
3898f04f24fbSMasami Hiramatsu 
38994eebcc81SSteven Rostedt 	if (unlikely(ftrace_disabled))
39004eebcc81SSteven Rostedt 		return -ENODEV;
39014eebcc81SSteven Rostedt 
39028530dec6SSteven Rostedt (VMware) 	if (tracing_check_open_get_tr(tr))
39039ef16693SSteven Rostedt (VMware) 		return -ENODEV;
39049ef16693SSteven Rostedt (VMware) 
39055072c59fSSteven Rostedt 	iter = kzalloc(sizeof(*iter), GFP_KERNEL);
39065072c59fSSteven Rostedt 	if (!iter)
39079ef16693SSteven Rostedt (VMware) 		goto out;
39085072c59fSSteven Rostedt 
39099ef16693SSteven Rostedt (VMware) 	if (trace_parser_get_init(&iter->parser, FTRACE_BUFF_MAX))
39109ef16693SSteven Rostedt (VMware) 		goto out;
3911689fd8b6S[email protected] 
39123f2367baSMasami Hiramatsu 	iter->ops = ops;
39133f2367baSMasami Hiramatsu 	iter->flags = flag;
39145985ea8bSSteven Rostedt (VMware) 	iter->tr = tr;
39153f2367baSMasami Hiramatsu 
391633b7f99cSSteven Rostedt (Red Hat) 	mutex_lock(&ops->func_hash->regex_lock);
39173f2367baSMasami Hiramatsu 
3918673feb9dSSteven Rostedt (VMware) 	if (flag & FTRACE_ITER_NOTRACE) {
391933b7f99cSSteven Rostedt (Red Hat) 		hash = ops->func_hash->notrace_hash;
39205985ea8bSSteven Rostedt (VMware) 		mod_head = tr ? &tr->mod_notrace : NULL;
3921673feb9dSSteven Rostedt (VMware) 	} else {
392233b7f99cSSteven Rostedt (Red Hat) 		hash = ops->func_hash->filter_hash;
39235985ea8bSSteven Rostedt (VMware) 		mod_head = tr ? &tr->mod_trace : NULL;
3924673feb9dSSteven Rostedt (VMware) 	}
3925f45948e8SSteven Rostedt 
39265985ea8bSSteven Rostedt (VMware) 	iter->mod_list = mod_head;
39275985ea8bSSteven Rostedt (VMware) 
392833dc9b12SSteven Rostedt 	if (file->f_mode & FMODE_WRITE) {
3929ef2fbe16SNamhyung Kim 		const int size_bits = FTRACE_HASH_DEFAULT_BITS;
3930ef2fbe16SNamhyung Kim 
3931673feb9dSSteven Rostedt (VMware) 		if (file->f_flags & O_TRUNC) {
3932ef2fbe16SNamhyung Kim 			iter->hash = alloc_ftrace_hash(size_bits);
3933673feb9dSSteven Rostedt (VMware) 			clear_ftrace_mod_list(mod_head);
3934673feb9dSSteven Rostedt (VMware) 	        } else {
3935ef2fbe16SNamhyung Kim 			iter->hash = alloc_and_copy_ftrace_hash(size_bits, hash);
3936673feb9dSSteven Rostedt (VMware) 		}
3937ef2fbe16SNamhyung Kim 
393833dc9b12SSteven Rostedt 		if (!iter->hash) {
393933dc9b12SSteven Rostedt 			trace_parser_put(&iter->parser);
39403f2367baSMasami Hiramatsu 			goto out_unlock;
394133dc9b12SSteven Rostedt 		}
3942c20489daSSteven Rostedt (VMware) 	} else
3943c20489daSSteven Rostedt (VMware) 		iter->hash = hash;
39441cf41dd7SSteven Rostedt 
39459ef16693SSteven Rostedt (VMware) 	ret = 0;
39469ef16693SSteven Rostedt (VMware) 
39475072c59fSSteven Rostedt 	if (file->f_mode & FMODE_READ) {
39485072c59fSSteven Rostedt 		iter->pg = ftrace_pages_start;
39495072c59fSSteven Rostedt 
39505072c59fSSteven Rostedt 		ret = seq_open(file, &show_ftrace_seq_ops);
39515072c59fSSteven Rostedt 		if (!ret) {
39525072c59fSSteven Rostedt 			struct seq_file *m = file->private_data;
39535072c59fSSteven Rostedt 			m->private = iter;
395479fe249cSLi Zefan 		} else {
395533dc9b12SSteven Rostedt 			/* Failed */
395633dc9b12SSteven Rostedt 			free_ftrace_hash(iter->hash);
395779fe249cSLi Zefan 			trace_parser_put(&iter->parser);
395879fe249cSLi Zefan 		}
39595072c59fSSteven Rostedt 	} else
39605072c59fSSteven Rostedt 		file->private_data = iter;
39613f2367baSMasami Hiramatsu 
39623f2367baSMasami Hiramatsu  out_unlock:
396333b7f99cSSteven Rostedt (Red Hat) 	mutex_unlock(&ops->func_hash->regex_lock);
39645072c59fSSteven Rostedt 
39659ef16693SSteven Rostedt (VMware)  out:
39669ef16693SSteven Rostedt (VMware) 	if (ret) {
39679ef16693SSteven Rostedt (VMware) 		kfree(iter);
39689ef16693SSteven Rostedt (VMware) 		if (tr)
39699ef16693SSteven Rostedt (VMware) 			trace_array_put(tr);
39709ef16693SSteven Rostedt (VMware) 	}
39719ef16693SSteven Rostedt (VMware) 
39725072c59fSSteven Rostedt 	return ret;
39735072c59fSSteven Rostedt }
39745072c59fSSteven Rostedt 
397541c52c0dSSteven Rostedt static int
397641c52c0dSSteven Rostedt ftrace_filter_open(struct inode *inode, struct file *file)
397741c52c0dSSteven Rostedt {
3978e3b3e2e8SSteven Rostedt (Red Hat) 	struct ftrace_ops *ops = inode->i_private;
3979e3b3e2e8SSteven Rostedt (Red Hat) 
398017911ff3SSteven Rostedt (VMware) 	/* Checks for tracefs lockdown */
3981e3b3e2e8SSteven Rostedt (Red Hat) 	return ftrace_regex_open(ops,
3982eee8ded1SSteven Rostedt (VMware) 			FTRACE_ITER_FILTER | FTRACE_ITER_DO_PROBES,
39831cf41dd7SSteven Rostedt 			inode, file);
398441c52c0dSSteven Rostedt }
398541c52c0dSSteven Rostedt 
398641c52c0dSSteven Rostedt static int
398741c52c0dSSteven Rostedt ftrace_notrace_open(struct inode *inode, struct file *file)
398841c52c0dSSteven Rostedt {
3989e3b3e2e8SSteven Rostedt (Red Hat) 	struct ftrace_ops *ops = inode->i_private;
3990e3b3e2e8SSteven Rostedt (Red Hat) 
399117911ff3SSteven Rostedt (VMware) 	/* Checks for tracefs lockdown */
3992e3b3e2e8SSteven Rostedt (Red Hat) 	return ftrace_regex_open(ops, FTRACE_ITER_NOTRACE,
39931cf41dd7SSteven Rostedt 				 inode, file);
399441c52c0dSSteven Rostedt }
399541c52c0dSSteven Rostedt 
39963ba00929SDmitry Safonov /* Type for quick search ftrace basic regexes (globs) from filter_parse_regex */
39973ba00929SDmitry Safonov struct ftrace_glob {
39983ba00929SDmitry Safonov 	char *search;
39993ba00929SDmitry Safonov 	unsigned len;
40003ba00929SDmitry Safonov 	int type;
40013ba00929SDmitry Safonov };
40023ba00929SDmitry Safonov 
40037132e2d6SThiago Jung Bauermann /*
40047132e2d6SThiago Jung Bauermann  * If symbols in an architecture don't correspond exactly to the user-visible
40057132e2d6SThiago Jung Bauermann  * name of what they represent, it is possible to define this function to
40067132e2d6SThiago Jung Bauermann  * perform the necessary adjustments.
40077132e2d6SThiago Jung Bauermann */
40087132e2d6SThiago Jung Bauermann char * __weak arch_ftrace_match_adjust(char *str, const char *search)
40097132e2d6SThiago Jung Bauermann {
40107132e2d6SThiago Jung Bauermann 	return str;
40117132e2d6SThiago Jung Bauermann }
40127132e2d6SThiago Jung Bauermann 
40133ba00929SDmitry Safonov static int ftrace_match(char *str, struct ftrace_glob *g)
40149f4801e3SSteven Rostedt {
40159f4801e3SSteven Rostedt 	int matched = 0;
4016751e9983SLi Zefan 	int slen;
40179f4801e3SSteven Rostedt 
40187132e2d6SThiago Jung Bauermann 	str = arch_ftrace_match_adjust(str, g->search);
40197132e2d6SThiago Jung Bauermann 
40203ba00929SDmitry Safonov 	switch (g->type) {
40219f4801e3SSteven Rostedt 	case MATCH_FULL:
40223ba00929SDmitry Safonov 		if (strcmp(str, g->search) == 0)
40239f4801e3SSteven Rostedt 			matched = 1;
40249f4801e3SSteven Rostedt 		break;
40259f4801e3SSteven Rostedt 	case MATCH_FRONT_ONLY:
40263ba00929SDmitry Safonov 		if (strncmp(str, g->search, g->len) == 0)
40279f4801e3SSteven Rostedt 			matched = 1;
40289f4801e3SSteven Rostedt 		break;
40299f4801e3SSteven Rostedt 	case MATCH_MIDDLE_ONLY:
40303ba00929SDmitry Safonov 		if (strstr(str, g->search))
40319f4801e3SSteven Rostedt 			matched = 1;
40329f4801e3SSteven Rostedt 		break;
40339f4801e3SSteven Rostedt 	case MATCH_END_ONLY:
4034751e9983SLi Zefan 		slen = strlen(str);
40353ba00929SDmitry Safonov 		if (slen >= g->len &&
40363ba00929SDmitry Safonov 		    memcmp(str + slen - g->len, g->search, g->len) == 0)
40379f4801e3SSteven Rostedt 			matched = 1;
40389f4801e3SSteven Rostedt 		break;
403960f1d5e3SMasami Hiramatsu 	case MATCH_GLOB:
404060f1d5e3SMasami Hiramatsu 		if (glob_match(g->search, str))
404160f1d5e3SMasami Hiramatsu 			matched = 1;
404260f1d5e3SMasami Hiramatsu 		break;
40439f4801e3SSteven Rostedt 	}
40449f4801e3SSteven Rostedt 
40459f4801e3SSteven Rostedt 	return matched;
40469f4801e3SSteven Rostedt }
40479f4801e3SSteven Rostedt 
4048b448c4e3SSteven Rostedt static int
4049f0a3b154SDmitry Safonov enter_record(struct ftrace_hash *hash, struct dyn_ftrace *rec, int clear_filter)
405064e7c440SSteven Rostedt {
4051b448c4e3SSteven Rostedt 	struct ftrace_func_entry *entry;
4052b448c4e3SSteven Rostedt 	int ret = 0;
4053b448c4e3SSteven Rostedt 
40541cf41dd7SSteven Rostedt 	entry = ftrace_lookup_ip(hash, rec->ip);
4055f0a3b154SDmitry Safonov 	if (clear_filter) {
4056b448c4e3SSteven Rostedt 		/* Do nothing if it doesn't exist */
4057b448c4e3SSteven Rostedt 		if (!entry)
4058b448c4e3SSteven Rostedt 			return 0;
4059b448c4e3SSteven Rostedt 
406033dc9b12SSteven Rostedt 		free_hash_entry(hash, entry);
4061b448c4e3SSteven Rostedt 	} else {
4062b448c4e3SSteven Rostedt 		/* Do nothing if it exists */
4063b448c4e3SSteven Rostedt 		if (entry)
4064b448c4e3SSteven Rostedt 			return 0;
4065b448c4e3SSteven Rostedt 
4066b448c4e3SSteven Rostedt 		ret = add_hash_entry(hash, rec->ip);
4067b448c4e3SSteven Rostedt 	}
4068b448c4e3SSteven Rostedt 	return ret;
4069996e87beSSteven Rostedt }
4070996e87beSSteven Rostedt 
407164e7c440SSteven Rostedt static int
4072f79b3f33SSteven Rostedt (VMware) add_rec_by_index(struct ftrace_hash *hash, struct ftrace_glob *func_g,
4073f79b3f33SSteven Rostedt (VMware) 		 int clear_filter)
4074f79b3f33SSteven Rostedt (VMware) {
4075f79b3f33SSteven Rostedt (VMware) 	long index = simple_strtoul(func_g->search, NULL, 0);
4076f79b3f33SSteven Rostedt (VMware) 	struct ftrace_page *pg;
4077f79b3f33SSteven Rostedt (VMware) 	struct dyn_ftrace *rec;
4078f79b3f33SSteven Rostedt (VMware) 
4079f79b3f33SSteven Rostedt (VMware) 	/* The index starts at 1 */
4080f79b3f33SSteven Rostedt (VMware) 	if (--index < 0)
4081f79b3f33SSteven Rostedt (VMware) 		return 0;
4082f79b3f33SSteven Rostedt (VMware) 
4083f79b3f33SSteven Rostedt (VMware) 	do_for_each_ftrace_rec(pg, rec) {
4084f79b3f33SSteven Rostedt (VMware) 		if (pg->index <= index) {
4085f79b3f33SSteven Rostedt (VMware) 			index -= pg->index;
4086f79b3f33SSteven Rostedt (VMware) 			/* this is a double loop, break goes to the next page */
4087f79b3f33SSteven Rostedt (VMware) 			break;
4088f79b3f33SSteven Rostedt (VMware) 		}
4089f79b3f33SSteven Rostedt (VMware) 		rec = &pg->records[index];
4090f79b3f33SSteven Rostedt (VMware) 		enter_record(hash, rec, clear_filter);
4091f79b3f33SSteven Rostedt (VMware) 		return 1;
4092f79b3f33SSteven Rostedt (VMware) 	} while_for_each_ftrace_rec();
4093f79b3f33SSteven Rostedt (VMware) 	return 0;
4094f79b3f33SSteven Rostedt (VMware) }
4095f79b3f33SSteven Rostedt (VMware) 
4096b39181f7SSteven Rostedt (Google) #ifdef FTRACE_MCOUNT_MAX_OFFSET
4097b39181f7SSteven Rostedt (Google) static int lookup_ip(unsigned long ip, char **modname, char *str)
4098b39181f7SSteven Rostedt (Google) {
4099b39181f7SSteven Rostedt (Google) 	unsigned long offset;
4100b39181f7SSteven Rostedt (Google) 
4101b39181f7SSteven Rostedt (Google) 	kallsyms_lookup(ip, NULL, &offset, modname, str);
4102b39181f7SSteven Rostedt (Google) 	if (offset > FTRACE_MCOUNT_MAX_OFFSET)
4103b39181f7SSteven Rostedt (Google) 		return -1;
4104b39181f7SSteven Rostedt (Google) 	return 0;
4105b39181f7SSteven Rostedt (Google) }
4106b39181f7SSteven Rostedt (Google) #else
4107b39181f7SSteven Rostedt (Google) static int lookup_ip(unsigned long ip, char **modname, char *str)
4108b39181f7SSteven Rostedt (Google) {
4109b39181f7SSteven Rostedt (Google) 	kallsyms_lookup(ip, NULL, NULL, modname, str);
4110b39181f7SSteven Rostedt (Google) 	return 0;
4111b39181f7SSteven Rostedt (Google) }
4112b39181f7SSteven Rostedt (Google) #endif
4113b39181f7SSteven Rostedt (Google) 
4114f79b3f33SSteven Rostedt (VMware) static int
41150b507e1eSDmitry Safonov ftrace_match_record(struct dyn_ftrace *rec, struct ftrace_glob *func_g,
41160b507e1eSDmitry Safonov 		struct ftrace_glob *mod_g, int exclude_mod)
411764e7c440SSteven Rostedt {
411864e7c440SSteven Rostedt 	char str[KSYM_SYMBOL_LEN];
4119b9df92d2SSteven Rostedt 	char *modname;
412064e7c440SSteven Rostedt 
4121b39181f7SSteven Rostedt (Google) 	if (lookup_ip(rec->ip, &modname, str)) {
4122b39181f7SSteven Rostedt (Google) 		/* This should only happen when a rec is disabled */
4123b39181f7SSteven Rostedt (Google) 		WARN_ON_ONCE(system_state == SYSTEM_RUNNING &&
4124b39181f7SSteven Rostedt (Google) 			     !(rec->flags & FTRACE_FL_DISABLED));
4125b39181f7SSteven Rostedt (Google) 		return 0;
4126b39181f7SSteven Rostedt (Google) 	}
4127b9df92d2SSteven Rostedt 
41280b507e1eSDmitry Safonov 	if (mod_g) {
41290b507e1eSDmitry Safonov 		int mod_matches = (modname) ? ftrace_match(modname, mod_g) : 0;
41300b507e1eSDmitry Safonov 
41310b507e1eSDmitry Safonov 		/* blank module name to match all modules */
41320b507e1eSDmitry Safonov 		if (!mod_g->len) {
41330b507e1eSDmitry Safonov 			/* blank module globbing: modname xor exclude_mod */
413477c0eddeSSteven Rostedt (VMware) 			if (!exclude_mod != !modname)
41350b507e1eSDmitry Safonov 				goto func_match;
41360b507e1eSDmitry Safonov 			return 0;
41370b507e1eSDmitry Safonov 		}
41380b507e1eSDmitry Safonov 
413977c0eddeSSteven Rostedt (VMware) 		/*
414077c0eddeSSteven Rostedt (VMware) 		 * exclude_mod is set to trace everything but the given
414177c0eddeSSteven Rostedt (VMware) 		 * module. If it is set and the module matches, then
414277c0eddeSSteven Rostedt (VMware) 		 * return 0. If it is not set, and the module doesn't match
414377c0eddeSSteven Rostedt (VMware) 		 * also return 0. Otherwise, check the function to see if
414477c0eddeSSteven Rostedt (VMware) 		 * that matches.
414577c0eddeSSteven Rostedt (VMware) 		 */
414677c0eddeSSteven Rostedt (VMware) 		if (!mod_matches == !exclude_mod)
41470b507e1eSDmitry Safonov 			return 0;
41480b507e1eSDmitry Safonov func_match:
4149b9df92d2SSteven Rostedt 		/* blank search means to match all funcs in the mod */
41503ba00929SDmitry Safonov 		if (!func_g->len)
4151b9df92d2SSteven Rostedt 			return 1;
4152b9df92d2SSteven Rostedt 	}
4153b9df92d2SSteven Rostedt 
41543ba00929SDmitry Safonov 	return ftrace_match(str, func_g);
415564e7c440SSteven Rostedt }
415664e7c440SSteven Rostedt 
41571cf41dd7SSteven Rostedt static int
41583ba00929SDmitry Safonov match_records(struct ftrace_hash *hash, char *func, int len, char *mod)
41599f4801e3SSteven Rostedt {
41609f4801e3SSteven Rostedt 	struct ftrace_page *pg;
41619f4801e3SSteven Rostedt 	struct dyn_ftrace *rec;
41623ba00929SDmitry Safonov 	struct ftrace_glob func_g = { .type = MATCH_FULL };
41630b507e1eSDmitry Safonov 	struct ftrace_glob mod_g = { .type = MATCH_FULL };
41640b507e1eSDmitry Safonov 	struct ftrace_glob *mod_match = (mod) ? &mod_g : NULL;
41650b507e1eSDmitry Safonov 	int exclude_mod = 0;
4166311d16daSLi Zefan 	int found = 0;
4167b448c4e3SSteven Rostedt 	int ret;
41682e028c4fSDan Carpenter 	int clear_filter = 0;
41699f4801e3SSteven Rostedt 
41700b507e1eSDmitry Safonov 	if (func) {
41713ba00929SDmitry Safonov 		func_g.type = filter_parse_regex(func, len, &func_g.search,
41723ba00929SDmitry Safonov 						 &clear_filter);
41733ba00929SDmitry Safonov 		func_g.len = strlen(func_g.search);
4174b9df92d2SSteven Rostedt 	}
4175b9df92d2SSteven Rostedt 
41760b507e1eSDmitry Safonov 	if (mod) {
41770b507e1eSDmitry Safonov 		mod_g.type = filter_parse_regex(mod, strlen(mod),
41780b507e1eSDmitry Safonov 				&mod_g.search, &exclude_mod);
41790b507e1eSDmitry Safonov 		mod_g.len = strlen(mod_g.search);
4180b9df92d2SSteven Rostedt 	}
4181b9df92d2SSteven Rostedt 
418252baf119SSteven Rostedt 	mutex_lock(&ftrace_lock);
4183b9df92d2SSteven Rostedt 
4184b9df92d2SSteven Rostedt 	if (unlikely(ftrace_disabled))
4185b9df92d2SSteven Rostedt 		goto out_unlock;
4186b9df92d2SSteven Rostedt 
4187f79b3f33SSteven Rostedt (VMware) 	if (func_g.type == MATCH_INDEX) {
4188f79b3f33SSteven Rostedt (VMware) 		found = add_rec_by_index(hash, &func_g, clear_filter);
4189f79b3f33SSteven Rostedt (VMware) 		goto out_unlock;
4190f79b3f33SSteven Rostedt (VMware) 	}
4191f79b3f33SSteven Rostedt (VMware) 
4192265c831cSSteven Rostedt 	do_for_each_ftrace_rec(pg, rec) {
4193546fece4SSteven Rostedt (Red Hat) 
4194546fece4SSteven Rostedt (Red Hat) 		if (rec->flags & FTRACE_FL_DISABLED)
4195546fece4SSteven Rostedt (Red Hat) 			continue;
4196546fece4SSteven Rostedt (Red Hat) 
41970b507e1eSDmitry Safonov 		if (ftrace_match_record(rec, &func_g, mod_match, exclude_mod)) {
4198f0a3b154SDmitry Safonov 			ret = enter_record(hash, rec, clear_filter);
4199b448c4e3SSteven Rostedt 			if (ret < 0) {
4200b448c4e3SSteven Rostedt 				found = ret;
4201b448c4e3SSteven Rostedt 				goto out_unlock;
4202b448c4e3SSteven Rostedt 			}
4203311d16daSLi Zefan 			found = 1;
42045072c59fSSteven Rostedt 		}
4205265c831cSSteven Rostedt 	} while_for_each_ftrace_rec();
4206b9df92d2SSteven Rostedt  out_unlock:
420752baf119SSteven Rostedt 	mutex_unlock(&ftrace_lock);
4208311d16daSLi Zefan 
4209311d16daSLi Zefan 	return found;
42105072c59fSSteven Rostedt }
42115072c59fSSteven Rostedt 
421264e7c440SSteven Rostedt static int
42131cf41dd7SSteven Rostedt ftrace_match_records(struct ftrace_hash *hash, char *buff, int len)
421464e7c440SSteven Rostedt {
4215f0a3b154SDmitry Safonov 	return match_records(hash, buff, len, NULL);
421664e7c440SSteven Rostedt }
421764e7c440SSteven Rostedt 
4218e16b35ddSSteven Rostedt (VMware) static void ftrace_ops_update_code(struct ftrace_ops *ops,
4219e16b35ddSSteven Rostedt (VMware) 				   struct ftrace_ops_hash *old_hash)
4220e16b35ddSSteven Rostedt (VMware) {
4221e16b35ddSSteven Rostedt (VMware) 	struct ftrace_ops *op;
4222e16b35ddSSteven Rostedt (VMware) 
4223e16b35ddSSteven Rostedt (VMware) 	if (!ftrace_enabled)
4224e16b35ddSSteven Rostedt (VMware) 		return;
4225e16b35ddSSteven Rostedt (VMware) 
4226e16b35ddSSteven Rostedt (VMware) 	if (ops->flags & FTRACE_OPS_FL_ENABLED) {
4227e16b35ddSSteven Rostedt (VMware) 		ftrace_run_modify_code(ops, FTRACE_UPDATE_CALLS, old_hash);
4228e16b35ddSSteven Rostedt (VMware) 		return;
4229e16b35ddSSteven Rostedt (VMware) 	}
4230e16b35ddSSteven Rostedt (VMware) 
4231e16b35ddSSteven Rostedt (VMware) 	/*
4232e16b35ddSSteven Rostedt (VMware) 	 * If this is the shared global_ops filter, then we need to
4233e16b35ddSSteven Rostedt (VMware) 	 * check if there is another ops that shares it, is enabled.
4234e16b35ddSSteven Rostedt (VMware) 	 * If so, we still need to run the modify code.
4235e16b35ddSSteven Rostedt (VMware) 	 */
4236e16b35ddSSteven Rostedt (VMware) 	if (ops->func_hash != &global_ops.local_hash)
4237e16b35ddSSteven Rostedt (VMware) 		return;
4238e16b35ddSSteven Rostedt (VMware) 
4239e16b35ddSSteven Rostedt (VMware) 	do_for_each_ftrace_op(op, ftrace_ops_list) {
4240e16b35ddSSteven Rostedt (VMware) 		if (op->func_hash == &global_ops.local_hash &&
4241e16b35ddSSteven Rostedt (VMware) 		    op->flags & FTRACE_OPS_FL_ENABLED) {
4242e16b35ddSSteven Rostedt (VMware) 			ftrace_run_modify_code(op, FTRACE_UPDATE_CALLS, old_hash);
4243e16b35ddSSteven Rostedt (VMware) 			/* Only need to do this once */
4244e16b35ddSSteven Rostedt (VMware) 			return;
4245e16b35ddSSteven Rostedt (VMware) 		}
4246e16b35ddSSteven Rostedt (VMware) 	} while_for_each_ftrace_op(op);
4247e16b35ddSSteven Rostedt (VMware) }
4248e16b35ddSSteven Rostedt (VMware) 
4249e16b35ddSSteven Rostedt (VMware) static int ftrace_hash_move_and_update_ops(struct ftrace_ops *ops,
4250e16b35ddSSteven Rostedt (VMware) 					   struct ftrace_hash **orig_hash,
4251e16b35ddSSteven Rostedt (VMware) 					   struct ftrace_hash *hash,
4252e16b35ddSSteven Rostedt (VMware) 					   int enable)
4253e16b35ddSSteven Rostedt (VMware) {
4254e16b35ddSSteven Rostedt (VMware) 	struct ftrace_ops_hash old_hash_ops;
4255e16b35ddSSteven Rostedt (VMware) 	struct ftrace_hash *old_hash;
4256e16b35ddSSteven Rostedt (VMware) 	int ret;
4257e16b35ddSSteven Rostedt (VMware) 
4258e16b35ddSSteven Rostedt (VMware) 	old_hash = *orig_hash;
4259e16b35ddSSteven Rostedt (VMware) 	old_hash_ops.filter_hash = ops->func_hash->filter_hash;
4260e16b35ddSSteven Rostedt (VMware) 	old_hash_ops.notrace_hash = ops->func_hash->notrace_hash;
4261e16b35ddSSteven Rostedt (VMware) 	ret = ftrace_hash_move(ops, enable, orig_hash, hash);
4262e16b35ddSSteven Rostedt (VMware) 	if (!ret) {
4263e16b35ddSSteven Rostedt (VMware) 		ftrace_ops_update_code(ops, &old_hash_ops);
4264e16b35ddSSteven Rostedt (VMware) 		free_ftrace_hash_rcu(old_hash);
4265e16b35ddSSteven Rostedt (VMware) 	}
4266e16b35ddSSteven Rostedt (VMware) 	return ret;
4267e16b35ddSSteven Rostedt (VMware) }
426864e7c440SSteven Rostedt 
4269673feb9dSSteven Rostedt (VMware) static bool module_exists(const char *module)
4270673feb9dSSteven Rostedt (VMware) {
4271673feb9dSSteven Rostedt (VMware) 	/* All modules have the symbol __this_module */
42720f5e5a3aSRasmus Villemoes 	static const char this_mod[] = "__this_module";
4273419e9fe5SSalvatore Mesoraca 	char modname[MAX_PARAM_PREFIX_LEN + sizeof(this_mod) + 2];
4274673feb9dSSteven Rostedt (VMware) 	unsigned long val;
4275673feb9dSSteven Rostedt (VMware) 	int n;
4276673feb9dSSteven Rostedt (VMware) 
4277419e9fe5SSalvatore Mesoraca 	n = snprintf(modname, sizeof(modname), "%s:%s", module, this_mod);
4278673feb9dSSteven Rostedt (VMware) 
4279419e9fe5SSalvatore Mesoraca 	if (n > sizeof(modname) - 1)
4280673feb9dSSteven Rostedt (VMware) 		return false;
4281673feb9dSSteven Rostedt (VMware) 
4282673feb9dSSteven Rostedt (VMware) 	val = module_kallsyms_lookup_name(modname);
4283673feb9dSSteven Rostedt (VMware) 	return val != 0;
4284673feb9dSSteven Rostedt (VMware) }
4285673feb9dSSteven Rostedt (VMware) 
4286673feb9dSSteven Rostedt (VMware) static int cache_mod(struct trace_array *tr,
4287673feb9dSSteven Rostedt (VMware) 		     const char *func, char *module, int enable)
4288673feb9dSSteven Rostedt (VMware) {
4289673feb9dSSteven Rostedt (VMware) 	struct ftrace_mod_load *ftrace_mod, *n;
4290673feb9dSSteven Rostedt (VMware) 	struct list_head *head = enable ? &tr->mod_trace : &tr->mod_notrace;
4291673feb9dSSteven Rostedt (VMware) 	int ret;
4292673feb9dSSteven Rostedt (VMware) 
4293673feb9dSSteven Rostedt (VMware) 	mutex_lock(&ftrace_lock);
4294673feb9dSSteven Rostedt (VMware) 
4295673feb9dSSteven Rostedt (VMware) 	/* We do not cache inverse filters */
4296673feb9dSSteven Rostedt (VMware) 	if (func[0] == '!') {
4297673feb9dSSteven Rostedt (VMware) 		func++;
4298673feb9dSSteven Rostedt (VMware) 		ret = -EINVAL;
4299673feb9dSSteven Rostedt (VMware) 
4300673feb9dSSteven Rostedt (VMware) 		/* Look to remove this hash */
4301673feb9dSSteven Rostedt (VMware) 		list_for_each_entry_safe(ftrace_mod, n, head, list) {
4302673feb9dSSteven Rostedt (VMware) 			if (strcmp(ftrace_mod->module, module) != 0)
4303673feb9dSSteven Rostedt (VMware) 				continue;
4304673feb9dSSteven Rostedt (VMware) 
4305673feb9dSSteven Rostedt (VMware) 			/* no func matches all */
430644925dffSDan Carpenter 			if (strcmp(func, "*") == 0 ||
4307673feb9dSSteven Rostedt (VMware) 			    (ftrace_mod->func &&
4308673feb9dSSteven Rostedt (VMware) 			     strcmp(ftrace_mod->func, func) == 0)) {
4309673feb9dSSteven Rostedt (VMware) 				ret = 0;
4310673feb9dSSteven Rostedt (VMware) 				free_ftrace_mod(ftrace_mod);
4311673feb9dSSteven Rostedt (VMware) 				continue;
4312673feb9dSSteven Rostedt (VMware) 			}
4313673feb9dSSteven Rostedt (VMware) 		}
4314673feb9dSSteven Rostedt (VMware) 		goto out;
4315673feb9dSSteven Rostedt (VMware) 	}
4316673feb9dSSteven Rostedt (VMware) 
4317673feb9dSSteven Rostedt (VMware) 	ret = -EINVAL;
4318673feb9dSSteven Rostedt (VMware) 	/* We only care about modules that have not been loaded yet */
4319673feb9dSSteven Rostedt (VMware) 	if (module_exists(module))
4320673feb9dSSteven Rostedt (VMware) 		goto out;
4321673feb9dSSteven Rostedt (VMware) 
4322673feb9dSSteven Rostedt (VMware) 	/* Save this string off, and execute it when the module is loaded */
4323673feb9dSSteven Rostedt (VMware) 	ret = ftrace_add_mod(tr, func, module, enable);
4324673feb9dSSteven Rostedt (VMware)  out:
4325673feb9dSSteven Rostedt (VMware) 	mutex_unlock(&ftrace_lock);
4326673feb9dSSteven Rostedt (VMware) 
4327673feb9dSSteven Rostedt (VMware) 	return ret;
4328673feb9dSSteven Rostedt (VMware) }
4329673feb9dSSteven Rostedt (VMware) 
4330d7fbf8dfSSteven Rostedt (VMware) static int
4331d7fbf8dfSSteven Rostedt (VMware) ftrace_set_regex(struct ftrace_ops *ops, unsigned char *buf, int len,
4332d7fbf8dfSSteven Rostedt (VMware) 		 int reset, int enable);
4333d7fbf8dfSSteven Rostedt (VMware) 
433469449bbdSArnd Bergmann #ifdef CONFIG_MODULES
4335d7fbf8dfSSteven Rostedt (VMware) static void process_mod_list(struct list_head *head, struct ftrace_ops *ops,
4336d7fbf8dfSSteven Rostedt (VMware) 			     char *mod, bool enable)
4337d7fbf8dfSSteven Rostedt (VMware) {
4338d7fbf8dfSSteven Rostedt (VMware) 	struct ftrace_mod_load *ftrace_mod, *n;
4339d7fbf8dfSSteven Rostedt (VMware) 	struct ftrace_hash **orig_hash, *new_hash;
4340d7fbf8dfSSteven Rostedt (VMware) 	LIST_HEAD(process_mods);
4341d7fbf8dfSSteven Rostedt (VMware) 	char *func;
4342d7fbf8dfSSteven Rostedt (VMware) 
4343d7fbf8dfSSteven Rostedt (VMware) 	mutex_lock(&ops->func_hash->regex_lock);
4344d7fbf8dfSSteven Rostedt (VMware) 
4345d7fbf8dfSSteven Rostedt (VMware) 	if (enable)
4346d7fbf8dfSSteven Rostedt (VMware) 		orig_hash = &ops->func_hash->filter_hash;
4347d7fbf8dfSSteven Rostedt (VMware) 	else
4348d7fbf8dfSSteven Rostedt (VMware) 		orig_hash = &ops->func_hash->notrace_hash;
4349d7fbf8dfSSteven Rostedt (VMware) 
4350d7fbf8dfSSteven Rostedt (VMware) 	new_hash = alloc_and_copy_ftrace_hash(FTRACE_HASH_DEFAULT_BITS,
4351d7fbf8dfSSteven Rostedt (VMware) 					      *orig_hash);
4352d7fbf8dfSSteven Rostedt (VMware) 	if (!new_hash)
43533b58a3c7SSteven Rostedt (VMware) 		goto out; /* warn? */
4354d7fbf8dfSSteven Rostedt (VMware) 
4355d7fbf8dfSSteven Rostedt (VMware) 	mutex_lock(&ftrace_lock);
4356d7fbf8dfSSteven Rostedt (VMware) 
4357d7fbf8dfSSteven Rostedt (VMware) 	list_for_each_entry_safe(ftrace_mod, n, head, list) {
4358d7fbf8dfSSteven Rostedt (VMware) 
4359d7fbf8dfSSteven Rostedt (VMware) 		if (strcmp(ftrace_mod->module, mod) != 0)
4360d7fbf8dfSSteven Rostedt (VMware) 			continue;
4361d7fbf8dfSSteven Rostedt (VMware) 
4362d7fbf8dfSSteven Rostedt (VMware) 		if (ftrace_mod->func)
4363d7fbf8dfSSteven Rostedt (VMware) 			func = kstrdup(ftrace_mod->func, GFP_KERNEL);
4364d7fbf8dfSSteven Rostedt (VMware) 		else
4365d7fbf8dfSSteven Rostedt (VMware) 			func = kstrdup("*", GFP_KERNEL);
4366d7fbf8dfSSteven Rostedt (VMware) 
4367d7fbf8dfSSteven Rostedt (VMware) 		if (!func) /* warn? */
4368d7fbf8dfSSteven Rostedt (VMware) 			continue;
4369d7fbf8dfSSteven Rostedt (VMware) 
43703ecda644SBaokun Li 		list_move(&ftrace_mod->list, &process_mods);
4371d7fbf8dfSSteven Rostedt (VMware) 
4372d7fbf8dfSSteven Rostedt (VMware) 		/* Use the newly allocated func, as it may be "*" */
4373d7fbf8dfSSteven Rostedt (VMware) 		kfree(ftrace_mod->func);
4374d7fbf8dfSSteven Rostedt (VMware) 		ftrace_mod->func = func;
4375d7fbf8dfSSteven Rostedt (VMware) 	}
4376d7fbf8dfSSteven Rostedt (VMware) 
4377d7fbf8dfSSteven Rostedt (VMware) 	mutex_unlock(&ftrace_lock);
4378d7fbf8dfSSteven Rostedt (VMware) 
4379d7fbf8dfSSteven Rostedt (VMware) 	list_for_each_entry_safe(ftrace_mod, n, &process_mods, list) {
4380d7fbf8dfSSteven Rostedt (VMware) 
4381d7fbf8dfSSteven Rostedt (VMware) 		func = ftrace_mod->func;
4382d7fbf8dfSSteven Rostedt (VMware) 
4383d7fbf8dfSSteven Rostedt (VMware) 		/* Grabs ftrace_lock, which is why we have this extra step */
4384d7fbf8dfSSteven Rostedt (VMware) 		match_records(new_hash, func, strlen(func), mod);
4385d7fbf8dfSSteven Rostedt (VMware) 		free_ftrace_mod(ftrace_mod);
4386d7fbf8dfSSteven Rostedt (VMware) 	}
4387d7fbf8dfSSteven Rostedt (VMware) 
43888c08f0d5SSteven Rostedt (VMware) 	if (enable && list_empty(head))
43898c08f0d5SSteven Rostedt (VMware) 		new_hash->flags &= ~FTRACE_HASH_FL_MOD;
43908c08f0d5SSteven Rostedt (VMware) 
4391d7fbf8dfSSteven Rostedt (VMware) 	mutex_lock(&ftrace_lock);
4392d7fbf8dfSSteven Rostedt (VMware) 
4393045e269cSAlex Shi 	ftrace_hash_move_and_update_ops(ops, orig_hash,
4394d7fbf8dfSSteven Rostedt (VMware) 					      new_hash, enable);
4395d7fbf8dfSSteven Rostedt (VMware) 	mutex_unlock(&ftrace_lock);
4396d7fbf8dfSSteven Rostedt (VMware) 
43973b58a3c7SSteven Rostedt (VMware)  out:
4398d7fbf8dfSSteven Rostedt (VMware) 	mutex_unlock(&ops->func_hash->regex_lock);
4399d7fbf8dfSSteven Rostedt (VMware) 
4400d7fbf8dfSSteven Rostedt (VMware) 	free_ftrace_hash(new_hash);
4401d7fbf8dfSSteven Rostedt (VMware) }
4402d7fbf8dfSSteven Rostedt (VMware) 
4403d7fbf8dfSSteven Rostedt (VMware) static void process_cached_mods(const char *mod_name)
4404d7fbf8dfSSteven Rostedt (VMware) {
4405d7fbf8dfSSteven Rostedt (VMware) 	struct trace_array *tr;
4406d7fbf8dfSSteven Rostedt (VMware) 	char *mod;
4407d7fbf8dfSSteven Rostedt (VMware) 
4408d7fbf8dfSSteven Rostedt (VMware) 	mod = kstrdup(mod_name, GFP_KERNEL);
4409d7fbf8dfSSteven Rostedt (VMware) 	if (!mod)
4410d7fbf8dfSSteven Rostedt (VMware) 		return;
4411d7fbf8dfSSteven Rostedt (VMware) 
4412d7fbf8dfSSteven Rostedt (VMware) 	mutex_lock(&trace_types_lock);
4413d7fbf8dfSSteven Rostedt (VMware) 	list_for_each_entry(tr, &ftrace_trace_arrays, list) {
4414d7fbf8dfSSteven Rostedt (VMware) 		if (!list_empty(&tr->mod_trace))
4415d7fbf8dfSSteven Rostedt (VMware) 			process_mod_list(&tr->mod_trace, tr->ops, mod, true);
4416d7fbf8dfSSteven Rostedt (VMware) 		if (!list_empty(&tr->mod_notrace))
4417d7fbf8dfSSteven Rostedt (VMware) 			process_mod_list(&tr->mod_notrace, tr->ops, mod, false);
4418d7fbf8dfSSteven Rostedt (VMware) 	}
4419d7fbf8dfSSteven Rostedt (VMware) 	mutex_unlock(&trace_types_lock);
4420d7fbf8dfSSteven Rostedt (VMware) 
4421d7fbf8dfSSteven Rostedt (VMware) 	kfree(mod);
4422d7fbf8dfSSteven Rostedt (VMware) }
442369449bbdSArnd Bergmann #endif
4424d7fbf8dfSSteven Rostedt (VMware) 
4425f6180773SSteven Rostedt /*
4426f6180773SSteven Rostedt  * We register the module command as a template to show others how
4427f6180773SSteven Rostedt  * to register the a command as well.
4428f6180773SSteven Rostedt  */
4429f6180773SSteven Rostedt 
4430f6180773SSteven Rostedt static int
443104ec7bb6SSteven Rostedt (VMware) ftrace_mod_callback(struct trace_array *tr, struct ftrace_hash *hash,
4432673feb9dSSteven Rostedt (VMware) 		    char *func_orig, char *cmd, char *module, int enable)
4433f6180773SSteven Rostedt {
4434673feb9dSSteven Rostedt (VMware) 	char *func;
44355e3949f0SDmitry Safonov 	int ret;
4436f6180773SSteven Rostedt 
4437673feb9dSSteven Rostedt (VMware) 	/* match_records() modifies func, and we need the original */
4438673feb9dSSteven Rostedt (VMware) 	func = kstrdup(func_orig, GFP_KERNEL);
4439673feb9dSSteven Rostedt (VMware) 	if (!func)
4440673feb9dSSteven Rostedt (VMware) 		return -ENOMEM;
4441673feb9dSSteven Rostedt (VMware) 
4442f6180773SSteven Rostedt 	/*
4443f6180773SSteven Rostedt 	 * cmd == 'mod' because we only registered this func
4444f6180773SSteven Rostedt 	 * for the 'mod' ftrace_func_command.
4445f6180773SSteven Rostedt 	 * But if you register one func with multiple commands,
4446f6180773SSteven Rostedt 	 * you can tell which command was used by the cmd
4447f6180773SSteven Rostedt 	 * parameter.
4448f6180773SSteven Rostedt 	 */
4449f0a3b154SDmitry Safonov 	ret = match_records(hash, func, strlen(func), module);
4450673feb9dSSteven Rostedt (VMware) 	kfree(func);
4451673feb9dSSteven Rostedt (VMware) 
4452b448c4e3SSteven Rostedt 	if (!ret)
4453673feb9dSSteven Rostedt (VMware) 		return cache_mod(tr, func_orig, module, enable);
4454b448c4e3SSteven Rostedt 	if (ret < 0)
4455b448c4e3SSteven Rostedt 		return ret;
4456f6180773SSteven Rostedt 	return 0;
4457f6180773SSteven Rostedt }
4458f6180773SSteven Rostedt 
4459f6180773SSteven Rostedt static struct ftrace_func_command ftrace_mod_cmd = {
4460f6180773SSteven Rostedt 	.name			= "mod",
4461f6180773SSteven Rostedt 	.func			= ftrace_mod_callback,
4462f6180773SSteven Rostedt };
4463f6180773SSteven Rostedt 
4464f6180773SSteven Rostedt static int __init ftrace_mod_cmd_init(void)
4465f6180773SSteven Rostedt {
4466f6180773SSteven Rostedt 	return register_ftrace_command(&ftrace_mod_cmd);
4467f6180773SSteven Rostedt }
44686f415672SSteven Rostedt core_initcall(ftrace_mod_cmd_init);
4469f6180773SSteven Rostedt 
44702f5f6ad9SSteven Rostedt static void function_trace_probe_call(unsigned long ip, unsigned long parent_ip,
4471d19ad077SSteven Rostedt (VMware) 				      struct ftrace_ops *op, struct ftrace_regs *fregs)
447259df055fSSteven Rostedt {
4473eee8ded1SSteven Rostedt (VMware) 	struct ftrace_probe_ops *probe_ops;
44747b60f3d8SSteven Rostedt (VMware) 	struct ftrace_func_probe *probe;
447559df055fSSteven Rostedt 
44767b60f3d8SSteven Rostedt (VMware) 	probe = container_of(op, struct ftrace_func_probe, ops);
44777b60f3d8SSteven Rostedt (VMware) 	probe_ops = probe->probe_ops;
447859df055fSSteven Rostedt 
447959df055fSSteven Rostedt 	/*
448059df055fSSteven Rostedt 	 * Disable preemption for these calls to prevent a RCU grace
448159df055fSSteven Rostedt 	 * period. This syncs the hash iteration and freeing of items
448259df055fSSteven Rostedt 	 * on the hash. rcu_read_lock is too dangerous here.
448359df055fSSteven Rostedt 	 */
44845168ae50SSteven Rostedt 	preempt_disable_notrace();
44856e444319SSteven Rostedt (VMware) 	probe_ops->func(ip, parent_ip, probe->tr, probe_ops, probe->data);
44865168ae50SSteven Rostedt 	preempt_enable_notrace();
448759df055fSSteven Rostedt }
448859df055fSSteven Rostedt 
448941794f19SSteven Rostedt (VMware) struct ftrace_func_map {
449041794f19SSteven Rostedt (VMware) 	struct ftrace_func_entry	entry;
449141794f19SSteven Rostedt (VMware) 	void				*data;
449259df055fSSteven Rostedt };
449359df055fSSteven Rostedt 
449441794f19SSteven Rostedt (VMware) struct ftrace_func_mapper {
449541794f19SSteven Rostedt (VMware) 	struct ftrace_hash		hash;
449641794f19SSteven Rostedt (VMware) };
449759df055fSSteven Rostedt 
449841794f19SSteven Rostedt (VMware) /**
449941794f19SSteven Rostedt (VMware)  * allocate_ftrace_func_mapper - allocate a new ftrace_func_mapper
450041794f19SSteven Rostedt (VMware)  *
450141794f19SSteven Rostedt (VMware)  * Returns a ftrace_func_mapper descriptor that can be used to map ips to data.
450241794f19SSteven Rostedt (VMware)  */
450341794f19SSteven Rostedt (VMware) struct ftrace_func_mapper *allocate_ftrace_func_mapper(void)
450459df055fSSteven Rostedt {
4505e1df4cb6SSteven Rostedt (Red Hat) 	struct ftrace_hash *hash;
450659df055fSSteven Rostedt 
450741794f19SSteven Rostedt (VMware) 	/*
450841794f19SSteven Rostedt (VMware) 	 * The mapper is simply a ftrace_hash, but since the entries
450941794f19SSteven Rostedt (VMware) 	 * in the hash are not ftrace_func_entry type, we define it
451041794f19SSteven Rostedt (VMware) 	 * as a separate structure.
451141794f19SSteven Rostedt (VMware) 	 */
451241794f19SSteven Rostedt (VMware) 	hash = alloc_ftrace_hash(FTRACE_HASH_DEFAULT_BITS);
451341794f19SSteven Rostedt (VMware) 	return (struct ftrace_func_mapper *)hash;
4514e1df4cb6SSteven Rostedt (Red Hat) }
4515e1df4cb6SSteven Rostedt (Red Hat) 
451641794f19SSteven Rostedt (VMware) /**
451741794f19SSteven Rostedt (VMware)  * ftrace_func_mapper_find_ip - Find some data mapped to an ip
451841794f19SSteven Rostedt (VMware)  * @mapper: The mapper that has the ip maps
451941794f19SSteven Rostedt (VMware)  * @ip: the instruction pointer to find the data for
452041794f19SSteven Rostedt (VMware)  *
452141794f19SSteven Rostedt (VMware)  * Returns the data mapped to @ip if found otherwise NULL. The return
452241794f19SSteven Rostedt (VMware)  * is actually the address of the mapper data pointer. The address is
452341794f19SSteven Rostedt (VMware)  * returned for use cases where the data is no bigger than a long, and
452441794f19SSteven Rostedt (VMware)  * the user can use the data pointer as its data instead of having to
452541794f19SSteven Rostedt (VMware)  * allocate more memory for the reference.
452641794f19SSteven Rostedt (VMware)  */
452741794f19SSteven Rostedt (VMware) void **ftrace_func_mapper_find_ip(struct ftrace_func_mapper *mapper,
452841794f19SSteven Rostedt (VMware) 				  unsigned long ip)
452941794f19SSteven Rostedt (VMware) {
453041794f19SSteven Rostedt (VMware) 	struct ftrace_func_entry *entry;
453141794f19SSteven Rostedt (VMware) 	struct ftrace_func_map *map;
453241794f19SSteven Rostedt (VMware) 
453341794f19SSteven Rostedt (VMware) 	entry = ftrace_lookup_ip(&mapper->hash, ip);
453441794f19SSteven Rostedt (VMware) 	if (!entry)
453541794f19SSteven Rostedt (VMware) 		return NULL;
453641794f19SSteven Rostedt (VMware) 
453741794f19SSteven Rostedt (VMware) 	map = (struct ftrace_func_map *)entry;
453841794f19SSteven Rostedt (VMware) 	return &map->data;
4539e1df4cb6SSteven Rostedt (Red Hat) }
454045a4a237SSteven Rostedt 
454141794f19SSteven Rostedt (VMware) /**
454241794f19SSteven Rostedt (VMware)  * ftrace_func_mapper_add_ip - Map some data to an ip
454341794f19SSteven Rostedt (VMware)  * @mapper: The mapper that has the ip maps
454441794f19SSteven Rostedt (VMware)  * @ip: The instruction pointer address to map @data to
454541794f19SSteven Rostedt (VMware)  * @data: The data to map to @ip
454641794f19SSteven Rostedt (VMware)  *
4547fdda88d3SQiujun Huang  * Returns 0 on success otherwise an error.
454841794f19SSteven Rostedt (VMware)  */
454941794f19SSteven Rostedt (VMware) int ftrace_func_mapper_add_ip(struct ftrace_func_mapper *mapper,
455041794f19SSteven Rostedt (VMware) 			      unsigned long ip, void *data)
455141794f19SSteven Rostedt (VMware) {
455241794f19SSteven Rostedt (VMware) 	struct ftrace_func_entry *entry;
455341794f19SSteven Rostedt (VMware) 	struct ftrace_func_map *map;
455441794f19SSteven Rostedt (VMware) 
455541794f19SSteven Rostedt (VMware) 	entry = ftrace_lookup_ip(&mapper->hash, ip);
455641794f19SSteven Rostedt (VMware) 	if (entry)
455741794f19SSteven Rostedt (VMware) 		return -EBUSY;
455841794f19SSteven Rostedt (VMware) 
455941794f19SSteven Rostedt (VMware) 	map = kmalloc(sizeof(*map), GFP_KERNEL);
456041794f19SSteven Rostedt (VMware) 	if (!map)
456141794f19SSteven Rostedt (VMware) 		return -ENOMEM;
456241794f19SSteven Rostedt (VMware) 
456341794f19SSteven Rostedt (VMware) 	map->entry.ip = ip;
456441794f19SSteven Rostedt (VMware) 	map->data = data;
456541794f19SSteven Rostedt (VMware) 
456641794f19SSteven Rostedt (VMware) 	__add_hash_entry(&mapper->hash, &map->entry);
456741794f19SSteven Rostedt (VMware) 
456841794f19SSteven Rostedt (VMware) 	return 0;
456941794f19SSteven Rostedt (VMware) }
457041794f19SSteven Rostedt (VMware) 
457141794f19SSteven Rostedt (VMware) /**
457241794f19SSteven Rostedt (VMware)  * ftrace_func_mapper_remove_ip - Remove an ip from the mapping
457341794f19SSteven Rostedt (VMware)  * @mapper: The mapper that has the ip maps
457441794f19SSteven Rostedt (VMware)  * @ip: The instruction pointer address to remove the data from
457541794f19SSteven Rostedt (VMware)  *
457641794f19SSteven Rostedt (VMware)  * Returns the data if it is found, otherwise NULL.
457741794f19SSteven Rostedt (VMware)  * Note, if the data pointer is used as the data itself, (see
457841794f19SSteven Rostedt (VMware)  * ftrace_func_mapper_find_ip(), then the return value may be meaningless,
457941794f19SSteven Rostedt (VMware)  * if the data pointer was set to zero.
458041794f19SSteven Rostedt (VMware)  */
458141794f19SSteven Rostedt (VMware) void *ftrace_func_mapper_remove_ip(struct ftrace_func_mapper *mapper,
458241794f19SSteven Rostedt (VMware) 				   unsigned long ip)
458341794f19SSteven Rostedt (VMware) {
458441794f19SSteven Rostedt (VMware) 	struct ftrace_func_entry *entry;
458541794f19SSteven Rostedt (VMware) 	struct ftrace_func_map *map;
458641794f19SSteven Rostedt (VMware) 	void *data;
458741794f19SSteven Rostedt (VMware) 
458841794f19SSteven Rostedt (VMware) 	entry = ftrace_lookup_ip(&mapper->hash, ip);
458941794f19SSteven Rostedt (VMware) 	if (!entry)
459041794f19SSteven Rostedt (VMware) 		return NULL;
459141794f19SSteven Rostedt (VMware) 
459241794f19SSteven Rostedt (VMware) 	map = (struct ftrace_func_map *)entry;
459341794f19SSteven Rostedt (VMware) 	data = map->data;
459441794f19SSteven Rostedt (VMware) 
459541794f19SSteven Rostedt (VMware) 	remove_hash_entry(&mapper->hash, entry);
459641794f19SSteven Rostedt (VMware) 	kfree(entry);
459741794f19SSteven Rostedt (VMware) 
459841794f19SSteven Rostedt (VMware) 	return data;
459941794f19SSteven Rostedt (VMware) }
460041794f19SSteven Rostedt (VMware) 
460141794f19SSteven Rostedt (VMware) /**
460241794f19SSteven Rostedt (VMware)  * free_ftrace_func_mapper - free a mapping of ips and data
460341794f19SSteven Rostedt (VMware)  * @mapper: The mapper that has the ip maps
460441794f19SSteven Rostedt (VMware)  * @free_func: A function to be called on each data item.
460541794f19SSteven Rostedt (VMware)  *
460641794f19SSteven Rostedt (VMware)  * This is used to free the function mapper. The @free_func is optional
460741794f19SSteven Rostedt (VMware)  * and can be used if the data needs to be freed as well.
460841794f19SSteven Rostedt (VMware)  */
460941794f19SSteven Rostedt (VMware) void free_ftrace_func_mapper(struct ftrace_func_mapper *mapper,
461041794f19SSteven Rostedt (VMware) 			     ftrace_mapper_func free_func)
461141794f19SSteven Rostedt (VMware) {
461241794f19SSteven Rostedt (VMware) 	struct ftrace_func_entry *entry;
461341794f19SSteven Rostedt (VMware) 	struct ftrace_func_map *map;
461441794f19SSteven Rostedt (VMware) 	struct hlist_head *hhd;
461504e03d9aSWei Li 	int size, i;
461604e03d9aSWei Li 
461704e03d9aSWei Li 	if (!mapper)
461804e03d9aSWei Li 		return;
461941794f19SSteven Rostedt (VMware) 
462041794f19SSteven Rostedt (VMware) 	if (free_func && mapper->hash.count) {
462104e03d9aSWei Li 		size = 1 << mapper->hash.size_bits;
462241794f19SSteven Rostedt (VMware) 		for (i = 0; i < size; i++) {
462341794f19SSteven Rostedt (VMware) 			hhd = &mapper->hash.buckets[i];
462441794f19SSteven Rostedt (VMware) 			hlist_for_each_entry(entry, hhd, hlist) {
462541794f19SSteven Rostedt (VMware) 				map = (struct ftrace_func_map *)entry;
462641794f19SSteven Rostedt (VMware) 				free_func(map);
462741794f19SSteven Rostedt (VMware) 			}
462841794f19SSteven Rostedt (VMware) 		}
462941794f19SSteven Rostedt (VMware) 	}
463041794f19SSteven Rostedt (VMware) 	free_ftrace_hash(&mapper->hash);
463141794f19SSteven Rostedt (VMware) }
463241794f19SSteven Rostedt (VMware) 
46337b60f3d8SSteven Rostedt (VMware) static void release_probe(struct ftrace_func_probe *probe)
46347b60f3d8SSteven Rostedt (VMware) {
46357b60f3d8SSteven Rostedt (VMware) 	struct ftrace_probe_ops *probe_ops;
46367b60f3d8SSteven Rostedt (VMware) 
46375ae0bf59SSteven Rostedt (Red Hat) 	mutex_lock(&ftrace_lock);
46385ae0bf59SSteven Rostedt (Red Hat) 
46397b60f3d8SSteven Rostedt (VMware) 	WARN_ON(probe->ref <= 0);
464059df055fSSteven Rostedt 
46417b60f3d8SSteven Rostedt (VMware) 	/* Subtract the ref that was used to protect this instance */
46427b60f3d8SSteven Rostedt (VMware) 	probe->ref--;
4643546fece4SSteven Rostedt (Red Hat) 
46447b60f3d8SSteven Rostedt (VMware) 	if (!probe->ref) {
46457b60f3d8SSteven Rostedt (VMware) 		probe_ops = probe->probe_ops;
46466e444319SSteven Rostedt (VMware) 		/*
46476e444319SSteven Rostedt (VMware) 		 * Sending zero as ip tells probe_ops to free
46486e444319SSteven Rostedt (VMware) 		 * the probe->data itself
46496e444319SSteven Rostedt (VMware) 		 */
46506e444319SSteven Rostedt (VMware) 		if (probe_ops->free)
46516e444319SSteven Rostedt (VMware) 			probe_ops->free(probe_ops, probe->tr, 0, probe->data);
46527b60f3d8SSteven Rostedt (VMware) 		list_del(&probe->list);
46537b60f3d8SSteven Rostedt (VMware) 		kfree(probe);
46547b60f3d8SSteven Rostedt (VMware) 	}
46557b60f3d8SSteven Rostedt (VMware) 	mutex_unlock(&ftrace_lock);
465659df055fSSteven Rostedt }
465759df055fSSteven Rostedt 
46587b60f3d8SSteven Rostedt (VMware) static void acquire_probe_locked(struct ftrace_func_probe *probe)
46597b60f3d8SSteven Rostedt (VMware) {
46607b60f3d8SSteven Rostedt (VMware) 	/*
46617b60f3d8SSteven Rostedt (VMware) 	 * Add one ref to keep it from being freed when releasing the
46627b60f3d8SSteven Rostedt (VMware) 	 * ftrace_lock mutex.
46637b60f3d8SSteven Rostedt (VMware) 	 */
46647b60f3d8SSteven Rostedt (VMware) 	probe->ref++;
46657b60f3d8SSteven Rostedt (VMware) }
466659df055fSSteven Rostedt 
466759df055fSSteven Rostedt int
466804ec7bb6SSteven Rostedt (VMware) register_ftrace_function_probe(char *glob, struct trace_array *tr,
46697b60f3d8SSteven Rostedt (VMware) 			       struct ftrace_probe_ops *probe_ops,
46707b60f3d8SSteven Rostedt (VMware) 			       void *data)
467159df055fSSteven Rostedt {
4672ba27d855SJakob Koschel 	struct ftrace_func_probe *probe = NULL, *iter;
46731ec3a81aSSteven Rostedt (VMware) 	struct ftrace_func_entry *entry;
46741ec3a81aSSteven Rostedt (VMware) 	struct ftrace_hash **orig_hash;
46751ec3a81aSSteven Rostedt (VMware) 	struct ftrace_hash *old_hash;
467659df055fSSteven Rostedt 	struct ftrace_hash *hash;
467759df055fSSteven Rostedt 	int count = 0;
46781ec3a81aSSteven Rostedt (VMware) 	int size;
467959df055fSSteven Rostedt 	int ret;
46801ec3a81aSSteven Rostedt (VMware) 	int i;
468159df055fSSteven Rostedt 
468204ec7bb6SSteven Rostedt (VMware) 	if (WARN_ON(!tr))
468304ec7bb6SSteven Rostedt (VMware) 		return -EINVAL;
468404ec7bb6SSteven Rostedt (VMware) 
46851ec3a81aSSteven Rostedt (VMware) 	/* We do not support '!' for function probes */
46861ec3a81aSSteven Rostedt (VMware) 	if (WARN_ON(glob[0] == '!'))
468759df055fSSteven Rostedt 		return -EINVAL;
468859df055fSSteven Rostedt 
46897b60f3d8SSteven Rostedt (VMware) 
46907b60f3d8SSteven Rostedt (VMware) 	mutex_lock(&ftrace_lock);
46917b60f3d8SSteven Rostedt (VMware) 	/* Check if the probe_ops is already registered */
4692ba27d855SJakob Koschel 	list_for_each_entry(iter, &tr->func_probes, list) {
4693ba27d855SJakob Koschel 		if (iter->probe_ops == probe_ops) {
4694ba27d855SJakob Koschel 			probe = iter;
46957b60f3d8SSteven Rostedt (VMware) 			break;
46967b60f3d8SSteven Rostedt (VMware) 		}
4697ba27d855SJakob Koschel 	}
4698ba27d855SJakob Koschel 	if (!probe) {
46997b60f3d8SSteven Rostedt (VMware) 		probe = kzalloc(sizeof(*probe), GFP_KERNEL);
47007b60f3d8SSteven Rostedt (VMware) 		if (!probe) {
47017b60f3d8SSteven Rostedt (VMware) 			mutex_unlock(&ftrace_lock);
47027b60f3d8SSteven Rostedt (VMware) 			return -ENOMEM;
47037b60f3d8SSteven Rostedt (VMware) 		}
47047b60f3d8SSteven Rostedt (VMware) 		probe->probe_ops = probe_ops;
47057b60f3d8SSteven Rostedt (VMware) 		probe->ops.func = function_trace_probe_call;
47067b60f3d8SSteven Rostedt (VMware) 		probe->tr = tr;
47077b60f3d8SSteven Rostedt (VMware) 		ftrace_ops_init(&probe->ops);
47087b60f3d8SSteven Rostedt (VMware) 		list_add(&probe->list, &tr->func_probes);
47091ec3a81aSSteven Rostedt (VMware) 	}
471059df055fSSteven Rostedt 
47117b60f3d8SSteven Rostedt (VMware) 	acquire_probe_locked(probe);
471259df055fSSteven Rostedt 
47137b60f3d8SSteven Rostedt (VMware) 	mutex_unlock(&ftrace_lock);
47147b60f3d8SSteven Rostedt (VMware) 
4715372e0d01SSteven Rostedt (VMware) 	/*
4716372e0d01SSteven Rostedt (VMware) 	 * Note, there's a small window here that the func_hash->filter_hash
4717fdda88d3SQiujun Huang 	 * may be NULL or empty. Need to be careful when reading the loop.
4718372e0d01SSteven Rostedt (VMware) 	 */
47197b60f3d8SSteven Rostedt (VMware) 	mutex_lock(&probe->ops.func_hash->regex_lock);
47207b60f3d8SSteven Rostedt (VMware) 
47217b60f3d8SSteven Rostedt (VMware) 	orig_hash = &probe->ops.func_hash->filter_hash;
47221ec3a81aSSteven Rostedt (VMware) 	old_hash = *orig_hash;
472359df055fSSteven Rostedt 	hash = alloc_and_copy_ftrace_hash(FTRACE_HASH_DEFAULT_BITS, old_hash);
47241ec3a81aSSteven Rostedt (VMware) 
47255b0022ddSNaveen N. Rao 	if (!hash) {
47265b0022ddSNaveen N. Rao 		ret = -ENOMEM;
47275b0022ddSNaveen N. Rao 		goto out;
47285b0022ddSNaveen N. Rao 	}
47295b0022ddSNaveen N. Rao 
47301ec3a81aSSteven Rostedt (VMware) 	ret = ftrace_match_records(hash, glob, strlen(glob));
47311ec3a81aSSteven Rostedt (VMware) 
47321ec3a81aSSteven Rostedt (VMware) 	/* Nothing found? */
47331ec3a81aSSteven Rostedt (VMware) 	if (!ret)
47341ec3a81aSSteven Rostedt (VMware) 		ret = -EINVAL;
47351ec3a81aSSteven Rostedt (VMware) 
47361ec3a81aSSteven Rostedt (VMware) 	if (ret < 0)
473759df055fSSteven Rostedt 		goto out;
473859df055fSSteven Rostedt 
47391ec3a81aSSteven Rostedt (VMware) 	size = 1 << hash->size_bits;
47401ec3a81aSSteven Rostedt (VMware) 	for (i = 0; i < size; i++) {
47411ec3a81aSSteven Rostedt (VMware) 		hlist_for_each_entry(entry, &hash->buckets[i], hlist) {
47421ec3a81aSSteven Rostedt (VMware) 			if (ftrace_lookup_ip(old_hash, entry->ip))
474359df055fSSteven Rostedt 				continue;
474459df055fSSteven Rostedt 			/*
474559df055fSSteven Rostedt 			 * The caller might want to do something special
474659df055fSSteven Rostedt 			 * for each function we find. We call the callback
474759df055fSSteven Rostedt 			 * to give the caller an opportunity to do so.
474859df055fSSteven Rostedt 			 */
47497b60f3d8SSteven Rostedt (VMware) 			if (probe_ops->init) {
47507b60f3d8SSteven Rostedt (VMware) 				ret = probe_ops->init(probe_ops, tr,
47516e444319SSteven Rostedt (VMware) 						      entry->ip, data,
47526e444319SSteven Rostedt (VMware) 						      &probe->data);
47536e444319SSteven Rostedt (VMware) 				if (ret < 0) {
47546e444319SSteven Rostedt (VMware) 					if (probe_ops->free && count)
47556e444319SSteven Rostedt (VMware) 						probe_ops->free(probe_ops, tr,
47566e444319SSteven Rostedt (VMware) 								0, probe->data);
47576e444319SSteven Rostedt (VMware) 					probe->data = NULL;
4758eee8ded1SSteven Rostedt (VMware) 					goto out;
47591ec3a81aSSteven Rostedt (VMware) 				}
47606e444319SSteven Rostedt (VMware) 			}
47611ec3a81aSSteven Rostedt (VMware) 			count++;
476259df055fSSteven Rostedt 		}
476359df055fSSteven Rostedt 	}
476459df055fSSteven Rostedt 
47651ec3a81aSSteven Rostedt (VMware) 	mutex_lock(&ftrace_lock);
47661ec3a81aSSteven Rostedt (VMware) 
47677b60f3d8SSteven Rostedt (VMware) 	if (!count) {
47687b60f3d8SSteven Rostedt (VMware) 		/* Nothing was added? */
47697b60f3d8SSteven Rostedt (VMware) 		ret = -EINVAL;
4770e1df4cb6SSteven Rostedt (Red Hat) 		goto out_unlock;
4771e1df4cb6SSteven Rostedt (Red Hat) 	}
4772e1df4cb6SSteven Rostedt (Red Hat) 
47737b60f3d8SSteven Rostedt (VMware) 	ret = ftrace_hash_move_and_update_ops(&probe->ops, orig_hash,
47741ec3a81aSSteven Rostedt (VMware) 					      hash, 1);
47751ec3a81aSSteven Rostedt (VMware) 	if (ret < 0)
47768d70725eSSteven Rostedt (VMware) 		goto err_unlock;
477759df055fSSteven Rostedt 
47787b60f3d8SSteven Rostedt (VMware) 	/* One ref for each new function traced */
47797b60f3d8SSteven Rostedt (VMware) 	probe->ref += count;
478059df055fSSteven Rostedt 
47817b60f3d8SSteven Rostedt (VMware) 	if (!(probe->ops.flags & FTRACE_OPS_FL_ENABLED))
47827b60f3d8SSteven Rostedt (VMware) 		ret = ftrace_startup(&probe->ops, 0);
4783e1df4cb6SSteven Rostedt (Red Hat) 
478459df055fSSteven Rostedt  out_unlock:
47855ae0bf59SSteven Rostedt (Red Hat) 	mutex_unlock(&ftrace_lock);
478659df055fSSteven Rostedt 
478759df055fSSteven Rostedt 	if (!ret)
47881ec3a81aSSteven Rostedt (VMware) 		ret = count;
47895ae0bf59SSteven Rostedt (Red Hat)  out:
47907b60f3d8SSteven Rostedt (VMware) 	mutex_unlock(&probe->ops.func_hash->regex_lock);
4791e1df4cb6SSteven Rostedt (Red Hat) 	free_ftrace_hash(hash);
479259df055fSSteven Rostedt 
47937b60f3d8SSteven Rostedt (VMware) 	release_probe(probe);
47947b60f3d8SSteven Rostedt (VMware) 
47951ec3a81aSSteven Rostedt (VMware) 	return ret;
47968d70725eSSteven Rostedt (VMware) 
47978d70725eSSteven Rostedt (VMware)  err_unlock:
47987b60f3d8SSteven Rostedt (VMware) 	if (!probe_ops->free || !count)
47998d70725eSSteven Rostedt (VMware) 		goto out_unlock;
48008d70725eSSteven Rostedt (VMware) 
48018d70725eSSteven Rostedt (VMware) 	/* Failed to do the move, need to call the free functions */
48028d70725eSSteven Rostedt (VMware) 	for (i = 0; i < size; i++) {
48038d70725eSSteven Rostedt (VMware) 		hlist_for_each_entry(entry, &hash->buckets[i], hlist) {
48048d70725eSSteven Rostedt (VMware) 			if (ftrace_lookup_ip(old_hash, entry->ip))
48058d70725eSSteven Rostedt (VMware) 				continue;
48066e444319SSteven Rostedt (VMware) 			probe_ops->free(probe_ops, tr, entry->ip, probe->data);
48078d70725eSSteven Rostedt (VMware) 		}
48088d70725eSSteven Rostedt (VMware) 	}
48098d70725eSSteven Rostedt (VMware) 	goto out_unlock;
481059df055fSSteven Rostedt }
481159df055fSSteven Rostedt 
4812d3d532d7SSteven Rostedt (VMware) int
48137b60f3d8SSteven Rostedt (VMware) unregister_ftrace_function_probe_func(char *glob, struct trace_array *tr,
48147b60f3d8SSteven Rostedt (VMware) 				      struct ftrace_probe_ops *probe_ops)
481559df055fSSteven Rostedt {
4816ba27d855SJakob Koschel 	struct ftrace_func_probe *probe = NULL, *iter;
481782cc4fc2SSteven Rostedt (VMware) 	struct ftrace_ops_hash old_hash_ops;
4818eee8ded1SSteven Rostedt (VMware) 	struct ftrace_func_entry *entry;
48193ba00929SDmitry Safonov 	struct ftrace_glob func_g;
48201ec3a81aSSteven Rostedt (VMware) 	struct ftrace_hash **orig_hash;
48211ec3a81aSSteven Rostedt (VMware) 	struct ftrace_hash *old_hash;
48221ec3a81aSSteven Rostedt (VMware) 	struct ftrace_hash *hash = NULL;
4823b67bfe0dSSasha Levin 	struct hlist_node *tmp;
4824eee8ded1SSteven Rostedt (VMware) 	struct hlist_head hhd;
482559df055fSSteven Rostedt 	char str[KSYM_SYMBOL_LEN];
48267b60f3d8SSteven Rostedt (VMware) 	int count = 0;
48277b60f3d8SSteven Rostedt (VMware) 	int i, ret = -ENODEV;
4828eee8ded1SSteven Rostedt (VMware) 	int size;
482959df055fSSteven Rostedt 
4830cbab567cSNaveen N. Rao 	if (!glob || !strlen(glob) || !strcmp(glob, "*"))
48313ba00929SDmitry Safonov 		func_g.search = NULL;
4832cbab567cSNaveen N. Rao 	else {
483359df055fSSteven Rostedt 		int not;
483459df055fSSteven Rostedt 
48353ba00929SDmitry Safonov 		func_g.type = filter_parse_regex(glob, strlen(glob),
48363ba00929SDmitry Safonov 						 &func_g.search, &not);
48373ba00929SDmitry Safonov 		func_g.len = strlen(func_g.search);
483859df055fSSteven Rostedt 
4839b6887d79SSteven Rostedt 		/* we do not support '!' for function probes */
484059df055fSSteven Rostedt 		if (WARN_ON(not))
4841d3d532d7SSteven Rostedt (VMware) 			return -EINVAL;
484259df055fSSteven Rostedt 	}
484359df055fSSteven Rostedt 
48447b60f3d8SSteven Rostedt (VMware) 	mutex_lock(&ftrace_lock);
48457b60f3d8SSteven Rostedt (VMware) 	/* Check if the probe_ops is already registered */
4846ba27d855SJakob Koschel 	list_for_each_entry(iter, &tr->func_probes, list) {
4847ba27d855SJakob Koschel 		if (iter->probe_ops == probe_ops) {
4848ba27d855SJakob Koschel 			probe = iter;
48497b60f3d8SSteven Rostedt (VMware) 			break;
48507b60f3d8SSteven Rostedt (VMware) 		}
4851ba27d855SJakob Koschel 	}
4852ba27d855SJakob Koschel 	if (!probe)
48537b60f3d8SSteven Rostedt (VMware) 		goto err_unlock_ftrace;
48541ec3a81aSSteven Rostedt (VMware) 
48551ec3a81aSSteven Rostedt (VMware) 	ret = -EINVAL;
48567b60f3d8SSteven Rostedt (VMware) 	if (!(probe->ops.flags & FTRACE_OPS_FL_INITIALIZED))
48577b60f3d8SSteven Rostedt (VMware) 		goto err_unlock_ftrace;
48587b60f3d8SSteven Rostedt (VMware) 
48597b60f3d8SSteven Rostedt (VMware) 	acquire_probe_locked(probe);
48607b60f3d8SSteven Rostedt (VMware) 
48617b60f3d8SSteven Rostedt (VMware) 	mutex_unlock(&ftrace_lock);
48627b60f3d8SSteven Rostedt (VMware) 
48637b60f3d8SSteven Rostedt (VMware) 	mutex_lock(&probe->ops.func_hash->regex_lock);
48647b60f3d8SSteven Rostedt (VMware) 
48657b60f3d8SSteven Rostedt (VMware) 	orig_hash = &probe->ops.func_hash->filter_hash;
48667b60f3d8SSteven Rostedt (VMware) 	old_hash = *orig_hash;
48677b60f3d8SSteven Rostedt (VMware) 
48681ec3a81aSSteven Rostedt (VMware) 	if (ftrace_hash_empty(old_hash))
48691ec3a81aSSteven Rostedt (VMware) 		goto out_unlock;
4870e1df4cb6SSteven Rostedt (Red Hat) 
487182cc4fc2SSteven Rostedt (VMware) 	old_hash_ops.filter_hash = old_hash;
487282cc4fc2SSteven Rostedt (VMware) 	/* Probes only have filters */
487382cc4fc2SSteven Rostedt (VMware) 	old_hash_ops.notrace_hash = NULL;
487482cc4fc2SSteven Rostedt (VMware) 
4875d3d532d7SSteven Rostedt (VMware) 	ret = -ENOMEM;
48761ec3a81aSSteven Rostedt (VMware) 	hash = alloc_and_copy_ftrace_hash(FTRACE_HASH_DEFAULT_BITS, old_hash);
4877e1df4cb6SSteven Rostedt (Red Hat) 	if (!hash)
4878e1df4cb6SSteven Rostedt (Red Hat) 		goto out_unlock;
4879e1df4cb6SSteven Rostedt (Red Hat) 
4880eee8ded1SSteven Rostedt (VMware) 	INIT_HLIST_HEAD(&hhd);
48817818b388SSteven Rostedt (Red Hat) 
4882eee8ded1SSteven Rostedt (VMware) 	size = 1 << hash->size_bits;
4883eee8ded1SSteven Rostedt (VMware) 	for (i = 0; i < size; i++) {
4884eee8ded1SSteven Rostedt (VMware) 		hlist_for_each_entry_safe(entry, tmp, &hash->buckets[i], hlist) {
488559df055fSSteven Rostedt 
48863ba00929SDmitry Safonov 			if (func_g.search) {
488759df055fSSteven Rostedt 				kallsyms_lookup(entry->ip, NULL, NULL,
488859df055fSSteven Rostedt 						NULL, str);
48893ba00929SDmitry Safonov 				if (!ftrace_match(str, &func_g))
489059df055fSSteven Rostedt 					continue;
489159df055fSSteven Rostedt 			}
48927b60f3d8SSteven Rostedt (VMware) 			count++;
4893eee8ded1SSteven Rostedt (VMware) 			remove_hash_entry(hash, entry);
4894eee8ded1SSteven Rostedt (VMware) 			hlist_add_head(&entry->hlist, &hhd);
489559df055fSSteven Rostedt 		}
489659df055fSSteven Rostedt 	}
4897d3d532d7SSteven Rostedt (VMware) 
4898d3d532d7SSteven Rostedt (VMware) 	/* Nothing found? */
48997b60f3d8SSteven Rostedt (VMware) 	if (!count) {
4900d3d532d7SSteven Rostedt (VMware) 		ret = -EINVAL;
4901d3d532d7SSteven Rostedt (VMware) 		goto out_unlock;
4902d3d532d7SSteven Rostedt (VMware) 	}
4903d3d532d7SSteven Rostedt (VMware) 
49043f2367baSMasami Hiramatsu 	mutex_lock(&ftrace_lock);
49051ec3a81aSSteven Rostedt (VMware) 
49067b60f3d8SSteven Rostedt (VMware) 	WARN_ON(probe->ref < count);
4907eee8ded1SSteven Rostedt (VMware) 
49087b60f3d8SSteven Rostedt (VMware) 	probe->ref -= count;
49091ec3a81aSSteven Rostedt (VMware) 
49107b60f3d8SSteven Rostedt (VMware) 	if (ftrace_hash_empty(hash))
49117b60f3d8SSteven Rostedt (VMware) 		ftrace_shutdown(&probe->ops, 0);
49127b60f3d8SSteven Rostedt (VMware) 
49137b60f3d8SSteven Rostedt (VMware) 	ret = ftrace_hash_move_and_update_ops(&probe->ops, orig_hash,
49141ec3a81aSSteven Rostedt (VMware) 					      hash, 1);
491582cc4fc2SSteven Rostedt (VMware) 
491682cc4fc2SSteven Rostedt (VMware) 	/* still need to update the function call sites */
49171ec3a81aSSteven Rostedt (VMware) 	if (ftrace_enabled && !ftrace_hash_empty(hash))
49187b60f3d8SSteven Rostedt (VMware) 		ftrace_run_modify_code(&probe->ops, FTRACE_UPDATE_CALLS,
491982cc4fc2SSteven Rostedt (VMware) 				       &old_hash_ops);
492074401729SPaul E. McKenney 	synchronize_rcu();
49213296fc4eSSteven Rostedt (Red Hat) 
4922eee8ded1SSteven Rostedt (VMware) 	hlist_for_each_entry_safe(entry, tmp, &hhd, hlist) {
4923eee8ded1SSteven Rostedt (VMware) 		hlist_del(&entry->hlist);
49247b60f3d8SSteven Rostedt (VMware) 		if (probe_ops->free)
49256e444319SSteven Rostedt (VMware) 			probe_ops->free(probe_ops, tr, entry->ip, probe->data);
4926eee8ded1SSteven Rostedt (VMware) 		kfree(entry);
49277818b388SSteven Rostedt (Red Hat) 	}
49283f2367baSMasami Hiramatsu 	mutex_unlock(&ftrace_lock);
49297818b388SSteven Rostedt (Red Hat) 
4930e1df4cb6SSteven Rostedt (Red Hat)  out_unlock:
49317b60f3d8SSteven Rostedt (VMware) 	mutex_unlock(&probe->ops.func_hash->regex_lock);
4932e1df4cb6SSteven Rostedt (Red Hat) 	free_ftrace_hash(hash);
493359df055fSSteven Rostedt 
49347b60f3d8SSteven Rostedt (VMware) 	release_probe(probe);
493559df055fSSteven Rostedt 
49367b60f3d8SSteven Rostedt (VMware) 	return ret;
493759df055fSSteven Rostedt 
49387b60f3d8SSteven Rostedt (VMware)  err_unlock_ftrace:
49397b60f3d8SSteven Rostedt (VMware) 	mutex_unlock(&ftrace_lock);
4940d3d532d7SSteven Rostedt (VMware) 	return ret;
494159df055fSSteven Rostedt }
494259df055fSSteven Rostedt 
4943a0e6369eSNaveen N. Rao void clear_ftrace_function_probes(struct trace_array *tr)
4944a0e6369eSNaveen N. Rao {
4945a0e6369eSNaveen N. Rao 	struct ftrace_func_probe *probe, *n;
4946a0e6369eSNaveen N. Rao 
4947a0e6369eSNaveen N. Rao 	list_for_each_entry_safe(probe, n, &tr->func_probes, list)
4948a0e6369eSNaveen N. Rao 		unregister_ftrace_function_probe_func(NULL, tr, probe->probe_ops);
4949a0e6369eSNaveen N. Rao }
4950a0e6369eSNaveen N. Rao 
4951f6180773SSteven Rostedt static LIST_HEAD(ftrace_commands);
4952f6180773SSteven Rostedt static DEFINE_MUTEX(ftrace_cmd_mutex);
4953f6180773SSteven Rostedt 
495438de93abSTom Zanussi /*
495538de93abSTom Zanussi  * Currently we only register ftrace commands from __init, so mark this
495638de93abSTom Zanussi  * __init too.
495738de93abSTom Zanussi  */
495838de93abSTom Zanussi __init int register_ftrace_command(struct ftrace_func_command *cmd)
4959f6180773SSteven Rostedt {
4960f6180773SSteven Rostedt 	struct ftrace_func_command *p;
4961f6180773SSteven Rostedt 	int ret = 0;
4962f6180773SSteven Rostedt 
4963f6180773SSteven Rostedt 	mutex_lock(&ftrace_cmd_mutex);
4964f6180773SSteven Rostedt 	list_for_each_entry(p, &ftrace_commands, list) {
4965f6180773SSteven Rostedt 		if (strcmp(cmd->name, p->name) == 0) {
4966f6180773SSteven Rostedt 			ret = -EBUSY;
4967f6180773SSteven Rostedt 			goto out_unlock;
4968f6180773SSteven Rostedt 		}
4969f6180773SSteven Rostedt 	}
4970f6180773SSteven Rostedt 	list_add(&cmd->list, &ftrace_commands);
4971f6180773SSteven Rostedt  out_unlock:
4972f6180773SSteven Rostedt 	mutex_unlock(&ftrace_cmd_mutex);
4973f6180773SSteven Rostedt 
4974f6180773SSteven Rostedt 	return ret;
4975f6180773SSteven Rostedt }
4976f6180773SSteven Rostedt 
497738de93abSTom Zanussi /*
497838de93abSTom Zanussi  * Currently we only unregister ftrace commands from __init, so mark
497938de93abSTom Zanussi  * this __init too.
498038de93abSTom Zanussi  */
498138de93abSTom Zanussi __init int unregister_ftrace_command(struct ftrace_func_command *cmd)
4982f6180773SSteven Rostedt {
4983f6180773SSteven Rostedt 	struct ftrace_func_command *p, *n;
4984f6180773SSteven Rostedt 	int ret = -ENODEV;
4985f6180773SSteven Rostedt 
4986f6180773SSteven Rostedt 	mutex_lock(&ftrace_cmd_mutex);
4987f6180773SSteven Rostedt 	list_for_each_entry_safe(p, n, &ftrace_commands, list) {
4988f6180773SSteven Rostedt 		if (strcmp(cmd->name, p->name) == 0) {
4989f6180773SSteven Rostedt 			ret = 0;
4990f6180773SSteven Rostedt 			list_del_init(&p->list);
4991f6180773SSteven Rostedt 			goto out_unlock;
4992f6180773SSteven Rostedt 		}
4993f6180773SSteven Rostedt 	}
4994f6180773SSteven Rostedt  out_unlock:
4995f6180773SSteven Rostedt 	mutex_unlock(&ftrace_cmd_mutex);
4996f6180773SSteven Rostedt 
4997f6180773SSteven Rostedt 	return ret;
4998f6180773SSteven Rostedt }
4999f6180773SSteven Rostedt 
500004ec7bb6SSteven Rostedt (VMware) static int ftrace_process_regex(struct ftrace_iterator *iter,
500133dc9b12SSteven Rostedt 				char *buff, int len, int enable)
500264e7c440SSteven Rostedt {
500304ec7bb6SSteven Rostedt (VMware) 	struct ftrace_hash *hash = iter->hash;
5004d2afd57aSSteven Rostedt (VMware) 	struct trace_array *tr = iter->ops->private;
5005f6180773SSteven Rostedt 	char *func, *command, *next = buff;
50066a24a244SSteven Rostedt 	struct ftrace_func_command *p;
50070aff1c0cSGuoWen Li 	int ret = -EINVAL;
500864e7c440SSteven Rostedt 
500964e7c440SSteven Rostedt 	func = strsep(&next, ":");
501064e7c440SSteven Rostedt 
501164e7c440SSteven Rostedt 	if (!next) {
50121cf41dd7SSteven Rostedt 		ret = ftrace_match_records(hash, func, len);
5013b448c4e3SSteven Rostedt 		if (!ret)
5014b448c4e3SSteven Rostedt 			ret = -EINVAL;
5015b448c4e3SSteven Rostedt 		if (ret < 0)
5016311d16daSLi Zefan 			return ret;
5017b448c4e3SSteven Rostedt 		return 0;
501864e7c440SSteven Rostedt 	}
501964e7c440SSteven Rostedt 
5020f6180773SSteven Rostedt 	/* command found */
502164e7c440SSteven Rostedt 
502264e7c440SSteven Rostedt 	command = strsep(&next, ":");
502364e7c440SSteven Rostedt 
5024f6180773SSteven Rostedt 	mutex_lock(&ftrace_cmd_mutex);
5025f6180773SSteven Rostedt 	list_for_each_entry(p, &ftrace_commands, list) {
5026f6180773SSteven Rostedt 		if (strcmp(p->name, command) == 0) {
502704ec7bb6SSteven Rostedt (VMware) 			ret = p->func(tr, hash, func, command, next, enable);
5028f6180773SSteven Rostedt 			goto out_unlock;
502964e7c440SSteven Rostedt 		}
5030f6180773SSteven Rostedt 	}
5031f6180773SSteven Rostedt  out_unlock:
5032f6180773SSteven Rostedt 	mutex_unlock(&ftrace_cmd_mutex);
503364e7c440SSteven Rostedt 
5034f6180773SSteven Rostedt 	return ret;
503564e7c440SSteven Rostedt }
503664e7c440SSteven Rostedt 
5037e309b41dSIngo Molnar static ssize_t
503841c52c0dSSteven Rostedt ftrace_regex_write(struct file *file, const char __user *ubuf,
503941c52c0dSSteven Rostedt 		   size_t cnt, loff_t *ppos, int enable)
50405072c59fSSteven Rostedt {
50415072c59fSSteven Rostedt 	struct ftrace_iterator *iter;
5042689fd8b6S[email protected] 	struct trace_parser *parser;
5043689fd8b6S[email protected] 	ssize_t ret, read;
50445072c59fSSteven Rostedt 
50454ba7978eSLi Zefan 	if (!cnt)
50465072c59fSSteven Rostedt 		return 0;
50475072c59fSSteven Rostedt 
50485072c59fSSteven Rostedt 	if (file->f_mode & FMODE_READ) {
50495072c59fSSteven Rostedt 		struct seq_file *m = file->private_data;
50505072c59fSSteven Rostedt 		iter = m->private;
50515072c59fSSteven Rostedt 	} else
50525072c59fSSteven Rostedt 		iter = file->private_data;
50535072c59fSSteven Rostedt 
5054f04f24fbSMasami Hiramatsu 	if (unlikely(ftrace_disabled))
50553f2367baSMasami Hiramatsu 		return -ENODEV;
50563f2367baSMasami Hiramatsu 
50573f2367baSMasami Hiramatsu 	/* iter->hash is a local copy, so we don't need regex_lock */
5058f04f24fbSMasami Hiramatsu 
5059689fd8b6S[email protected] 	parser = &iter->parser;
5060689fd8b6S[email protected] 	read = trace_get_user(parser, ubuf, cnt, ppos);
50615072c59fSSteven Rostedt 
50624ba7978eSLi Zefan 	if (read >= 0 && trace_parser_loaded(parser) &&
5063689fd8b6S[email protected] 	    !trace_parser_cont(parser)) {
506404ec7bb6SSteven Rostedt (VMware) 		ret = ftrace_process_regex(iter, parser->buffer,
5065689fd8b6S[email protected] 					   parser->idx, enable);
5066313254a9SLi Zefan 		trace_parser_clear(parser);
50677c088b51SSteven Rostedt (Red Hat) 		if (ret < 0)
50683f2367baSMasami Hiramatsu 			goto out;
50695072c59fSSteven Rostedt 	}
50705072c59fSSteven Rostedt 
50715072c59fSSteven Rostedt 	ret = read;
50723f2367baSMasami Hiramatsu  out:
50735072c59fSSteven Rostedt 	return ret;
50745072c59fSSteven Rostedt }
50755072c59fSSteven Rostedt 
5076fc13cb0cSSteven Rostedt ssize_t
507741c52c0dSSteven Rostedt ftrace_filter_write(struct file *file, const char __user *ubuf,
507841c52c0dSSteven Rostedt 		    size_t cnt, loff_t *ppos)
507941c52c0dSSteven Rostedt {
508041c52c0dSSteven Rostedt 	return ftrace_regex_write(file, ubuf, cnt, ppos, 1);
508141c52c0dSSteven Rostedt }
508241c52c0dSSteven Rostedt 
5083fc13cb0cSSteven Rostedt ssize_t
508441c52c0dSSteven Rostedt ftrace_notrace_write(struct file *file, const char __user *ubuf,
508541c52c0dSSteven Rostedt 		     size_t cnt, loff_t *ppos)
508641c52c0dSSteven Rostedt {
508741c52c0dSSteven Rostedt 	return ftrace_regex_write(file, ubuf, cnt, ppos, 0);
508841c52c0dSSteven Rostedt }
508941c52c0dSSteven Rostedt 
509033dc9b12SSteven Rostedt static int
50914f554e95SJiri Olsa __ftrace_match_addr(struct ftrace_hash *hash, unsigned long ip, int remove)
5092647664eaSMasami Hiramatsu {
5093647664eaSMasami Hiramatsu 	struct ftrace_func_entry *entry;
5094647664eaSMasami Hiramatsu 
5095aebfd125SPeter Zijlstra 	ip = ftrace_location(ip);
5096aebfd125SPeter Zijlstra 	if (!ip)
5097647664eaSMasami Hiramatsu 		return -EINVAL;
5098647664eaSMasami Hiramatsu 
5099647664eaSMasami Hiramatsu 	if (remove) {
5100647664eaSMasami Hiramatsu 		entry = ftrace_lookup_ip(hash, ip);
5101647664eaSMasami Hiramatsu 		if (!entry)
5102647664eaSMasami Hiramatsu 			return -ENOENT;
5103647664eaSMasami Hiramatsu 		free_hash_entry(hash, entry);
5104647664eaSMasami Hiramatsu 		return 0;
5105647664eaSMasami Hiramatsu 	}
5106647664eaSMasami Hiramatsu 
5107647664eaSMasami Hiramatsu 	return add_hash_entry(hash, ip);
5108647664eaSMasami Hiramatsu }
5109647664eaSMasami Hiramatsu 
5110647664eaSMasami Hiramatsu static int
51114f554e95SJiri Olsa ftrace_match_addr(struct ftrace_hash *hash, unsigned long *ips,
51124f554e95SJiri Olsa 		  unsigned int cnt, int remove)
51134f554e95SJiri Olsa {
51144f554e95SJiri Olsa 	unsigned int i;
51154f554e95SJiri Olsa 	int err;
51164f554e95SJiri Olsa 
51174f554e95SJiri Olsa 	for (i = 0; i < cnt; i++) {
51184f554e95SJiri Olsa 		err = __ftrace_match_addr(hash, ips[i], remove);
51194f554e95SJiri Olsa 		if (err) {
51204f554e95SJiri Olsa 			/*
51214f554e95SJiri Olsa 			 * This expects the @hash is a temporary hash and if this
51224f554e95SJiri Olsa 			 * fails the caller must free the @hash.
51234f554e95SJiri Olsa 			 */
51244f554e95SJiri Olsa 			return err;
51254f554e95SJiri Olsa 		}
51264f554e95SJiri Olsa 	}
51274f554e95SJiri Olsa 	return 0;
51284f554e95SJiri Olsa }
51294f554e95SJiri Olsa 
51304f554e95SJiri Olsa static int
5131647664eaSMasami Hiramatsu ftrace_set_hash(struct ftrace_ops *ops, unsigned char *buf, int len,
51324f554e95SJiri Olsa 		unsigned long *ips, unsigned int cnt,
51334f554e95SJiri Olsa 		int remove, int reset, int enable)
513441c52c0dSSteven Rostedt {
513533dc9b12SSteven Rostedt 	struct ftrace_hash **orig_hash;
5136f45948e8SSteven Rostedt 	struct ftrace_hash *hash;
513733dc9b12SSteven Rostedt 	int ret;
5138f45948e8SSteven Rostedt 
513941c52c0dSSteven Rostedt 	if (unlikely(ftrace_disabled))
514033dc9b12SSteven Rostedt 		return -ENODEV;
514141c52c0dSSteven Rostedt 
514233b7f99cSSteven Rostedt (Red Hat) 	mutex_lock(&ops->func_hash->regex_lock);
51433f2367baSMasami Hiramatsu 
5144f45948e8SSteven Rostedt 	if (enable)
514533b7f99cSSteven Rostedt (Red Hat) 		orig_hash = &ops->func_hash->filter_hash;
5146f45948e8SSteven Rostedt 	else
514733b7f99cSSteven Rostedt (Red Hat) 		orig_hash = &ops->func_hash->notrace_hash;
514833dc9b12SSteven Rostedt 
5149b972cc58SWang Nan 	if (reset)
5150b972cc58SWang Nan 		hash = alloc_ftrace_hash(FTRACE_HASH_DEFAULT_BITS);
5151b972cc58SWang Nan 	else
515233dc9b12SSteven Rostedt 		hash = alloc_and_copy_ftrace_hash(FTRACE_HASH_DEFAULT_BITS, *orig_hash);
5153b972cc58SWang Nan 
51543f2367baSMasami Hiramatsu 	if (!hash) {
51553f2367baSMasami Hiramatsu 		ret = -ENOMEM;
51563f2367baSMasami Hiramatsu 		goto out_regex_unlock;
51573f2367baSMasami Hiramatsu 	}
5158f45948e8SSteven Rostedt 
5159ac483c44SJiri Olsa 	if (buf && !ftrace_match_records(hash, buf, len)) {
5160ac483c44SJiri Olsa 		ret = -EINVAL;
5161ac483c44SJiri Olsa 		goto out_regex_unlock;
5162ac483c44SJiri Olsa 	}
51634f554e95SJiri Olsa 	if (ips) {
51644f554e95SJiri Olsa 		ret = ftrace_match_addr(hash, ips, cnt, remove);
5165647664eaSMasami Hiramatsu 		if (ret < 0)
5166647664eaSMasami Hiramatsu 			goto out_regex_unlock;
5167647664eaSMasami Hiramatsu 	}
516833dc9b12SSteven Rostedt 
516933dc9b12SSteven Rostedt 	mutex_lock(&ftrace_lock);
5170e16b35ddSSteven Rostedt (VMware) 	ret = ftrace_hash_move_and_update_ops(ops, orig_hash, hash, enable);
517133dc9b12SSteven Rostedt 	mutex_unlock(&ftrace_lock);
517233dc9b12SSteven Rostedt 
5173ac483c44SJiri Olsa  out_regex_unlock:
517433b7f99cSSteven Rostedt (Red Hat) 	mutex_unlock(&ops->func_hash->regex_lock);
517533dc9b12SSteven Rostedt 
517633dc9b12SSteven Rostedt 	free_ftrace_hash(hash);
517733dc9b12SSteven Rostedt 	return ret;
517841c52c0dSSteven Rostedt }
517941c52c0dSSteven Rostedt 
5180647664eaSMasami Hiramatsu static int
51814f554e95SJiri Olsa ftrace_set_addr(struct ftrace_ops *ops, unsigned long *ips, unsigned int cnt,
51824f554e95SJiri Olsa 		int remove, int reset, int enable)
5183647664eaSMasami Hiramatsu {
51844f554e95SJiri Olsa 	return ftrace_set_hash(ops, NULL, 0, ips, cnt, remove, reset, enable);
5185647664eaSMasami Hiramatsu }
5186647664eaSMasami Hiramatsu 
5187763e34e7SSteven Rostedt (VMware) #ifdef CONFIG_DYNAMIC_FTRACE_WITH_DIRECT_CALLS
5188013bf0daSSteven Rostedt (VMware) 
5189013bf0daSSteven Rostedt (VMware) struct ftrace_direct_func {
5190013bf0daSSteven Rostedt (VMware) 	struct list_head	next;
5191013bf0daSSteven Rostedt (VMware) 	unsigned long		addr;
5192013bf0daSSteven Rostedt (VMware) 	int			count;
5193013bf0daSSteven Rostedt (VMware) };
5194013bf0daSSteven Rostedt (VMware) 
5195013bf0daSSteven Rostedt (VMware) static LIST_HEAD(ftrace_direct_funcs);
5196013bf0daSSteven Rostedt (VMware) 
5197013bf0daSSteven Rostedt (VMware) /**
5198013bf0daSSteven Rostedt (VMware)  * ftrace_find_direct_func - test an address if it is a registered direct caller
5199013bf0daSSteven Rostedt (VMware)  * @addr: The address of a registered direct caller
5200013bf0daSSteven Rostedt (VMware)  *
5201013bf0daSSteven Rostedt (VMware)  * This searches to see if a ftrace direct caller has been registered
5202013bf0daSSteven Rostedt (VMware)  * at a specific address, and if so, it returns a descriptor for it.
5203013bf0daSSteven Rostedt (VMware)  *
5204013bf0daSSteven Rostedt (VMware)  * This can be used by architecture code to see if an address is
5205013bf0daSSteven Rostedt (VMware)  * a direct caller (trampoline) attached to a fentry/mcount location.
5206013bf0daSSteven Rostedt (VMware)  * This is useful for the function_graph tracer, as it may need to
5207013bf0daSSteven Rostedt (VMware)  * do adjustments if it traced a location that also has a direct
5208013bf0daSSteven Rostedt (VMware)  * trampoline attached to it.
5209013bf0daSSteven Rostedt (VMware)  */
5210013bf0daSSteven Rostedt (VMware) struct ftrace_direct_func *ftrace_find_direct_func(unsigned long addr)
5211013bf0daSSteven Rostedt (VMware) {
5212013bf0daSSteven Rostedt (VMware) 	struct ftrace_direct_func *entry;
5213013bf0daSSteven Rostedt (VMware) 	bool found = false;
5214013bf0daSSteven Rostedt (VMware) 
5215013bf0daSSteven Rostedt (VMware) 	/* May be called by fgraph trampoline (protected by rcu tasks) */
5216013bf0daSSteven Rostedt (VMware) 	list_for_each_entry_rcu(entry, &ftrace_direct_funcs, next) {
5217013bf0daSSteven Rostedt (VMware) 		if (entry->addr == addr) {
5218013bf0daSSteven Rostedt (VMware) 			found = true;
5219013bf0daSSteven Rostedt (VMware) 			break;
5220013bf0daSSteven Rostedt (VMware) 		}
5221013bf0daSSteven Rostedt (VMware) 	}
5222013bf0daSSteven Rostedt (VMware) 	if (found)
5223013bf0daSSteven Rostedt (VMware) 		return entry;
5224013bf0daSSteven Rostedt (VMware) 
5225013bf0daSSteven Rostedt (VMware) 	return NULL;
5226013bf0daSSteven Rostedt (VMware) }
5227013bf0daSSteven Rostedt (VMware) 
52288a141dd7SAlexei Starovoitov static struct ftrace_direct_func *ftrace_alloc_direct_func(unsigned long addr)
52298a141dd7SAlexei Starovoitov {
52308a141dd7SAlexei Starovoitov 	struct ftrace_direct_func *direct;
52318a141dd7SAlexei Starovoitov 
52328a141dd7SAlexei Starovoitov 	direct = kmalloc(sizeof(*direct), GFP_KERNEL);
52338a141dd7SAlexei Starovoitov 	if (!direct)
52348a141dd7SAlexei Starovoitov 		return NULL;
52358a141dd7SAlexei Starovoitov 	direct->addr = addr;
52368a141dd7SAlexei Starovoitov 	direct->count = 0;
52378a141dd7SAlexei Starovoitov 	list_add_rcu(&direct->next, &ftrace_direct_funcs);
52388a141dd7SAlexei Starovoitov 	ftrace_direct_func_count++;
52398a141dd7SAlexei Starovoitov 	return direct;
52408a141dd7SAlexei Starovoitov }
52418a141dd7SAlexei Starovoitov 
524253cd885bSSong Liu static int register_ftrace_function_nolock(struct ftrace_ops *ops);
524353cd885bSSong Liu 
5244763e34e7SSteven Rostedt (VMware) /**
5245763e34e7SSteven Rostedt (VMware)  * register_ftrace_direct - Call a custom trampoline directly
5246763e34e7SSteven Rostedt (VMware)  * @ip: The address of the nop at the beginning of a function
5247763e34e7SSteven Rostedt (VMware)  * @addr: The address of the trampoline to call at @ip
5248763e34e7SSteven Rostedt (VMware)  *
5249763e34e7SSteven Rostedt (VMware)  * This is used to connect a direct call from the nop location (@ip)
5250763e34e7SSteven Rostedt (VMware)  * at the start of ftrace traced functions. The location that it calls
5251763e34e7SSteven Rostedt (VMware)  * (@addr) must be able to handle a direct call, and save the parameters
5252763e34e7SSteven Rostedt (VMware)  * of the function being traced, and restore them (or inject new ones
5253763e34e7SSteven Rostedt (VMware)  * if needed), before returning.
5254763e34e7SSteven Rostedt (VMware)  *
5255763e34e7SSteven Rostedt (VMware)  * Returns:
5256763e34e7SSteven Rostedt (VMware)  *  0 on success
5257763e34e7SSteven Rostedt (VMware)  *  -EBUSY - Another direct function is already attached (there can be only one)
5258763e34e7SSteven Rostedt (VMware)  *  -ENODEV - @ip does not point to a ftrace nop location (or not supported)
5259763e34e7SSteven Rostedt (VMware)  *  -ENOMEM - There was an allocation failure.
5260763e34e7SSteven Rostedt (VMware)  */
5261763e34e7SSteven Rostedt (VMware) int register_ftrace_direct(unsigned long ip, unsigned long addr)
5262763e34e7SSteven Rostedt (VMware) {
5263013bf0daSSteven Rostedt (VMware) 	struct ftrace_direct_func *direct;
5264763e34e7SSteven Rostedt (VMware) 	struct ftrace_func_entry *entry;
5265763e34e7SSteven Rostedt (VMware) 	struct ftrace_hash *free_hash = NULL;
5266763e34e7SSteven Rostedt (VMware) 	struct dyn_ftrace *rec;
5267aebfd125SPeter Zijlstra 	int ret = -ENODEV;
5268763e34e7SSteven Rostedt (VMware) 
5269763e34e7SSteven Rostedt (VMware) 	mutex_lock(&direct_mutex);
5270763e34e7SSteven Rostedt (VMware) 
5271aebfd125SPeter Zijlstra 	ip = ftrace_location(ip);
5272aebfd125SPeter Zijlstra 	if (!ip)
5273aebfd125SPeter Zijlstra 		goto out_unlock;
5274aebfd125SPeter Zijlstra 
5275763e34e7SSteven Rostedt (VMware) 	/* See if there's a direct function at @ip already */
5276aebfd125SPeter Zijlstra 	ret = -EBUSY;
5277ff205766SAlexei Starovoitov 	if (ftrace_find_rec_direct(ip))
5278763e34e7SSteven Rostedt (VMware) 		goto out_unlock;
5279763e34e7SSteven Rostedt (VMware) 
5280763e34e7SSteven Rostedt (VMware) 	ret = -ENODEV;
5281763e34e7SSteven Rostedt (VMware) 	rec = lookup_rec(ip, ip);
5282763e34e7SSteven Rostedt (VMware) 	if (!rec)
5283763e34e7SSteven Rostedt (VMware) 		goto out_unlock;
5284763e34e7SSteven Rostedt (VMware) 
5285763e34e7SSteven Rostedt (VMware) 	/*
5286763e34e7SSteven Rostedt (VMware) 	 * Check if the rec says it has a direct call but we didn't
5287763e34e7SSteven Rostedt (VMware) 	 * find one earlier?
5288763e34e7SSteven Rostedt (VMware) 	 */
5289763e34e7SSteven Rostedt (VMware) 	if (WARN_ON(rec->flags & FTRACE_FL_DIRECT))
5290763e34e7SSteven Rostedt (VMware) 		goto out_unlock;
5291763e34e7SSteven Rostedt (VMware) 
5292763e34e7SSteven Rostedt (VMware) 	/* Make sure the ip points to the exact record */
5293406acdd3SSteven Rostedt (VMware) 	if (ip != rec->ip) {
5294763e34e7SSteven Rostedt (VMware) 		ip = rec->ip;
5295406acdd3SSteven Rostedt (VMware) 		/* Need to check this ip for a direct. */
5296ff205766SAlexei Starovoitov 		if (ftrace_find_rec_direct(ip))
5297406acdd3SSteven Rostedt (VMware) 			goto out_unlock;
5298406acdd3SSteven Rostedt (VMware) 	}
5299763e34e7SSteven Rostedt (VMware) 
5300763e34e7SSteven Rostedt (VMware) 	ret = -ENOMEM;
5301013bf0daSSteven Rostedt (VMware) 	direct = ftrace_find_direct_func(addr);
5302013bf0daSSteven Rostedt (VMware) 	if (!direct) {
53038a141dd7SAlexei Starovoitov 		direct = ftrace_alloc_direct_func(addr);
53041904a814SJiri Olsa 		if (!direct)
5305013bf0daSSteven Rostedt (VMware) 			goto out_unlock;
5306013bf0daSSteven Rostedt (VMware) 	}
5307013bf0daSSteven Rostedt (VMware) 
53081904a814SJiri Olsa 	entry = ftrace_add_rec_direct(ip, addr, &free_hash);
53091904a814SJiri Olsa 	if (!entry)
53101904a814SJiri Olsa 		goto out_unlock;
5311763e34e7SSteven Rostedt (VMware) 
5312763e34e7SSteven Rostedt (VMware) 	ret = ftrace_set_filter_ip(&direct_ops, ip, 0, 0);
5313763e34e7SSteven Rostedt (VMware) 
5314763e34e7SSteven Rostedt (VMware) 	if (!ret && !(direct_ops.flags & FTRACE_OPS_FL_ENABLED)) {
531553cd885bSSong Liu 		ret = register_ftrace_function_nolock(&direct_ops);
5316763e34e7SSteven Rostedt (VMware) 		if (ret)
5317763e34e7SSteven Rostedt (VMware) 			ftrace_set_filter_ip(&direct_ops, ip, 1, 0);
5318763e34e7SSteven Rostedt (VMware) 	}
5319763e34e7SSteven Rostedt (VMware) 
5320013bf0daSSteven Rostedt (VMware) 	if (ret) {
53217d54c15cSSong Liu 		remove_hash_entry(direct_functions, entry);
5322763e34e7SSteven Rostedt (VMware) 		kfree(entry);
5323013bf0daSSteven Rostedt (VMware) 		if (!direct->count) {
5324013bf0daSSteven Rostedt (VMware) 			list_del_rcu(&direct->next);
5325013bf0daSSteven Rostedt (VMware) 			synchronize_rcu_tasks();
5326013bf0daSSteven Rostedt (VMware) 			kfree(direct);
5327013bf0daSSteven Rostedt (VMware) 			if (free_hash)
5328013bf0daSSteven Rostedt (VMware) 				free_ftrace_hash(free_hash);
5329013bf0daSSteven Rostedt (VMware) 			free_hash = NULL;
5330a3ad1a7eSSteven Rostedt (VMware) 			ftrace_direct_func_count--;
5331013bf0daSSteven Rostedt (VMware) 		}
5332013bf0daSSteven Rostedt (VMware) 	} else {
5333013bf0daSSteven Rostedt (VMware) 		direct->count++;
5334013bf0daSSteven Rostedt (VMware) 	}
5335763e34e7SSteven Rostedt (VMware)  out_unlock:
5336763e34e7SSteven Rostedt (VMware) 	mutex_unlock(&direct_mutex);
5337763e34e7SSteven Rostedt (VMware) 
5338763e34e7SSteven Rostedt (VMware) 	if (free_hash) {
5339763e34e7SSteven Rostedt (VMware) 		synchronize_rcu_tasks();
5340763e34e7SSteven Rostedt (VMware) 		free_ftrace_hash(free_hash);
5341763e34e7SSteven Rostedt (VMware) 	}
5342763e34e7SSteven Rostedt (VMware) 
5343763e34e7SSteven Rostedt (VMware) 	return ret;
5344763e34e7SSteven Rostedt (VMware) }
5345763e34e7SSteven Rostedt (VMware) EXPORT_SYMBOL_GPL(register_ftrace_direct);
5346763e34e7SSteven Rostedt (VMware) 
5347ea806eb3SSteven Rostedt (VMware) static struct ftrace_func_entry *find_direct_entry(unsigned long *ip,
5348ea806eb3SSteven Rostedt (VMware) 						   struct dyn_ftrace **recp)
5349763e34e7SSteven Rostedt (VMware) {
5350763e34e7SSteven Rostedt (VMware) 	struct ftrace_func_entry *entry;
5351763e34e7SSteven Rostedt (VMware) 	struct dyn_ftrace *rec;
5352763e34e7SSteven Rostedt (VMware) 
5353128161f4SSteven Rostedt (VMware) 	rec = lookup_rec(*ip, *ip);
5354128161f4SSteven Rostedt (VMware) 	if (!rec)
5355128161f4SSteven Rostedt (VMware) 		return NULL;
5356763e34e7SSteven Rostedt (VMware) 
5357763e34e7SSteven Rostedt (VMware) 	entry = __ftrace_lookup_ip(direct_functions, rec->ip);
5358763e34e7SSteven Rostedt (VMware) 	if (!entry) {
5359763e34e7SSteven Rostedt (VMware) 		WARN_ON(rec->flags & FTRACE_FL_DIRECT);
5360128161f4SSteven Rostedt (VMware) 		return NULL;
5361763e34e7SSteven Rostedt (VMware) 	}
5362763e34e7SSteven Rostedt (VMware) 
5363763e34e7SSteven Rostedt (VMware) 	WARN_ON(!(rec->flags & FTRACE_FL_DIRECT));
5364128161f4SSteven Rostedt (VMware) 
5365128161f4SSteven Rostedt (VMware) 	/* Passed in ip just needs to be on the call site */
5366128161f4SSteven Rostedt (VMware) 	*ip = rec->ip;
5367128161f4SSteven Rostedt (VMware) 
5368ea806eb3SSteven Rostedt (VMware) 	if (recp)
5369ea806eb3SSteven Rostedt (VMware) 		*recp = rec;
5370ea806eb3SSteven Rostedt (VMware) 
5371128161f4SSteven Rostedt (VMware) 	return entry;
5372763e34e7SSteven Rostedt (VMware) }
5373763e34e7SSteven Rostedt (VMware) 
5374128161f4SSteven Rostedt (VMware) int unregister_ftrace_direct(unsigned long ip, unsigned long addr)
5375128161f4SSteven Rostedt (VMware) {
5376128161f4SSteven Rostedt (VMware) 	struct ftrace_direct_func *direct;
5377128161f4SSteven Rostedt (VMware) 	struct ftrace_func_entry *entry;
53787d5b7cadSJiri Olsa 	struct ftrace_hash *hash;
5379128161f4SSteven Rostedt (VMware) 	int ret = -ENODEV;
5380128161f4SSteven Rostedt (VMware) 
5381128161f4SSteven Rostedt (VMware) 	mutex_lock(&direct_mutex);
5382128161f4SSteven Rostedt (VMware) 
5383aebfd125SPeter Zijlstra 	ip = ftrace_location(ip);
5384aebfd125SPeter Zijlstra 	if (!ip)
5385aebfd125SPeter Zijlstra 		goto out_unlock;
5386aebfd125SPeter Zijlstra 
5387ea806eb3SSteven Rostedt (VMware) 	entry = find_direct_entry(&ip, NULL);
5388128161f4SSteven Rostedt (VMware) 	if (!entry)
5389128161f4SSteven Rostedt (VMware) 		goto out_unlock;
5390128161f4SSteven Rostedt (VMware) 
53917d5b7cadSJiri Olsa 	hash = direct_ops.func_hash->filter_hash;
53927d5b7cadSJiri Olsa 	if (hash->count == 1)
5393763e34e7SSteven Rostedt (VMware) 		unregister_ftrace_function(&direct_ops);
5394763e34e7SSteven Rostedt (VMware) 
5395763e34e7SSteven Rostedt (VMware) 	ret = ftrace_set_filter_ip(&direct_ops, ip, 1, 0);
5396763e34e7SSteven Rostedt (VMware) 
5397763e34e7SSteven Rostedt (VMware) 	WARN_ON(ret);
5398763e34e7SSteven Rostedt (VMware) 
5399763e34e7SSteven Rostedt (VMware) 	remove_hash_entry(direct_functions, entry);
5400763e34e7SSteven Rostedt (VMware) 
5401013bf0daSSteven Rostedt (VMware) 	direct = ftrace_find_direct_func(addr);
5402013bf0daSSteven Rostedt (VMware) 	if (!WARN_ON(!direct)) {
5403013bf0daSSteven Rostedt (VMware) 		/* This is the good path (see the ! before WARN) */
5404013bf0daSSteven Rostedt (VMware) 		direct->count--;
5405013bf0daSSteven Rostedt (VMware) 		WARN_ON(direct->count < 0);
5406013bf0daSSteven Rostedt (VMware) 		if (!direct->count) {
5407013bf0daSSteven Rostedt (VMware) 			list_del_rcu(&direct->next);
5408013bf0daSSteven Rostedt (VMware) 			synchronize_rcu_tasks();
5409013bf0daSSteven Rostedt (VMware) 			kfree(direct);
5410353da879SSteven Rostedt (VMware) 			kfree(entry);
5411a3ad1a7eSSteven Rostedt (VMware) 			ftrace_direct_func_count--;
5412013bf0daSSteven Rostedt (VMware) 		}
5413013bf0daSSteven Rostedt (VMware) 	}
5414763e34e7SSteven Rostedt (VMware)  out_unlock:
5415763e34e7SSteven Rostedt (VMware) 	mutex_unlock(&direct_mutex);
5416763e34e7SSteven Rostedt (VMware) 
5417763e34e7SSteven Rostedt (VMware) 	return ret;
5418763e34e7SSteven Rostedt (VMware) }
5419763e34e7SSteven Rostedt (VMware) EXPORT_SYMBOL_GPL(unregister_ftrace_direct);
54200567d680SSteven Rostedt (VMware) 
54210567d680SSteven Rostedt (VMware) static struct ftrace_ops stub_ops = {
54220567d680SSteven Rostedt (VMware) 	.func		= ftrace_stub,
54230567d680SSteven Rostedt (VMware) };
54240567d680SSteven Rostedt (VMware) 
54250567d680SSteven Rostedt (VMware) /**
5426ea806eb3SSteven Rostedt (VMware)  * ftrace_modify_direct_caller - modify ftrace nop directly
5427ea806eb3SSteven Rostedt (VMware)  * @entry: The ftrace hash entry of the direct helper for @rec
5428ea806eb3SSteven Rostedt (VMware)  * @rec: The record representing the function site to patch
5429ea806eb3SSteven Rostedt (VMware)  * @old_addr: The location that the site at @rec->ip currently calls
5430ea806eb3SSteven Rostedt (VMware)  * @new_addr: The location that the site at @rec->ip should call
5431ea806eb3SSteven Rostedt (VMware)  *
5432ea806eb3SSteven Rostedt (VMware)  * An architecture may overwrite this function to optimize the
5433ea806eb3SSteven Rostedt (VMware)  * changing of the direct callback on an ftrace nop location.
5434ea806eb3SSteven Rostedt (VMware)  * This is called with the ftrace_lock mutex held, and no other
5435ea806eb3SSteven Rostedt (VMware)  * ftrace callbacks are on the associated record (@rec). Thus,
5436ea806eb3SSteven Rostedt (VMware)  * it is safe to modify the ftrace record, where it should be
5437ea806eb3SSteven Rostedt (VMware)  * currently calling @old_addr directly, to call @new_addr.
5438ea806eb3SSteven Rostedt (VMware)  *
54399d2ce78dSSong Liu  * This is called with direct_mutex locked.
54409d2ce78dSSong Liu  *
5441ea806eb3SSteven Rostedt (VMware)  * Safety checks should be made to make sure that the code at
5442ea806eb3SSteven Rostedt (VMware)  * @rec->ip is currently calling @old_addr. And this must
5443ea806eb3SSteven Rostedt (VMware)  * also update entry->direct to @new_addr.
5444ea806eb3SSteven Rostedt (VMware)  */
5445ea806eb3SSteven Rostedt (VMware) int __weak ftrace_modify_direct_caller(struct ftrace_func_entry *entry,
5446ea806eb3SSteven Rostedt (VMware) 				       struct dyn_ftrace *rec,
5447ea806eb3SSteven Rostedt (VMware) 				       unsigned long old_addr,
5448ea806eb3SSteven Rostedt (VMware) 				       unsigned long new_addr)
5449ea806eb3SSteven Rostedt (VMware) {
5450ea806eb3SSteven Rostedt (VMware) 	unsigned long ip = rec->ip;
5451ea806eb3SSteven Rostedt (VMware) 	int ret;
5452ea806eb3SSteven Rostedt (VMware) 
54539d2ce78dSSong Liu 	lockdep_assert_held(&direct_mutex);
54549d2ce78dSSong Liu 
5455ea806eb3SSteven Rostedt (VMware) 	/*
5456ea806eb3SSteven Rostedt (VMware) 	 * The ftrace_lock was used to determine if the record
5457ea806eb3SSteven Rostedt (VMware) 	 * had more than one registered user to it. If it did,
5458ea806eb3SSteven Rostedt (VMware) 	 * we needed to prevent that from changing to do the quick
5459ea806eb3SSteven Rostedt (VMware) 	 * switch. But if it did not (only a direct caller was attached)
5460ea806eb3SSteven Rostedt (VMware) 	 * then this function is called. But this function can deal
5461ea806eb3SSteven Rostedt (VMware) 	 * with attached callers to the rec that we care about, and
5462ea806eb3SSteven Rostedt (VMware) 	 * since this function uses standard ftrace calls that take
5463ea806eb3SSteven Rostedt (VMware) 	 * the ftrace_lock mutex, we need to release it.
5464ea806eb3SSteven Rostedt (VMware) 	 */
5465ea806eb3SSteven Rostedt (VMware) 	mutex_unlock(&ftrace_lock);
5466ea806eb3SSteven Rostedt (VMware) 
5467ea806eb3SSteven Rostedt (VMware) 	/*
5468ea806eb3SSteven Rostedt (VMware) 	 * By setting a stub function at the same address, we force
5469ea806eb3SSteven Rostedt (VMware) 	 * the code to call the iterator and the direct_ops helper.
5470ea806eb3SSteven Rostedt (VMware) 	 * This means that @ip does not call the direct call, and
5471ea806eb3SSteven Rostedt (VMware) 	 * we can simply modify it.
5472ea806eb3SSteven Rostedt (VMware) 	 */
5473ea806eb3SSteven Rostedt (VMware) 	ret = ftrace_set_filter_ip(&stub_ops, ip, 0, 0);
5474ea806eb3SSteven Rostedt (VMware) 	if (ret)
5475ea806eb3SSteven Rostedt (VMware) 		goto out_lock;
5476ea806eb3SSteven Rostedt (VMware) 
54779d2ce78dSSong Liu 	ret = register_ftrace_function_nolock(&stub_ops);
5478ea806eb3SSteven Rostedt (VMware) 	if (ret) {
5479ea806eb3SSteven Rostedt (VMware) 		ftrace_set_filter_ip(&stub_ops, ip, 1, 0);
5480ea806eb3SSteven Rostedt (VMware) 		goto out_lock;
5481ea806eb3SSteven Rostedt (VMware) 	}
5482ea806eb3SSteven Rostedt (VMware) 
5483ea806eb3SSteven Rostedt (VMware) 	entry->direct = new_addr;
5484ea806eb3SSteven Rostedt (VMware) 
5485ea806eb3SSteven Rostedt (VMware) 	/*
5486ea806eb3SSteven Rostedt (VMware) 	 * By removing the stub, we put back the direct call, calling
5487ea806eb3SSteven Rostedt (VMware) 	 * the @new_addr.
5488ea806eb3SSteven Rostedt (VMware) 	 */
5489ea806eb3SSteven Rostedt (VMware) 	unregister_ftrace_function(&stub_ops);
5490ea806eb3SSteven Rostedt (VMware) 	ftrace_set_filter_ip(&stub_ops, ip, 1, 0);
5491ea806eb3SSteven Rostedt (VMware) 
5492ea806eb3SSteven Rostedt (VMware)  out_lock:
5493ea806eb3SSteven Rostedt (VMware) 	mutex_lock(&ftrace_lock);
5494ea806eb3SSteven Rostedt (VMware) 
5495ea806eb3SSteven Rostedt (VMware) 	return ret;
5496ea806eb3SSteven Rostedt (VMware) }
5497ea806eb3SSteven Rostedt (VMware) 
5498ea806eb3SSteven Rostedt (VMware) /**
54990567d680SSteven Rostedt (VMware)  * modify_ftrace_direct - Modify an existing direct call to call something else
55000567d680SSteven Rostedt (VMware)  * @ip: The instruction pointer to modify
55010567d680SSteven Rostedt (VMware)  * @old_addr: The address that the current @ip calls directly
55020567d680SSteven Rostedt (VMware)  * @new_addr: The address that the @ip should call
55030567d680SSteven Rostedt (VMware)  *
55040567d680SSteven Rostedt (VMware)  * This modifies a ftrace direct caller at an instruction pointer without
55050567d680SSteven Rostedt (VMware)  * having to disable it first. The direct call will switch over to the
55060567d680SSteven Rostedt (VMware)  * @new_addr without missing anything.
55070567d680SSteven Rostedt (VMware)  *
55080567d680SSteven Rostedt (VMware)  * Returns: zero on success. Non zero on error, which includes:
55090567d680SSteven Rostedt (VMware)  *  -ENODEV : the @ip given has no direct caller attached
55100567d680SSteven Rostedt (VMware)  *  -EINVAL : the @old_addr does not match the current direct caller
55110567d680SSteven Rostedt (VMware)  */
55120567d680SSteven Rostedt (VMware) int modify_ftrace_direct(unsigned long ip,
55130567d680SSteven Rostedt (VMware) 			 unsigned long old_addr, unsigned long new_addr)
55140567d680SSteven Rostedt (VMware) {
55158a141dd7SAlexei Starovoitov 	struct ftrace_direct_func *direct, *new_direct = NULL;
55160567d680SSteven Rostedt (VMware) 	struct ftrace_func_entry *entry;
5517ea806eb3SSteven Rostedt (VMware) 	struct dyn_ftrace *rec;
55180567d680SSteven Rostedt (VMware) 	int ret = -ENODEV;
55190567d680SSteven Rostedt (VMware) 
55200567d680SSteven Rostedt (VMware) 	mutex_lock(&direct_mutex);
55210567d680SSteven Rostedt (VMware) 
5522ea806eb3SSteven Rostedt (VMware) 	mutex_lock(&ftrace_lock);
5523aebfd125SPeter Zijlstra 
5524aebfd125SPeter Zijlstra 	ip = ftrace_location(ip);
5525aebfd125SPeter Zijlstra 	if (!ip)
5526aebfd125SPeter Zijlstra 		goto out_unlock;
5527aebfd125SPeter Zijlstra 
5528ea806eb3SSteven Rostedt (VMware) 	entry = find_direct_entry(&ip, &rec);
55290567d680SSteven Rostedt (VMware) 	if (!entry)
55300567d680SSteven Rostedt (VMware) 		goto out_unlock;
55310567d680SSteven Rostedt (VMware) 
55320567d680SSteven Rostedt (VMware) 	ret = -EINVAL;
55330567d680SSteven Rostedt (VMware) 	if (entry->direct != old_addr)
55340567d680SSteven Rostedt (VMware) 		goto out_unlock;
55350567d680SSteven Rostedt (VMware) 
55368a141dd7SAlexei Starovoitov 	direct = ftrace_find_direct_func(old_addr);
55378a141dd7SAlexei Starovoitov 	if (WARN_ON(!direct))
55388a141dd7SAlexei Starovoitov 		goto out_unlock;
55398a141dd7SAlexei Starovoitov 	if (direct->count > 1) {
55408a141dd7SAlexei Starovoitov 		ret = -ENOMEM;
55418a141dd7SAlexei Starovoitov 		new_direct = ftrace_alloc_direct_func(new_addr);
55428a141dd7SAlexei Starovoitov 		if (!new_direct)
55438a141dd7SAlexei Starovoitov 			goto out_unlock;
55448a141dd7SAlexei Starovoitov 		direct->count--;
55458a141dd7SAlexei Starovoitov 		new_direct->count++;
55468a141dd7SAlexei Starovoitov 	} else {
55478a141dd7SAlexei Starovoitov 		direct->addr = new_addr;
55488a141dd7SAlexei Starovoitov 	}
55498a141dd7SAlexei Starovoitov 
55500567d680SSteven Rostedt (VMware) 	/*
5551ea806eb3SSteven Rostedt (VMware) 	 * If there's no other ftrace callback on the rec->ip location,
5552ea806eb3SSteven Rostedt (VMware) 	 * then it can be changed directly by the architecture.
5553ea806eb3SSteven Rostedt (VMware) 	 * If there is another caller, then we just need to change the
5554ea806eb3SSteven Rostedt (VMware) 	 * direct caller helper to point to @new_addr.
55550567d680SSteven Rostedt (VMware) 	 */
5556ea806eb3SSteven Rostedt (VMware) 	if (ftrace_rec_count(rec) == 1) {
5557ea806eb3SSteven Rostedt (VMware) 		ret = ftrace_modify_direct_caller(entry, rec, old_addr, new_addr);
5558ea806eb3SSteven Rostedt (VMware) 	} else {
5559ea806eb3SSteven Rostedt (VMware) 		entry->direct = new_addr;
5560ea806eb3SSteven Rostedt (VMware) 		ret = 0;
55610567d680SSteven Rostedt (VMware) 	}
55620567d680SSteven Rostedt (VMware) 
55638a141dd7SAlexei Starovoitov 	if (unlikely(ret && new_direct)) {
55648a141dd7SAlexei Starovoitov 		direct->count++;
55658a141dd7SAlexei Starovoitov 		list_del_rcu(&new_direct->next);
55668a141dd7SAlexei Starovoitov 		synchronize_rcu_tasks();
55678a141dd7SAlexei Starovoitov 		kfree(new_direct);
55688a141dd7SAlexei Starovoitov 		ftrace_direct_func_count--;
55698a141dd7SAlexei Starovoitov 	}
55708a141dd7SAlexei Starovoitov 
55710567d680SSteven Rostedt (VMware)  out_unlock:
5572ea806eb3SSteven Rostedt (VMware) 	mutex_unlock(&ftrace_lock);
55730567d680SSteven Rostedt (VMware) 	mutex_unlock(&direct_mutex);
55740567d680SSteven Rostedt (VMware) 	return ret;
55750567d680SSteven Rostedt (VMware) }
55760567d680SSteven Rostedt (VMware) EXPORT_SYMBOL_GPL(modify_ftrace_direct);
5577f64dd462SJiri Olsa 
557853cd885bSSong Liu #define MULTI_FLAGS (FTRACE_OPS_FL_DIRECT | FTRACE_OPS_FL_SAVE_REGS)
5579f64dd462SJiri Olsa 
5580f64dd462SJiri Olsa static int check_direct_multi(struct ftrace_ops *ops)
5581f64dd462SJiri Olsa {
5582f64dd462SJiri Olsa 	if (!(ops->flags & FTRACE_OPS_FL_INITIALIZED))
5583f64dd462SJiri Olsa 		return -EINVAL;
5584f64dd462SJiri Olsa 	if ((ops->flags & MULTI_FLAGS) != MULTI_FLAGS)
5585f64dd462SJiri Olsa 		return -EINVAL;
5586f64dd462SJiri Olsa 	return 0;
5587f64dd462SJiri Olsa }
5588f64dd462SJiri Olsa 
5589f64dd462SJiri Olsa static void remove_direct_functions_hash(struct ftrace_hash *hash, unsigned long addr)
5590f64dd462SJiri Olsa {
5591f64dd462SJiri Olsa 	struct ftrace_func_entry *entry, *del;
5592f64dd462SJiri Olsa 	int size, i;
5593f64dd462SJiri Olsa 
5594f64dd462SJiri Olsa 	size = 1 << hash->size_bits;
5595f64dd462SJiri Olsa 	for (i = 0; i < size; i++) {
5596f64dd462SJiri Olsa 		hlist_for_each_entry(entry, &hash->buckets[i], hlist) {
5597f64dd462SJiri Olsa 			del = __ftrace_lookup_ip(direct_functions, entry->ip);
5598f64dd462SJiri Olsa 			if (del && del->direct == addr) {
5599f64dd462SJiri Olsa 				remove_hash_entry(direct_functions, del);
5600f64dd462SJiri Olsa 				kfree(del);
5601f64dd462SJiri Olsa 			}
5602f64dd462SJiri Olsa 		}
5603f64dd462SJiri Olsa 	}
5604f64dd462SJiri Olsa }
5605f64dd462SJiri Olsa 
5606f64dd462SJiri Olsa /**
5607f64dd462SJiri Olsa  * register_ftrace_direct_multi - Call a custom trampoline directly
5608f64dd462SJiri Olsa  * for multiple functions registered in @ops
5609f64dd462SJiri Olsa  * @ops: The address of the struct ftrace_ops object
5610f64dd462SJiri Olsa  * @addr: The address of the trampoline to call at @ops functions
5611f64dd462SJiri Olsa  *
5612f64dd462SJiri Olsa  * This is used to connect a direct calls to @addr from the nop locations
5613f64dd462SJiri Olsa  * of the functions registered in @ops (with by ftrace_set_filter_ip
5614f64dd462SJiri Olsa  * function).
5615f64dd462SJiri Olsa  *
5616f64dd462SJiri Olsa  * The location that it calls (@addr) must be able to handle a direct call,
5617f64dd462SJiri Olsa  * and save the parameters of the function being traced, and restore them
5618f64dd462SJiri Olsa  * (or inject new ones if needed), before returning.
5619f64dd462SJiri Olsa  *
5620f64dd462SJiri Olsa  * Returns:
5621f64dd462SJiri Olsa  *  0 on success
5622f64dd462SJiri Olsa  *  -EINVAL  - The @ops object was already registered with this call or
5623f64dd462SJiri Olsa  *             when there are no functions in @ops object.
5624f64dd462SJiri Olsa  *  -EBUSY   - Another direct function is already attached (there can be only one)
5625f64dd462SJiri Olsa  *  -ENODEV  - @ip does not point to a ftrace nop location (or not supported)
5626f64dd462SJiri Olsa  *  -ENOMEM  - There was an allocation failure.
5627f64dd462SJiri Olsa  */
5628f64dd462SJiri Olsa int register_ftrace_direct_multi(struct ftrace_ops *ops, unsigned long addr)
5629f64dd462SJiri Olsa {
5630f64dd462SJiri Olsa 	struct ftrace_hash *hash, *free_hash = NULL;
5631f64dd462SJiri Olsa 	struct ftrace_func_entry *entry, *new;
5632f64dd462SJiri Olsa 	int err = -EBUSY, size, i;
5633f64dd462SJiri Olsa 
5634f64dd462SJiri Olsa 	if (ops->func || ops->trampoline)
5635f64dd462SJiri Olsa 		return -EINVAL;
5636f64dd462SJiri Olsa 	if (!(ops->flags & FTRACE_OPS_FL_INITIALIZED))
5637f64dd462SJiri Olsa 		return -EINVAL;
5638f64dd462SJiri Olsa 	if (ops->flags & FTRACE_OPS_FL_ENABLED)
5639f64dd462SJiri Olsa 		return -EINVAL;
5640f64dd462SJiri Olsa 
5641f64dd462SJiri Olsa 	hash = ops->func_hash->filter_hash;
5642f64dd462SJiri Olsa 	if (ftrace_hash_empty(hash))
5643f64dd462SJiri Olsa 		return -EINVAL;
5644f64dd462SJiri Olsa 
5645f64dd462SJiri Olsa 	mutex_lock(&direct_mutex);
5646f64dd462SJiri Olsa 
5647f64dd462SJiri Olsa 	/* Make sure requested entries are not already registered.. */
5648f64dd462SJiri Olsa 	size = 1 << hash->size_bits;
5649f64dd462SJiri Olsa 	for (i = 0; i < size; i++) {
5650f64dd462SJiri Olsa 		hlist_for_each_entry(entry, &hash->buckets[i], hlist) {
5651f64dd462SJiri Olsa 			if (ftrace_find_rec_direct(entry->ip))
5652f64dd462SJiri Olsa 				goto out_unlock;
5653f64dd462SJiri Olsa 		}
5654f64dd462SJiri Olsa 	}
5655f64dd462SJiri Olsa 
5656f64dd462SJiri Olsa 	/* ... and insert them to direct_functions hash. */
5657f64dd462SJiri Olsa 	err = -ENOMEM;
5658f64dd462SJiri Olsa 	for (i = 0; i < size; i++) {
5659f64dd462SJiri Olsa 		hlist_for_each_entry(entry, &hash->buckets[i], hlist) {
5660f64dd462SJiri Olsa 			new = ftrace_add_rec_direct(entry->ip, addr, &free_hash);
5661f64dd462SJiri Olsa 			if (!new)
5662f64dd462SJiri Olsa 				goto out_remove;
5663f64dd462SJiri Olsa 			entry->direct = addr;
5664f64dd462SJiri Olsa 		}
5665f64dd462SJiri Olsa 	}
5666f64dd462SJiri Olsa 
5667f64dd462SJiri Olsa 	ops->func = call_direct_funcs;
5668f64dd462SJiri Olsa 	ops->flags = MULTI_FLAGS;
5669f64dd462SJiri Olsa 	ops->trampoline = FTRACE_REGS_ADDR;
5670f64dd462SJiri Olsa 
567153cd885bSSong Liu 	err = register_ftrace_function_nolock(ops);
5672f64dd462SJiri Olsa 
5673f64dd462SJiri Olsa  out_remove:
5674f64dd462SJiri Olsa 	if (err)
5675f64dd462SJiri Olsa 		remove_direct_functions_hash(hash, addr);
5676f64dd462SJiri Olsa 
5677f64dd462SJiri Olsa  out_unlock:
5678f64dd462SJiri Olsa 	mutex_unlock(&direct_mutex);
5679f64dd462SJiri Olsa 
5680f64dd462SJiri Olsa 	if (free_hash) {
5681f64dd462SJiri Olsa 		synchronize_rcu_tasks();
5682f64dd462SJiri Olsa 		free_ftrace_hash(free_hash);
5683f64dd462SJiri Olsa 	}
5684f64dd462SJiri Olsa 	return err;
5685f64dd462SJiri Olsa }
5686f64dd462SJiri Olsa EXPORT_SYMBOL_GPL(register_ftrace_direct_multi);
5687f64dd462SJiri Olsa 
5688f64dd462SJiri Olsa /**
5689f64dd462SJiri Olsa  * unregister_ftrace_direct_multi - Remove calls to custom trampoline
5690f64dd462SJiri Olsa  * previously registered by register_ftrace_direct_multi for @ops object.
5691f64dd462SJiri Olsa  * @ops: The address of the struct ftrace_ops object
5692f64dd462SJiri Olsa  *
5693f64dd462SJiri Olsa  * This is used to remove a direct calls to @addr from the nop locations
5694f64dd462SJiri Olsa  * of the functions registered in @ops (with by ftrace_set_filter_ip
5695f64dd462SJiri Olsa  * function).
5696f64dd462SJiri Olsa  *
5697f64dd462SJiri Olsa  * Returns:
5698f64dd462SJiri Olsa  *  0 on success
5699f64dd462SJiri Olsa  *  -EINVAL - The @ops object was not properly registered.
5700f64dd462SJiri Olsa  */
5701f64dd462SJiri Olsa int unregister_ftrace_direct_multi(struct ftrace_ops *ops, unsigned long addr)
5702f64dd462SJiri Olsa {
5703f64dd462SJiri Olsa 	struct ftrace_hash *hash = ops->func_hash->filter_hash;
5704f64dd462SJiri Olsa 	int err;
5705f64dd462SJiri Olsa 
5706f64dd462SJiri Olsa 	if (check_direct_multi(ops))
5707f64dd462SJiri Olsa 		return -EINVAL;
5708f64dd462SJiri Olsa 	if (!(ops->flags & FTRACE_OPS_FL_ENABLED))
5709f64dd462SJiri Olsa 		return -EINVAL;
5710f64dd462SJiri Olsa 
5711f64dd462SJiri Olsa 	mutex_lock(&direct_mutex);
5712f64dd462SJiri Olsa 	err = unregister_ftrace_function(ops);
5713f64dd462SJiri Olsa 	remove_direct_functions_hash(hash, addr);
5714f64dd462SJiri Olsa 	mutex_unlock(&direct_mutex);
5715fea3ffa4SJiri Olsa 
5716fea3ffa4SJiri Olsa 	/* cleanup for possible another register call */
5717fea3ffa4SJiri Olsa 	ops->func = NULL;
5718fea3ffa4SJiri Olsa 	ops->trampoline = 0;
5719f64dd462SJiri Olsa 	return err;
5720f64dd462SJiri Olsa }
5721f64dd462SJiri Olsa EXPORT_SYMBOL_GPL(unregister_ftrace_direct_multi);
5722ccf5a89eSJiri Olsa 
5723f96f644aSSong Liu static int
5724f96f644aSSong Liu __modify_ftrace_direct_multi(struct ftrace_ops *ops, unsigned long addr)
5725ccf5a89eSJiri Olsa {
5726ed292718SSteven Rostedt (VMware) 	struct ftrace_hash *hash;
5727ccf5a89eSJiri Olsa 	struct ftrace_func_entry *entry, *iter;
5728ed292718SSteven Rostedt (VMware) 	static struct ftrace_ops tmp_ops = {
5729ed292718SSteven Rostedt (VMware) 		.func		= ftrace_stub,
5730ed292718SSteven Rostedt (VMware) 		.flags		= FTRACE_OPS_FL_STUB,
5731ed292718SSteven Rostedt (VMware) 	};
5732ccf5a89eSJiri Olsa 	int i, size;
5733ccf5a89eSJiri Olsa 	int err;
5734ccf5a89eSJiri Olsa 
5735f96f644aSSong Liu 	lockdep_assert_held_once(&direct_mutex);
5736ed292718SSteven Rostedt (VMware) 
5737ed292718SSteven Rostedt (VMware) 	/* Enable the tmp_ops to have the same functions as the direct ops */
5738ed292718SSteven Rostedt (VMware) 	ftrace_ops_init(&tmp_ops);
5739ed292718SSteven Rostedt (VMware) 	tmp_ops.func_hash = ops->func_hash;
5740ed292718SSteven Rostedt (VMware) 
574153cd885bSSong Liu 	err = register_ftrace_function_nolock(&tmp_ops);
5742ed292718SSteven Rostedt (VMware) 	if (err)
5743f96f644aSSong Liu 		return err;
5744ccf5a89eSJiri Olsa 
5745ccf5a89eSJiri Olsa 	/*
5746ed292718SSteven Rostedt (VMware) 	 * Now the ftrace_ops_list_func() is called to do the direct callers.
5747ed292718SSteven Rostedt (VMware) 	 * We can safely change the direct functions attached to each entry.
5748ccf5a89eSJiri Olsa 	 */
5749ed292718SSteven Rostedt (VMware) 	mutex_lock(&ftrace_lock);
5750ccf5a89eSJiri Olsa 
5751ed292718SSteven Rostedt (VMware) 	hash = ops->func_hash->filter_hash;
5752ccf5a89eSJiri Olsa 	size = 1 << hash->size_bits;
5753ccf5a89eSJiri Olsa 	for (i = 0; i < size; i++) {
5754ccf5a89eSJiri Olsa 		hlist_for_each_entry(iter, &hash->buckets[i], hlist) {
5755ccf5a89eSJiri Olsa 			entry = __ftrace_lookup_ip(direct_functions, iter->ip);
5756ccf5a89eSJiri Olsa 			if (!entry)
5757ccf5a89eSJiri Olsa 				continue;
5758ccf5a89eSJiri Olsa 			entry->direct = addr;
5759ccf5a89eSJiri Olsa 		}
5760ccf5a89eSJiri Olsa 	}
5761ccf5a89eSJiri Olsa 
57622e6e9058SJiri Olsa 	mutex_unlock(&ftrace_lock);
57632e6e9058SJiri Olsa 
5764ed292718SSteven Rostedt (VMware) 	/* Removing the tmp_ops will add the updated direct callers to the functions */
5765ed292718SSteven Rostedt (VMware) 	unregister_ftrace_function(&tmp_ops);
5766ccf5a89eSJiri Olsa 
5767f96f644aSSong Liu 	return err;
5768f96f644aSSong Liu }
5769f96f644aSSong Liu 
5770f96f644aSSong Liu /**
5771f96f644aSSong Liu  * modify_ftrace_direct_multi_nolock - Modify an existing direct 'multi' call
5772f96f644aSSong Liu  * to call something else
5773f96f644aSSong Liu  * @ops: The address of the struct ftrace_ops object
5774f96f644aSSong Liu  * @addr: The address of the new trampoline to call at @ops functions
5775f96f644aSSong Liu  *
5776f96f644aSSong Liu  * This is used to unregister currently registered direct caller and
5777f96f644aSSong Liu  * register new one @addr on functions registered in @ops object.
5778f96f644aSSong Liu  *
5779f96f644aSSong Liu  * Note there's window between ftrace_shutdown and ftrace_startup calls
5780f96f644aSSong Liu  * where there will be no callbacks called.
5781f96f644aSSong Liu  *
5782f96f644aSSong Liu  * Caller should already have direct_mutex locked, so we don't lock
5783f96f644aSSong Liu  * direct_mutex here.
5784f96f644aSSong Liu  *
5785f96f644aSSong Liu  * Returns: zero on success. Non zero on error, which includes:
5786f96f644aSSong Liu  *  -EINVAL - The @ops object was not properly registered.
5787f96f644aSSong Liu  */
5788f96f644aSSong Liu int modify_ftrace_direct_multi_nolock(struct ftrace_ops *ops, unsigned long addr)
5789f96f644aSSong Liu {
5790f96f644aSSong Liu 	if (check_direct_multi(ops))
5791f96f644aSSong Liu 		return -EINVAL;
5792f96f644aSSong Liu 	if (!(ops->flags & FTRACE_OPS_FL_ENABLED))
5793f96f644aSSong Liu 		return -EINVAL;
5794f96f644aSSong Liu 
5795f96f644aSSong Liu 	return __modify_ftrace_direct_multi(ops, addr);
5796f96f644aSSong Liu }
5797f96f644aSSong Liu EXPORT_SYMBOL_GPL(modify_ftrace_direct_multi_nolock);
5798f96f644aSSong Liu 
5799f96f644aSSong Liu /**
5800f96f644aSSong Liu  * modify_ftrace_direct_multi - Modify an existing direct 'multi' call
5801f96f644aSSong Liu  * to call something else
5802f96f644aSSong Liu  * @ops: The address of the struct ftrace_ops object
5803f96f644aSSong Liu  * @addr: The address of the new trampoline to call at @ops functions
5804f96f644aSSong Liu  *
5805f96f644aSSong Liu  * This is used to unregister currently registered direct caller and
5806f96f644aSSong Liu  * register new one @addr on functions registered in @ops object.
5807f96f644aSSong Liu  *
5808f96f644aSSong Liu  * Note there's window between ftrace_shutdown and ftrace_startup calls
5809f96f644aSSong Liu  * where there will be no callbacks called.
5810f96f644aSSong Liu  *
5811f96f644aSSong Liu  * Returns: zero on success. Non zero on error, which includes:
5812f96f644aSSong Liu  *  -EINVAL - The @ops object was not properly registered.
5813f96f644aSSong Liu  */
5814f96f644aSSong Liu int modify_ftrace_direct_multi(struct ftrace_ops *ops, unsigned long addr)
5815f96f644aSSong Liu {
5816f96f644aSSong Liu 	int err;
5817f96f644aSSong Liu 
5818f96f644aSSong Liu 	if (check_direct_multi(ops))
5819f96f644aSSong Liu 		return -EINVAL;
5820f96f644aSSong Liu 	if (!(ops->flags & FTRACE_OPS_FL_ENABLED))
5821f96f644aSSong Liu 		return -EINVAL;
5822f96f644aSSong Liu 
5823f96f644aSSong Liu 	mutex_lock(&direct_mutex);
5824f96f644aSSong Liu 	err = __modify_ftrace_direct_multi(ops, addr);
5825ccf5a89eSJiri Olsa 	mutex_unlock(&direct_mutex);
5826ccf5a89eSJiri Olsa 	return err;
5827ccf5a89eSJiri Olsa }
5828ccf5a89eSJiri Olsa EXPORT_SYMBOL_GPL(modify_ftrace_direct_multi);
5829763e34e7SSteven Rostedt (VMware) #endif /* CONFIG_DYNAMIC_FTRACE_WITH_DIRECT_CALLS */
5830763e34e7SSteven Rostedt (VMware) 
5831647664eaSMasami Hiramatsu /**
5832647664eaSMasami Hiramatsu  * ftrace_set_filter_ip - set a function to filter on in ftrace by address
5833647664eaSMasami Hiramatsu  * @ops - the ops to set the filter with
5834647664eaSMasami Hiramatsu  * @ip - the address to add to or remove from the filter.
5835647664eaSMasami Hiramatsu  * @remove - non zero to remove the ip from the filter
5836647664eaSMasami Hiramatsu  * @reset - non zero to reset all filters before applying this filter.
5837647664eaSMasami Hiramatsu  *
5838647664eaSMasami Hiramatsu  * Filters denote which functions should be enabled when tracing is enabled
5839f2cc020dSIngo Molnar  * If @ip is NULL, it fails to update filter.
5840647664eaSMasami Hiramatsu  */
5841647664eaSMasami Hiramatsu int ftrace_set_filter_ip(struct ftrace_ops *ops, unsigned long ip,
5842647664eaSMasami Hiramatsu 			 int remove, int reset)
5843647664eaSMasami Hiramatsu {
5844f04f24fbSMasami Hiramatsu 	ftrace_ops_init(ops);
58454f554e95SJiri Olsa 	return ftrace_set_addr(ops, &ip, 1, remove, reset, 1);
5846647664eaSMasami Hiramatsu }
5847647664eaSMasami Hiramatsu EXPORT_SYMBOL_GPL(ftrace_set_filter_ip);
5848647664eaSMasami Hiramatsu 
5849d032ae89SJoel Fernandes /**
58504f554e95SJiri Olsa  * ftrace_set_filter_ips - set functions to filter on in ftrace by addresses
58514f554e95SJiri Olsa  * @ops - the ops to set the filter with
58524f554e95SJiri Olsa  * @ips - the array of addresses to add to or remove from the filter.
58534f554e95SJiri Olsa  * @cnt - the number of addresses in @ips
58544f554e95SJiri Olsa  * @remove - non zero to remove ips from the filter
58554f554e95SJiri Olsa  * @reset - non zero to reset all filters before applying this filter.
58564f554e95SJiri Olsa  *
58574f554e95SJiri Olsa  * Filters denote which functions should be enabled when tracing is enabled
58584f554e95SJiri Olsa  * If @ips array or any ip specified within is NULL , it fails to update filter.
58594f554e95SJiri Olsa  */
58604f554e95SJiri Olsa int ftrace_set_filter_ips(struct ftrace_ops *ops, unsigned long *ips,
58614f554e95SJiri Olsa 			  unsigned int cnt, int remove, int reset)
58624f554e95SJiri Olsa {
58634f554e95SJiri Olsa 	ftrace_ops_init(ops);
58644f554e95SJiri Olsa 	return ftrace_set_addr(ops, ips, cnt, remove, reset, 1);
58654f554e95SJiri Olsa }
58664f554e95SJiri Olsa EXPORT_SYMBOL_GPL(ftrace_set_filter_ips);
58674f554e95SJiri Olsa 
58684f554e95SJiri Olsa /**
5869d032ae89SJoel Fernandes  * ftrace_ops_set_global_filter - setup ops to use global filters
5870d032ae89SJoel Fernandes  * @ops - the ops which will use the global filters
5871d032ae89SJoel Fernandes  *
5872d032ae89SJoel Fernandes  * ftrace users who need global function trace filtering should call this.
5873d032ae89SJoel Fernandes  * It can set the global filter only if ops were not initialized before.
5874d032ae89SJoel Fernandes  */
5875d032ae89SJoel Fernandes void ftrace_ops_set_global_filter(struct ftrace_ops *ops)
5876d032ae89SJoel Fernandes {
5877d032ae89SJoel Fernandes 	if (ops->flags & FTRACE_OPS_FL_INITIALIZED)
5878d032ae89SJoel Fernandes 		return;
5879d032ae89SJoel Fernandes 
5880d032ae89SJoel Fernandes 	ftrace_ops_init(ops);
5881d032ae89SJoel Fernandes 	ops->func_hash = &global_ops.local_hash;
5882d032ae89SJoel Fernandes }
5883d032ae89SJoel Fernandes EXPORT_SYMBOL_GPL(ftrace_ops_set_global_filter);
5884d032ae89SJoel Fernandes 
5885647664eaSMasami Hiramatsu static int
5886647664eaSMasami Hiramatsu ftrace_set_regex(struct ftrace_ops *ops, unsigned char *buf, int len,
5887647664eaSMasami Hiramatsu 		 int reset, int enable)
5888647664eaSMasami Hiramatsu {
58894f554e95SJiri Olsa 	return ftrace_set_hash(ops, buf, len, NULL, 0, 0, reset, enable);
5890647664eaSMasami Hiramatsu }
5891647664eaSMasami Hiramatsu 
589277a2b37dSSteven Rostedt /**
589377a2b37dSSteven Rostedt  * ftrace_set_filter - set a function to filter on in ftrace
5894936e074bSSteven Rostedt  * @ops - the ops to set the filter with
589577a2b37dSSteven Rostedt  * @buf - the string that holds the function filter text.
589677a2b37dSSteven Rostedt  * @len - the length of the string.
589777a2b37dSSteven Rostedt  * @reset - non zero to reset all filters before applying this filter.
589877a2b37dSSteven Rostedt  *
589977a2b37dSSteven Rostedt  * Filters denote which functions should be enabled when tracing is enabled.
590077a2b37dSSteven Rostedt  * If @buf is NULL and reset is set, all functions will be enabled for tracing.
590177a2b37dSSteven Rostedt  */
5902ac483c44SJiri Olsa int ftrace_set_filter(struct ftrace_ops *ops, unsigned char *buf,
5903936e074bSSteven Rostedt 		       int len, int reset)
590477a2b37dSSteven Rostedt {
5905f04f24fbSMasami Hiramatsu 	ftrace_ops_init(ops);
5906ac483c44SJiri Olsa 	return ftrace_set_regex(ops, buf, len, reset, 1);
590741c52c0dSSteven Rostedt }
5908936e074bSSteven Rostedt EXPORT_SYMBOL_GPL(ftrace_set_filter);
59094eebcc81SSteven Rostedt 
591041c52c0dSSteven Rostedt /**
591141c52c0dSSteven Rostedt  * ftrace_set_notrace - set a function to not trace in ftrace
5912936e074bSSteven Rostedt  * @ops - the ops to set the notrace filter with
591341c52c0dSSteven Rostedt  * @buf - the string that holds the function notrace text.
591441c52c0dSSteven Rostedt  * @len - the length of the string.
591541c52c0dSSteven Rostedt  * @reset - non zero to reset all filters before applying this filter.
591641c52c0dSSteven Rostedt  *
591741c52c0dSSteven Rostedt  * Notrace Filters denote which functions should not be enabled when tracing
591841c52c0dSSteven Rostedt  * is enabled. If @buf is NULL and reset is set, all functions will be enabled
591941c52c0dSSteven Rostedt  * for tracing.
592041c52c0dSSteven Rostedt  */
5921ac483c44SJiri Olsa int ftrace_set_notrace(struct ftrace_ops *ops, unsigned char *buf,
5922936e074bSSteven Rostedt 			int len, int reset)
5923936e074bSSteven Rostedt {
5924f04f24fbSMasami Hiramatsu 	ftrace_ops_init(ops);
5925ac483c44SJiri Olsa 	return ftrace_set_regex(ops, buf, len, reset, 0);
5926936e074bSSteven Rostedt }
5927936e074bSSteven Rostedt EXPORT_SYMBOL_GPL(ftrace_set_notrace);
5928936e074bSSteven Rostedt /**
59298d1b065dSJiaxing Wang  * ftrace_set_global_filter - set a function to filter on with global tracers
5930936e074bSSteven Rostedt  * @buf - the string that holds the function filter text.
5931936e074bSSteven Rostedt  * @len - the length of the string.
5932936e074bSSteven Rostedt  * @reset - non zero to reset all filters before applying this filter.
5933936e074bSSteven Rostedt  *
5934936e074bSSteven Rostedt  * Filters denote which functions should be enabled when tracing is enabled.
5935936e074bSSteven Rostedt  * If @buf is NULL and reset is set, all functions will be enabled for tracing.
5936936e074bSSteven Rostedt  */
5937936e074bSSteven Rostedt void ftrace_set_global_filter(unsigned char *buf, int len, int reset)
5938936e074bSSteven Rostedt {
5939936e074bSSteven Rostedt 	ftrace_set_regex(&global_ops, buf, len, reset, 1);
5940936e074bSSteven Rostedt }
5941936e074bSSteven Rostedt EXPORT_SYMBOL_GPL(ftrace_set_global_filter);
5942936e074bSSteven Rostedt 
5943936e074bSSteven Rostedt /**
59448d1b065dSJiaxing Wang  * ftrace_set_global_notrace - set a function to not trace with global tracers
5945936e074bSSteven Rostedt  * @buf - the string that holds the function notrace text.
5946936e074bSSteven Rostedt  * @len - the length of the string.
5947936e074bSSteven Rostedt  * @reset - non zero to reset all filters before applying this filter.
5948936e074bSSteven Rostedt  *
5949936e074bSSteven Rostedt  * Notrace Filters denote which functions should not be enabled when tracing
5950936e074bSSteven Rostedt  * is enabled. If @buf is NULL and reset is set, all functions will be enabled
5951936e074bSSteven Rostedt  * for tracing.
5952936e074bSSteven Rostedt  */
5953936e074bSSteven Rostedt void ftrace_set_global_notrace(unsigned char *buf, int len, int reset)
595441c52c0dSSteven Rostedt {
5955f45948e8SSteven Rostedt 	ftrace_set_regex(&global_ops, buf, len, reset, 0);
595677a2b37dSSteven Rostedt }
5957936e074bSSteven Rostedt EXPORT_SYMBOL_GPL(ftrace_set_global_notrace);
595877a2b37dSSteven Rostedt 
59592af15d6aSSteven Rostedt /*
59602af15d6aSSteven Rostedt  * command line interface to allow users to set filters on boot up.
59612af15d6aSSteven Rostedt  */
59622af15d6aSSteven Rostedt #define FTRACE_FILTER_SIZE		COMMAND_LINE_SIZE
59632af15d6aSSteven Rostedt static char ftrace_notrace_buf[FTRACE_FILTER_SIZE] __initdata;
59642af15d6aSSteven Rostedt static char ftrace_filter_buf[FTRACE_FILTER_SIZE] __initdata;
59652af15d6aSSteven Rostedt 
5966f1ed7c74SSteven Rostedt (Red Hat) /* Used by function selftest to not test if filter is set */
5967f1ed7c74SSteven Rostedt (Red Hat) bool ftrace_filter_param __initdata;
5968f1ed7c74SSteven Rostedt (Red Hat) 
59692af15d6aSSteven Rostedt static int __init set_ftrace_notrace(char *str)
59702af15d6aSSteven Rostedt {
5971f1ed7c74SSteven Rostedt (Red Hat) 	ftrace_filter_param = true;
597275761cc1SChen Gang 	strlcpy(ftrace_notrace_buf, str, FTRACE_FILTER_SIZE);
59732af15d6aSSteven Rostedt 	return 1;
59742af15d6aSSteven Rostedt }
59752af15d6aSSteven Rostedt __setup("ftrace_notrace=", set_ftrace_notrace);
59762af15d6aSSteven Rostedt 
59772af15d6aSSteven Rostedt static int __init set_ftrace_filter(char *str)
59782af15d6aSSteven Rostedt {
5979f1ed7c74SSteven Rostedt (Red Hat) 	ftrace_filter_param = true;
598075761cc1SChen Gang 	strlcpy(ftrace_filter_buf, str, FTRACE_FILTER_SIZE);
59812af15d6aSSteven Rostedt 	return 1;
59822af15d6aSSteven Rostedt }
59832af15d6aSSteven Rostedt __setup("ftrace_filter=", set_ftrace_filter);
59842af15d6aSSteven Rostedt 
5985369bc18fSStefan Assmann #ifdef CONFIG_FUNCTION_GRAPH_TRACER
5986f6060f46SLai Jiangshan static char ftrace_graph_buf[FTRACE_FILTER_SIZE] __initdata;
59870d7d9a16SNamhyung Kim static char ftrace_graph_notrace_buf[FTRACE_FILTER_SIZE] __initdata;
5988b9b0c831SNamhyung Kim static int ftrace_graph_set_hash(struct ftrace_hash *hash, char *buffer);
5989801c29fdSSteven Rostedt 
5990369bc18fSStefan Assmann static int __init set_graph_function(char *str)
5991369bc18fSStefan Assmann {
599206f43d66SFrederic Weisbecker 	strlcpy(ftrace_graph_buf, str, FTRACE_FILTER_SIZE);
5993369bc18fSStefan Assmann 	return 1;
5994369bc18fSStefan Assmann }
5995369bc18fSStefan Assmann __setup("ftrace_graph_filter=", set_graph_function);
5996369bc18fSStefan Assmann 
59970d7d9a16SNamhyung Kim static int __init set_graph_notrace_function(char *str)
59980d7d9a16SNamhyung Kim {
59990d7d9a16SNamhyung Kim 	strlcpy(ftrace_graph_notrace_buf, str, FTRACE_FILTER_SIZE);
60000d7d9a16SNamhyung Kim 	return 1;
60010d7d9a16SNamhyung Kim }
60020d7d9a16SNamhyung Kim __setup("ftrace_graph_notrace=", set_graph_notrace_function);
60030d7d9a16SNamhyung Kim 
600465a50c65STodd Brandt static int __init set_graph_max_depth_function(char *str)
600565a50c65STodd Brandt {
600665a50c65STodd Brandt 	if (!str)
600765a50c65STodd Brandt 		return 0;
600865a50c65STodd Brandt 	fgraph_max_depth = simple_strtoul(str, NULL, 0);
600965a50c65STodd Brandt 	return 1;
601065a50c65STodd Brandt }
601165a50c65STodd Brandt __setup("ftrace_graph_max_depth=", set_graph_max_depth_function);
601265a50c65STodd Brandt 
60130d7d9a16SNamhyung Kim static void __init set_ftrace_early_graph(char *buf, int enable)
6014369bc18fSStefan Assmann {
6015369bc18fSStefan Assmann 	int ret;
6016369bc18fSStefan Assmann 	char *func;
6017b9b0c831SNamhyung Kim 	struct ftrace_hash *hash;
60180d7d9a16SNamhyung Kim 
601992ad18ecSSteven Rostedt (VMware) 	hash = alloc_ftrace_hash(FTRACE_HASH_DEFAULT_BITS);
602024589e3aSSteven Rostedt (VMware) 	if (MEM_FAIL(!hash, "Failed to allocate hash\n"))
602192ad18ecSSteven Rostedt (VMware) 		return;
6022369bc18fSStefan Assmann 
6023369bc18fSStefan Assmann 	while (buf) {
6024369bc18fSStefan Assmann 		func = strsep(&buf, ",");
6025369bc18fSStefan Assmann 		/* we allow only one expression at a time */
6026b9b0c831SNamhyung Kim 		ret = ftrace_graph_set_hash(hash, func);
6027369bc18fSStefan Assmann 		if (ret)
6028369bc18fSStefan Assmann 			printk(KERN_DEBUG "ftrace: function %s not "
6029369bc18fSStefan Assmann 					  "traceable\n", func);
6030369bc18fSStefan Assmann 	}
603192ad18ecSSteven Rostedt (VMware) 
603292ad18ecSSteven Rostedt (VMware) 	if (enable)
603392ad18ecSSteven Rostedt (VMware) 		ftrace_graph_hash = hash;
603492ad18ecSSteven Rostedt (VMware) 	else
603592ad18ecSSteven Rostedt (VMware) 		ftrace_graph_notrace_hash = hash;
6036369bc18fSStefan Assmann }
6037369bc18fSStefan Assmann #endif /* CONFIG_FUNCTION_GRAPH_TRACER */
6038369bc18fSStefan Assmann 
60392a85a37fSSteven Rostedt void __init
60402a85a37fSSteven Rostedt ftrace_set_early_filter(struct ftrace_ops *ops, char *buf, int enable)
60412af15d6aSSteven Rostedt {
60422af15d6aSSteven Rostedt 	char *func;
60432af15d6aSSteven Rostedt 
6044f04f24fbSMasami Hiramatsu 	ftrace_ops_init(ops);
6045f04f24fbSMasami Hiramatsu 
60462af15d6aSSteven Rostedt 	while (buf) {
60472af15d6aSSteven Rostedt 		func = strsep(&buf, ",");
6048f45948e8SSteven Rostedt 		ftrace_set_regex(ops, func, strlen(func), 0, enable);
60492af15d6aSSteven Rostedt 	}
60502af15d6aSSteven Rostedt }
60512af15d6aSSteven Rostedt 
60522af15d6aSSteven Rostedt static void __init set_ftrace_early_filters(void)
60532af15d6aSSteven Rostedt {
60542af15d6aSSteven Rostedt 	if (ftrace_filter_buf[0])
60552a85a37fSSteven Rostedt 		ftrace_set_early_filter(&global_ops, ftrace_filter_buf, 1);
60562af15d6aSSteven Rostedt 	if (ftrace_notrace_buf[0])
60572a85a37fSSteven Rostedt 		ftrace_set_early_filter(&global_ops, ftrace_notrace_buf, 0);
6058369bc18fSStefan Assmann #ifdef CONFIG_FUNCTION_GRAPH_TRACER
6059369bc18fSStefan Assmann 	if (ftrace_graph_buf[0])
60600d7d9a16SNamhyung Kim 		set_ftrace_early_graph(ftrace_graph_buf, 1);
60610d7d9a16SNamhyung Kim 	if (ftrace_graph_notrace_buf[0])
60620d7d9a16SNamhyung Kim 		set_ftrace_early_graph(ftrace_graph_notrace_buf, 0);
6063369bc18fSStefan Assmann #endif /* CONFIG_FUNCTION_GRAPH_TRACER */
60642af15d6aSSteven Rostedt }
60652af15d6aSSteven Rostedt 
6066fc13cb0cSSteven Rostedt int ftrace_regex_release(struct inode *inode, struct file *file)
60675072c59fSSteven Rostedt {
60685072c59fSSteven Rostedt 	struct seq_file *m = (struct seq_file *)file->private_data;
60695072c59fSSteven Rostedt 	struct ftrace_iterator *iter;
607033dc9b12SSteven Rostedt 	struct ftrace_hash **orig_hash;
6071689fd8b6S[email protected] 	struct trace_parser *parser;
6072ed926f9bSSteven Rostedt 	int filter_hash;
60735072c59fSSteven Rostedt 
60745072c59fSSteven Rostedt 	if (file->f_mode & FMODE_READ) {
60755072c59fSSteven Rostedt 		iter = m->private;
60765072c59fSSteven Rostedt 		seq_release(inode, file);
60775072c59fSSteven Rostedt 	} else
60785072c59fSSteven Rostedt 		iter = file->private_data;
60795072c59fSSteven Rostedt 
6080689fd8b6S[email protected] 	parser = &iter->parser;
6081689fd8b6S[email protected] 	if (trace_parser_loaded(parser)) {
60828c9af478SSteven Rostedt (VMware) 		int enable = !(iter->flags & FTRACE_ITER_NOTRACE);
60838c9af478SSteven Rostedt (VMware) 
60848c9af478SSteven Rostedt (VMware) 		ftrace_process_regex(iter, parser->buffer,
60858c9af478SSteven Rostedt (VMware) 				     parser->idx, enable);
60865072c59fSSteven Rostedt 	}
60875072c59fSSteven Rostedt 
6088058e297dSSteven Rostedt 	trace_parser_put(parser);
6089058e297dSSteven Rostedt 
609033b7f99cSSteven Rostedt (Red Hat) 	mutex_lock(&iter->ops->func_hash->regex_lock);
60913f2367baSMasami Hiramatsu 
6092058e297dSSteven Rostedt 	if (file->f_mode & FMODE_WRITE) {
6093ed926f9bSSteven Rostedt 		filter_hash = !!(iter->flags & FTRACE_ITER_FILTER);
6094ed926f9bSSteven Rostedt 
60958c08f0d5SSteven Rostedt (VMware) 		if (filter_hash) {
609633b7f99cSSteven Rostedt (Red Hat) 			orig_hash = &iter->ops->func_hash->filter_hash;
60970ce0638eSZheng Yejian 			if (iter->tr) {
60980ce0638eSZheng Yejian 				if (list_empty(&iter->tr->mod_trace))
60990ce0638eSZheng Yejian 					iter->hash->flags &= ~FTRACE_HASH_FL_MOD;
61000ce0638eSZheng Yejian 				else
61018c08f0d5SSteven Rostedt (VMware) 					iter->hash->flags |= FTRACE_HASH_FL_MOD;
61020ce0638eSZheng Yejian 			}
61038c08f0d5SSteven Rostedt (VMware) 		} else
610433b7f99cSSteven Rostedt (Red Hat) 			orig_hash = &iter->ops->func_hash->notrace_hash;
610533dc9b12SSteven Rostedt 
6106e6ea44e9SSteven Rostedt 		mutex_lock(&ftrace_lock);
6107045e269cSAlex Shi 		ftrace_hash_move_and_update_ops(iter->ops, orig_hash,
6108e16b35ddSSteven Rostedt (VMware) 						      iter->hash, filter_hash);
6109e6ea44e9SSteven Rostedt 		mutex_unlock(&ftrace_lock);
6110c20489daSSteven Rostedt (VMware) 	} else {
6111c20489daSSteven Rostedt (VMware) 		/* For read only, the hash is the ops hash */
6112c20489daSSteven Rostedt (VMware) 		iter->hash = NULL;
6113058e297dSSteven Rostedt 	}
61143f2367baSMasami Hiramatsu 
611533b7f99cSSteven Rostedt (Red Hat) 	mutex_unlock(&iter->ops->func_hash->regex_lock);
611633dc9b12SSteven Rostedt 	free_ftrace_hash(iter->hash);
61179ef16693SSteven Rostedt (VMware) 	if (iter->tr)
61189ef16693SSteven Rostedt (VMware) 		trace_array_put(iter->tr);
611933dc9b12SSteven Rostedt 	kfree(iter);
6120689fd8b6S[email protected] 
61215072c59fSSteven Rostedt 	return 0;
61225072c59fSSteven Rostedt }
61235072c59fSSteven Rostedt 
61245e2336a0SSteven Rostedt static const struct file_operations ftrace_avail_fops = {
61255072c59fSSteven Rostedt 	.open = ftrace_avail_open,
61265072c59fSSteven Rostedt 	.read = seq_read,
61275072c59fSSteven Rostedt 	.llseek = seq_lseek,
61283be04b47SLi Zefan 	.release = seq_release_private,
61295072c59fSSteven Rostedt };
61305072c59fSSteven Rostedt 
6131647bcd03SSteven Rostedt static const struct file_operations ftrace_enabled_fops = {
6132647bcd03SSteven Rostedt 	.open = ftrace_enabled_open,
6133647bcd03SSteven Rostedt 	.read = seq_read,
6134647bcd03SSteven Rostedt 	.llseek = seq_lseek,
6135647bcd03SSteven Rostedt 	.release = seq_release_private,
6136647bcd03SSteven Rostedt };
6137647bcd03SSteven Rostedt 
61385e2336a0SSteven Rostedt static const struct file_operations ftrace_filter_fops = {
61395072c59fSSteven Rostedt 	.open = ftrace_filter_open,
6140850a80cfSLai Jiangshan 	.read = seq_read,
61415072c59fSSteven Rostedt 	.write = ftrace_filter_write,
6142098c879eSSteven Rostedt (Red Hat) 	.llseek = tracing_lseek,
61431cf41dd7SSteven Rostedt 	.release = ftrace_regex_release,
61445072c59fSSteven Rostedt };
61455072c59fSSteven Rostedt 
61465e2336a0SSteven Rostedt static const struct file_operations ftrace_notrace_fops = {
614741c52c0dSSteven Rostedt 	.open = ftrace_notrace_open,
6148850a80cfSLai Jiangshan 	.read = seq_read,
614941c52c0dSSteven Rostedt 	.write = ftrace_notrace_write,
6150098c879eSSteven Rostedt (Red Hat) 	.llseek = tracing_lseek,
61511cf41dd7SSteven Rostedt 	.release = ftrace_regex_release,
615241c52c0dSSteven Rostedt };
615341c52c0dSSteven Rostedt 
6154ea4e2bc4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
6155ea4e2bc4SSteven Rostedt 
6156ea4e2bc4SSteven Rostedt static DEFINE_MUTEX(graph_lock);
6157ea4e2bc4SSteven Rostedt 
615824a9729fSAmol Grover struct ftrace_hash __rcu *ftrace_graph_hash = EMPTY_HASH;
6159fd0e6852SAmol Grover struct ftrace_hash __rcu *ftrace_graph_notrace_hash = EMPTY_HASH;
6160b9b0c831SNamhyung Kim 
6161b9b0c831SNamhyung Kim enum graph_filter_type {
6162b9b0c831SNamhyung Kim 	GRAPH_FILTER_NOTRACE	= 0,
6163b9b0c831SNamhyung Kim 	GRAPH_FILTER_FUNCTION,
6164b9b0c831SNamhyung Kim };
6165ea4e2bc4SSteven Rostedt 
6166555fc781SSteven Rostedt (VMware) #define FTRACE_GRAPH_EMPTY	((void *)1)
6167555fc781SSteven Rostedt (VMware) 
6168faf982a6SNamhyung Kim struct ftrace_graph_data {
6169b9b0c831SNamhyung Kim 	struct ftrace_hash		*hash;
6170b9b0c831SNamhyung Kim 	struct ftrace_func_entry	*entry;
6171b9b0c831SNamhyung Kim 	int				idx;   /* for hash table iteration */
6172b9b0c831SNamhyung Kim 	enum graph_filter_type		type;
6173b9b0c831SNamhyung Kim 	struct ftrace_hash		*new_hash;
6174faf982a6SNamhyung Kim 	const struct seq_operations	*seq_ops;
6175e704eff3SSteven Rostedt (VMware) 	struct trace_parser		parser;
6176faf982a6SNamhyung Kim };
6177faf982a6SNamhyung Kim 
6178ea4e2bc4SSteven Rostedt static void *
617985951842SLi Zefan __g_next(struct seq_file *m, loff_t *pos)
6180ea4e2bc4SSteven Rostedt {
6181faf982a6SNamhyung Kim 	struct ftrace_graph_data *fgd = m->private;
6182b9b0c831SNamhyung Kim 	struct ftrace_func_entry *entry = fgd->entry;
6183b9b0c831SNamhyung Kim 	struct hlist_head *head;
6184b9b0c831SNamhyung Kim 	int i, idx = fgd->idx;
6185faf982a6SNamhyung Kim 
6186b9b0c831SNamhyung Kim 	if (*pos >= fgd->hash->count)
6187ea4e2bc4SSteven Rostedt 		return NULL;
6188b9b0c831SNamhyung Kim 
6189b9b0c831SNamhyung Kim 	if (entry) {
6190b9b0c831SNamhyung Kim 		hlist_for_each_entry_continue(entry, hlist) {
6191b9b0c831SNamhyung Kim 			fgd->entry = entry;
6192b9b0c831SNamhyung Kim 			return entry;
6193b9b0c831SNamhyung Kim 		}
6194b9b0c831SNamhyung Kim 
6195b9b0c831SNamhyung Kim 		idx++;
6196b9b0c831SNamhyung Kim 	}
6197b9b0c831SNamhyung Kim 
6198b9b0c831SNamhyung Kim 	for (i = idx; i < 1 << fgd->hash->size_bits; i++) {
6199b9b0c831SNamhyung Kim 		head = &fgd->hash->buckets[i];
6200b9b0c831SNamhyung Kim 		hlist_for_each_entry(entry, head, hlist) {
6201b9b0c831SNamhyung Kim 			fgd->entry = entry;
6202b9b0c831SNamhyung Kim 			fgd->idx = i;
6203b9b0c831SNamhyung Kim 			return entry;
6204b9b0c831SNamhyung Kim 		}
6205b9b0c831SNamhyung Kim 	}
6206b9b0c831SNamhyung Kim 	return NULL;
620785951842SLi Zefan }
6208ea4e2bc4SSteven Rostedt 
620985951842SLi Zefan static void *
621085951842SLi Zefan g_next(struct seq_file *m, void *v, loff_t *pos)
621185951842SLi Zefan {
621285951842SLi Zefan 	(*pos)++;
621385951842SLi Zefan 	return __g_next(m, pos);
6214ea4e2bc4SSteven Rostedt }
6215ea4e2bc4SSteven Rostedt 
6216ea4e2bc4SSteven Rostedt static void *g_start(struct seq_file *m, loff_t *pos)
6217ea4e2bc4SSteven Rostedt {
6218faf982a6SNamhyung Kim 	struct ftrace_graph_data *fgd = m->private;
6219faf982a6SNamhyung Kim 
6220ea4e2bc4SSteven Rostedt 	mutex_lock(&graph_lock);
6221ea4e2bc4SSteven Rostedt 
6222649b988bSSteven Rostedt (VMware) 	if (fgd->type == GRAPH_FILTER_FUNCTION)
6223649b988bSSteven Rostedt (VMware) 		fgd->hash = rcu_dereference_protected(ftrace_graph_hash,
6224649b988bSSteven Rostedt (VMware) 					lockdep_is_held(&graph_lock));
6225649b988bSSteven Rostedt (VMware) 	else
6226649b988bSSteven Rostedt (VMware) 		fgd->hash = rcu_dereference_protected(ftrace_graph_notrace_hash,
6227649b988bSSteven Rostedt (VMware) 					lockdep_is_held(&graph_lock));
6228649b988bSSteven Rostedt (VMware) 
6229f9349a8fSFrederic Weisbecker 	/* Nothing, tell g_show to print all functions are enabled */
6230b9b0c831SNamhyung Kim 	if (ftrace_hash_empty(fgd->hash) && !*pos)
6231555fc781SSteven Rostedt (VMware) 		return FTRACE_GRAPH_EMPTY;
6232f9349a8fSFrederic Weisbecker 
6233b9b0c831SNamhyung Kim 	fgd->idx = 0;
6234b9b0c831SNamhyung Kim 	fgd->entry = NULL;
623585951842SLi Zefan 	return __g_next(m, pos);
6236ea4e2bc4SSteven Rostedt }
6237ea4e2bc4SSteven Rostedt 
6238ea4e2bc4SSteven Rostedt static void g_stop(struct seq_file *m, void *p)
6239ea4e2bc4SSteven Rostedt {
6240ea4e2bc4SSteven Rostedt 	mutex_unlock(&graph_lock);
6241ea4e2bc4SSteven Rostedt }
6242ea4e2bc4SSteven Rostedt 
6243ea4e2bc4SSteven Rostedt static int g_show(struct seq_file *m, void *v)
6244ea4e2bc4SSteven Rostedt {
6245b9b0c831SNamhyung Kim 	struct ftrace_func_entry *entry = v;
6246ea4e2bc4SSteven Rostedt 
6247b9b0c831SNamhyung Kim 	if (!entry)
6248ea4e2bc4SSteven Rostedt 		return 0;
6249ea4e2bc4SSteven Rostedt 
6250555fc781SSteven Rostedt (VMware) 	if (entry == FTRACE_GRAPH_EMPTY) {
6251280d1429SNamhyung Kim 		struct ftrace_graph_data *fgd = m->private;
6252280d1429SNamhyung Kim 
6253b9b0c831SNamhyung Kim 		if (fgd->type == GRAPH_FILTER_FUNCTION)
6254fa6f0cc7SRasmus Villemoes 			seq_puts(m, "#### all functions enabled ####\n");
6255280d1429SNamhyung Kim 		else
6256fa6f0cc7SRasmus Villemoes 			seq_puts(m, "#### no functions disabled ####\n");
6257f9349a8fSFrederic Weisbecker 		return 0;
6258f9349a8fSFrederic Weisbecker 	}
6259f9349a8fSFrederic Weisbecker 
6260b9b0c831SNamhyung Kim 	seq_printf(m, "%ps\n", (void *)entry->ip);
6261ea4e2bc4SSteven Rostedt 
6262ea4e2bc4SSteven Rostedt 	return 0;
6263ea4e2bc4SSteven Rostedt }
6264ea4e2bc4SSteven Rostedt 
626588e9d34cSJames Morris static const struct seq_operations ftrace_graph_seq_ops = {
6266ea4e2bc4SSteven Rostedt 	.start = g_start,
6267ea4e2bc4SSteven Rostedt 	.next = g_next,
6268ea4e2bc4SSteven Rostedt 	.stop = g_stop,
6269ea4e2bc4SSteven Rostedt 	.show = g_show,
6270ea4e2bc4SSteven Rostedt };
6271ea4e2bc4SSteven Rostedt 
6272ea4e2bc4SSteven Rostedt static int
6273faf982a6SNamhyung Kim __ftrace_graph_open(struct inode *inode, struct file *file,
6274faf982a6SNamhyung Kim 		    struct ftrace_graph_data *fgd)
6275ea4e2bc4SSteven Rostedt {
627617911ff3SSteven Rostedt (VMware) 	int ret;
6277b9b0c831SNamhyung Kim 	struct ftrace_hash *new_hash = NULL;
6278ea4e2bc4SSteven Rostedt 
627917911ff3SSteven Rostedt (VMware) 	ret = security_locked_down(LOCKDOWN_TRACEFS);
628017911ff3SSteven Rostedt (VMware) 	if (ret)
628117911ff3SSteven Rostedt (VMware) 		return ret;
628217911ff3SSteven Rostedt (VMware) 
6283b9b0c831SNamhyung Kim 	if (file->f_mode & FMODE_WRITE) {
6284b9b0c831SNamhyung Kim 		const int size_bits = FTRACE_HASH_DEFAULT_BITS;
6285b9b0c831SNamhyung Kim 
6286e704eff3SSteven Rostedt (VMware) 		if (trace_parser_get_init(&fgd->parser, FTRACE_BUFF_MAX))
6287e704eff3SSteven Rostedt (VMware) 			return -ENOMEM;
6288e704eff3SSteven Rostedt (VMware) 
6289b9b0c831SNamhyung Kim 		if (file->f_flags & O_TRUNC)
6290b9b0c831SNamhyung Kim 			new_hash = alloc_ftrace_hash(size_bits);
6291b9b0c831SNamhyung Kim 		else
6292b9b0c831SNamhyung Kim 			new_hash = alloc_and_copy_ftrace_hash(size_bits,
6293b9b0c831SNamhyung Kim 							      fgd->hash);
6294b9b0c831SNamhyung Kim 		if (!new_hash) {
6295b9b0c831SNamhyung Kim 			ret = -ENOMEM;
6296b9b0c831SNamhyung Kim 			goto out;
6297ea4e2bc4SSteven Rostedt 		}
6298b9b0c831SNamhyung Kim 	}
6299ea4e2bc4SSteven Rostedt 
6300faf982a6SNamhyung Kim 	if (file->f_mode & FMODE_READ) {
6301b9b0c831SNamhyung Kim 		ret = seq_open(file, &ftrace_graph_seq_ops);
6302faf982a6SNamhyung Kim 		if (!ret) {
6303faf982a6SNamhyung Kim 			struct seq_file *m = file->private_data;
6304faf982a6SNamhyung Kim 			m->private = fgd;
6305b9b0c831SNamhyung Kim 		} else {
6306b9b0c831SNamhyung Kim 			/* Failed */
6307b9b0c831SNamhyung Kim 			free_ftrace_hash(new_hash);
6308b9b0c831SNamhyung Kim 			new_hash = NULL;
6309faf982a6SNamhyung Kim 		}
6310faf982a6SNamhyung Kim 	} else
6311faf982a6SNamhyung Kim 		file->private_data = fgd;
6312a4ec5e0cSLi Zefan 
6313b9b0c831SNamhyung Kim out:
6314e704eff3SSteven Rostedt (VMware) 	if (ret < 0 && file->f_mode & FMODE_WRITE)
6315e704eff3SSteven Rostedt (VMware) 		trace_parser_put(&fgd->parser);
6316e704eff3SSteven Rostedt (VMware) 
6317b9b0c831SNamhyung Kim 	fgd->new_hash = new_hash;
6318649b988bSSteven Rostedt (VMware) 
6319649b988bSSteven Rostedt (VMware) 	/*
6320649b988bSSteven Rostedt (VMware) 	 * All uses of fgd->hash must be taken with the graph_lock
6321649b988bSSteven Rostedt (VMware) 	 * held. The graph_lock is going to be released, so force
6322649b988bSSteven Rostedt (VMware) 	 * fgd->hash to be reinitialized when it is taken again.
6323649b988bSSteven Rostedt (VMware) 	 */
6324649b988bSSteven Rostedt (VMware) 	fgd->hash = NULL;
6325649b988bSSteven Rostedt (VMware) 
6326ea4e2bc4SSteven Rostedt 	return ret;
6327ea4e2bc4SSteven Rostedt }
6328ea4e2bc4SSteven Rostedt 
6329ea4e2bc4SSteven Rostedt static int
6330faf982a6SNamhyung Kim ftrace_graph_open(struct inode *inode, struct file *file)
6331faf982a6SNamhyung Kim {
6332faf982a6SNamhyung Kim 	struct ftrace_graph_data *fgd;
6333b9b0c831SNamhyung Kim 	int ret;
6334faf982a6SNamhyung Kim 
6335faf982a6SNamhyung Kim 	if (unlikely(ftrace_disabled))
6336faf982a6SNamhyung Kim 		return -ENODEV;
6337faf982a6SNamhyung Kim 
6338faf982a6SNamhyung Kim 	fgd = kmalloc(sizeof(*fgd), GFP_KERNEL);
6339faf982a6SNamhyung Kim 	if (fgd == NULL)
6340faf982a6SNamhyung Kim 		return -ENOMEM;
6341faf982a6SNamhyung Kim 
6342b9b0c831SNamhyung Kim 	mutex_lock(&graph_lock);
6343b9b0c831SNamhyung Kim 
6344649b988bSSteven Rostedt (VMware) 	fgd->hash = rcu_dereference_protected(ftrace_graph_hash,
6345649b988bSSteven Rostedt (VMware) 					lockdep_is_held(&graph_lock));
6346b9b0c831SNamhyung Kim 	fgd->type = GRAPH_FILTER_FUNCTION;
6347faf982a6SNamhyung Kim 	fgd->seq_ops = &ftrace_graph_seq_ops;
6348faf982a6SNamhyung Kim 
6349b9b0c831SNamhyung Kim 	ret = __ftrace_graph_open(inode, file, fgd);
6350b9b0c831SNamhyung Kim 	if (ret < 0)
6351b9b0c831SNamhyung Kim 		kfree(fgd);
6352b9b0c831SNamhyung Kim 
6353b9b0c831SNamhyung Kim 	mutex_unlock(&graph_lock);
6354b9b0c831SNamhyung Kim 	return ret;
6355faf982a6SNamhyung Kim }
6356faf982a6SNamhyung Kim 
6357faf982a6SNamhyung Kim static int
635829ad23b0SNamhyung Kim ftrace_graph_notrace_open(struct inode *inode, struct file *file)
635929ad23b0SNamhyung Kim {
636029ad23b0SNamhyung Kim 	struct ftrace_graph_data *fgd;
6361b9b0c831SNamhyung Kim 	int ret;
636229ad23b0SNamhyung Kim 
636329ad23b0SNamhyung Kim 	if (unlikely(ftrace_disabled))
636429ad23b0SNamhyung Kim 		return -ENODEV;
636529ad23b0SNamhyung Kim 
636629ad23b0SNamhyung Kim 	fgd = kmalloc(sizeof(*fgd), GFP_KERNEL);
636729ad23b0SNamhyung Kim 	if (fgd == NULL)
636829ad23b0SNamhyung Kim 		return -ENOMEM;
636929ad23b0SNamhyung Kim 
6370b9b0c831SNamhyung Kim 	mutex_lock(&graph_lock);
6371b9b0c831SNamhyung Kim 
6372649b988bSSteven Rostedt (VMware) 	fgd->hash = rcu_dereference_protected(ftrace_graph_notrace_hash,
6373649b988bSSteven Rostedt (VMware) 					lockdep_is_held(&graph_lock));
6374b9b0c831SNamhyung Kim 	fgd->type = GRAPH_FILTER_NOTRACE;
637529ad23b0SNamhyung Kim 	fgd->seq_ops = &ftrace_graph_seq_ops;
637629ad23b0SNamhyung Kim 
6377b9b0c831SNamhyung Kim 	ret = __ftrace_graph_open(inode, file, fgd);
6378b9b0c831SNamhyung Kim 	if (ret < 0)
6379b9b0c831SNamhyung Kim 		kfree(fgd);
6380b9b0c831SNamhyung Kim 
6381b9b0c831SNamhyung Kim 	mutex_unlock(&graph_lock);
6382b9b0c831SNamhyung Kim 	return ret;
638329ad23b0SNamhyung Kim }
638429ad23b0SNamhyung Kim 
638529ad23b0SNamhyung Kim static int
638687827111SLi Zefan ftrace_graph_release(struct inode *inode, struct file *file)
638787827111SLi Zefan {
6388b9b0c831SNamhyung Kim 	struct ftrace_graph_data *fgd;
6389e704eff3SSteven Rostedt (VMware) 	struct ftrace_hash *old_hash, *new_hash;
6390e704eff3SSteven Rostedt (VMware) 	struct trace_parser *parser;
6391e704eff3SSteven Rostedt (VMware) 	int ret = 0;
6392b9b0c831SNamhyung Kim 
6393faf982a6SNamhyung Kim 	if (file->f_mode & FMODE_READ) {
6394faf982a6SNamhyung Kim 		struct seq_file *m = file->private_data;
6395faf982a6SNamhyung Kim 
6396b9b0c831SNamhyung Kim 		fgd = m->private;
639787827111SLi Zefan 		seq_release(inode, file);
6398faf982a6SNamhyung Kim 	} else {
6399b9b0c831SNamhyung Kim 		fgd = file->private_data;
6400faf982a6SNamhyung Kim 	}
6401faf982a6SNamhyung Kim 
6402e704eff3SSteven Rostedt (VMware) 
6403e704eff3SSteven Rostedt (VMware) 	if (file->f_mode & FMODE_WRITE) {
6404e704eff3SSteven Rostedt (VMware) 
6405e704eff3SSteven Rostedt (VMware) 		parser = &fgd->parser;
6406e704eff3SSteven Rostedt (VMware) 
6407e704eff3SSteven Rostedt (VMware) 		if (trace_parser_loaded((parser))) {
6408e704eff3SSteven Rostedt (VMware) 			ret = ftrace_graph_set_hash(fgd->new_hash,
6409e704eff3SSteven Rostedt (VMware) 						    parser->buffer);
6410e704eff3SSteven Rostedt (VMware) 		}
6411e704eff3SSteven Rostedt (VMware) 
6412e704eff3SSteven Rostedt (VMware) 		trace_parser_put(parser);
6413e704eff3SSteven Rostedt (VMware) 
6414e704eff3SSteven Rostedt (VMware) 		new_hash = __ftrace_hash_move(fgd->new_hash);
6415e704eff3SSteven Rostedt (VMware) 		if (!new_hash) {
6416e704eff3SSteven Rostedt (VMware) 			ret = -ENOMEM;
6417e704eff3SSteven Rostedt (VMware) 			goto out;
6418e704eff3SSteven Rostedt (VMware) 		}
6419e704eff3SSteven Rostedt (VMware) 
6420e704eff3SSteven Rostedt (VMware) 		mutex_lock(&graph_lock);
6421e704eff3SSteven Rostedt (VMware) 
6422e704eff3SSteven Rostedt (VMware) 		if (fgd->type == GRAPH_FILTER_FUNCTION) {
6423e704eff3SSteven Rostedt (VMware) 			old_hash = rcu_dereference_protected(ftrace_graph_hash,
6424e704eff3SSteven Rostedt (VMware) 					lockdep_is_held(&graph_lock));
6425e704eff3SSteven Rostedt (VMware) 			rcu_assign_pointer(ftrace_graph_hash, new_hash);
6426e704eff3SSteven Rostedt (VMware) 		} else {
6427e704eff3SSteven Rostedt (VMware) 			old_hash = rcu_dereference_protected(ftrace_graph_notrace_hash,
6428e704eff3SSteven Rostedt (VMware) 					lockdep_is_held(&graph_lock));
6429e704eff3SSteven Rostedt (VMware) 			rcu_assign_pointer(ftrace_graph_notrace_hash, new_hash);
6430e704eff3SSteven Rostedt (VMware) 		}
6431e704eff3SSteven Rostedt (VMware) 
6432e704eff3SSteven Rostedt (VMware) 		mutex_unlock(&graph_lock);
6433e704eff3SSteven Rostedt (VMware) 
643454a16ff6SSteven Rostedt (VMware) 		/*
643554a16ff6SSteven Rostedt (VMware) 		 * We need to do a hard force of sched synchronization.
643654a16ff6SSteven Rostedt (VMware) 		 * This is because we use preempt_disable() to do RCU, but
643754a16ff6SSteven Rostedt (VMware) 		 * the function tracers can be called where RCU is not watching
643854a16ff6SSteven Rostedt (VMware) 		 * (like before user_exit()). We can not rely on the RCU
643954a16ff6SSteven Rostedt (VMware) 		 * infrastructure to do the synchronization, thus we must do it
644054a16ff6SSteven Rostedt (VMware) 		 * ourselves.
644154a16ff6SSteven Rostedt (VMware) 		 */
644268e83498SNicolas Saenz Julienne 		if (old_hash != EMPTY_HASH)
6443e5a971d7SPaul E. McKenney 			synchronize_rcu_tasks_rude();
6444e704eff3SSteven Rostedt (VMware) 
6445e704eff3SSteven Rostedt (VMware) 		free_ftrace_hash(old_hash);
6446e704eff3SSteven Rostedt (VMware) 	}
6447e704eff3SSteven Rostedt (VMware) 
6448e704eff3SSteven Rostedt (VMware)  out:
6449f9797c2fSLuis Henriques 	free_ftrace_hash(fgd->new_hash);
6450b9b0c831SNamhyung Kim 	kfree(fgd);
6451b9b0c831SNamhyung Kim 
6452e704eff3SSteven Rostedt (VMware) 	return ret;
645387827111SLi Zefan }
645487827111SLi Zefan 
645587827111SLi Zefan static int
6456b9b0c831SNamhyung Kim ftrace_graph_set_hash(struct ftrace_hash *hash, char *buffer)
6457ea4e2bc4SSteven Rostedt {
64583ba00929SDmitry Safonov 	struct ftrace_glob func_g;
6459ea4e2bc4SSteven Rostedt 	struct dyn_ftrace *rec;
6460ea4e2bc4SSteven Rostedt 	struct ftrace_page *pg;
6461b9b0c831SNamhyung Kim 	struct ftrace_func_entry *entry;
6462c7c6b1feSLi Zefan 	int fail = 1;
64633ba00929SDmitry Safonov 	int not;
6464ea4e2bc4SSteven Rostedt 
6465f9349a8fSFrederic Weisbecker 	/* decode regex */
64663ba00929SDmitry Safonov 	func_g.type = filter_parse_regex(buffer, strlen(buffer),
64673ba00929SDmitry Safonov 					 &func_g.search, &not);
6468f9349a8fSFrederic Weisbecker 
64693ba00929SDmitry Safonov 	func_g.len = strlen(func_g.search);
6470f9349a8fSFrederic Weisbecker 
647152baf119SSteven Rostedt 	mutex_lock(&ftrace_lock);
647245a4a237SSteven Rostedt 
647345a4a237SSteven Rostedt 	if (unlikely(ftrace_disabled)) {
647445a4a237SSteven Rostedt 		mutex_unlock(&ftrace_lock);
647545a4a237SSteven Rostedt 		return -ENODEV;
647645a4a237SSteven Rostedt 	}
647745a4a237SSteven Rostedt 
6478265c831cSSteven Rostedt 	do_for_each_ftrace_rec(pg, rec) {
6479ea4e2bc4SSteven Rostedt 
6480546fece4SSteven Rostedt (Red Hat) 		if (rec->flags & FTRACE_FL_DISABLED)
6481546fece4SSteven Rostedt (Red Hat) 			continue;
6482546fece4SSteven Rostedt (Red Hat) 
64830b507e1eSDmitry Safonov 		if (ftrace_match_record(rec, &func_g, NULL, 0)) {
6484b9b0c831SNamhyung Kim 			entry = ftrace_lookup_ip(hash, rec->ip);
6485c7c6b1feSLi Zefan 
6486c7c6b1feSLi Zefan 			if (!not) {
6487c7c6b1feSLi Zefan 				fail = 0;
6488b9b0c831SNamhyung Kim 
6489b9b0c831SNamhyung Kim 				if (entry)
6490b9b0c831SNamhyung Kim 					continue;
6491b9b0c831SNamhyung Kim 				if (add_hash_entry(hash, rec->ip) < 0)
6492c7c6b1feSLi Zefan 					goto out;
6493c7c6b1feSLi Zefan 			} else {
6494b9b0c831SNamhyung Kim 				if (entry) {
6495b9b0c831SNamhyung Kim 					free_hash_entry(hash, entry);
6496c7c6b1feSLi Zefan 					fail = 0;
6497c7c6b1feSLi Zefan 				}
6498c7c6b1feSLi Zefan 			}
6499f9349a8fSFrederic Weisbecker 		}
6500265c831cSSteven Rostedt 	} while_for_each_ftrace_rec();
6501c7c6b1feSLi Zefan out:
650252baf119SSteven Rostedt 	mutex_unlock(&ftrace_lock);
6503ea4e2bc4SSteven Rostedt 
6504c7c6b1feSLi Zefan 	if (fail)
6505c7c6b1feSLi Zefan 		return -EINVAL;
6506c7c6b1feSLi Zefan 
6507c7c6b1feSLi Zefan 	return 0;
6508ea4e2bc4SSteven Rostedt }
6509ea4e2bc4SSteven Rostedt 
6510ea4e2bc4SSteven Rostedt static ssize_t
6511ea4e2bc4SSteven Rostedt ftrace_graph_write(struct file *file, const char __user *ubuf,
6512ea4e2bc4SSteven Rostedt 		   size_t cnt, loff_t *ppos)
6513ea4e2bc4SSteven Rostedt {
65146a10108bSNamhyung Kim 	ssize_t read, ret = 0;
6515faf982a6SNamhyung Kim 	struct ftrace_graph_data *fgd = file->private_data;
6516e704eff3SSteven Rostedt (VMware) 	struct trace_parser *parser;
6517ea4e2bc4SSteven Rostedt 
6518c7c6b1feSLi Zefan 	if (!cnt)
6519ea4e2bc4SSteven Rostedt 		return 0;
6520ea4e2bc4SSteven Rostedt 
6521ae98d27aSSteven Rostedt (VMware) 	/* Read mode uses seq functions */
6522ae98d27aSSteven Rostedt (VMware) 	if (file->f_mode & FMODE_READ) {
6523ae98d27aSSteven Rostedt (VMware) 		struct seq_file *m = file->private_data;
6524ae98d27aSSteven Rostedt (VMware) 		fgd = m->private;
6525ae98d27aSSteven Rostedt (VMware) 	}
6526ae98d27aSSteven Rostedt (VMware) 
6527e704eff3SSteven Rostedt (VMware) 	parser = &fgd->parser;
6528689fd8b6S[email protected] 
6529e704eff3SSteven Rostedt (VMware) 	read = trace_get_user(parser, ubuf, cnt, ppos);
6530ea4e2bc4SSteven Rostedt 
6531e704eff3SSteven Rostedt (VMware) 	if (read >= 0 && trace_parser_loaded(parser) &&
6532e704eff3SSteven Rostedt (VMware) 	    !trace_parser_cont(parser)) {
65336a10108bSNamhyung Kim 
6534b9b0c831SNamhyung Kim 		ret = ftrace_graph_set_hash(fgd->new_hash,
6535e704eff3SSteven Rostedt (VMware) 					    parser->buffer);
6536e704eff3SSteven Rostedt (VMware) 		trace_parser_clear(parser);
6537689fd8b6S[email protected] 	}
6538ea4e2bc4SSteven Rostedt 
65396a10108bSNamhyung Kim 	if (!ret)
6540ea4e2bc4SSteven Rostedt 		ret = read;
65411eb90f13SLi Zefan 
6542ea4e2bc4SSteven Rostedt 	return ret;
6543ea4e2bc4SSteven Rostedt }
6544ea4e2bc4SSteven Rostedt 
6545ea4e2bc4SSteven Rostedt static const struct file_operations ftrace_graph_fops = {
6546ea4e2bc4SSteven Rostedt 	.open		= ftrace_graph_open,
6547850a80cfSLai Jiangshan 	.read		= seq_read,
6548ea4e2bc4SSteven Rostedt 	.write		= ftrace_graph_write,
6549098c879eSSteven Rostedt (Red Hat) 	.llseek		= tracing_lseek,
655087827111SLi Zefan 	.release	= ftrace_graph_release,
6551ea4e2bc4SSteven Rostedt };
655229ad23b0SNamhyung Kim 
655329ad23b0SNamhyung Kim static const struct file_operations ftrace_graph_notrace_fops = {
655429ad23b0SNamhyung Kim 	.open		= ftrace_graph_notrace_open,
655529ad23b0SNamhyung Kim 	.read		= seq_read,
655629ad23b0SNamhyung Kim 	.write		= ftrace_graph_write,
6557098c879eSSteven Rostedt (Red Hat) 	.llseek		= tracing_lseek,
655829ad23b0SNamhyung Kim 	.release	= ftrace_graph_release,
655929ad23b0SNamhyung Kim };
6560ea4e2bc4SSteven Rostedt #endif /* CONFIG_FUNCTION_GRAPH_TRACER */
6561ea4e2bc4SSteven Rostedt 
6562591dffdaSSteven Rostedt (Red Hat) void ftrace_create_filter_files(struct ftrace_ops *ops,
6563591dffdaSSteven Rostedt (Red Hat) 				struct dentry *parent)
6564591dffdaSSteven Rostedt (Red Hat) {
6565591dffdaSSteven Rostedt (Red Hat) 
656621ccc9cdSSteven Rostedt (VMware) 	trace_create_file("set_ftrace_filter", TRACE_MODE_WRITE, parent,
6567591dffdaSSteven Rostedt (Red Hat) 			  ops, &ftrace_filter_fops);
6568591dffdaSSteven Rostedt (Red Hat) 
656921ccc9cdSSteven Rostedt (VMware) 	trace_create_file("set_ftrace_notrace", TRACE_MODE_WRITE, parent,
6570591dffdaSSteven Rostedt (Red Hat) 			  ops, &ftrace_notrace_fops);
6571591dffdaSSteven Rostedt (Red Hat) }
6572591dffdaSSteven Rostedt (Red Hat) 
6573591dffdaSSteven Rostedt (Red Hat) /*
6574591dffdaSSteven Rostedt (Red Hat)  * The name "destroy_filter_files" is really a misnomer. Although
65759efb85c5SHariprasad Kelam  * in the future, it may actually delete the files, but this is
6576591dffdaSSteven Rostedt (Red Hat)  * really intended to make sure the ops passed in are disabled
6577591dffdaSSteven Rostedt (Red Hat)  * and that when this function returns, the caller is free to
6578591dffdaSSteven Rostedt (Red Hat)  * free the ops.
6579591dffdaSSteven Rostedt (Red Hat)  *
6580591dffdaSSteven Rostedt (Red Hat)  * The "destroy" name is only to match the "create" name that this
6581591dffdaSSteven Rostedt (Red Hat)  * should be paired with.
6582591dffdaSSteven Rostedt (Red Hat)  */
6583591dffdaSSteven Rostedt (Red Hat) void ftrace_destroy_filter_files(struct ftrace_ops *ops)
6584591dffdaSSteven Rostedt (Red Hat) {
6585591dffdaSSteven Rostedt (Red Hat) 	mutex_lock(&ftrace_lock);
6586591dffdaSSteven Rostedt (Red Hat) 	if (ops->flags & FTRACE_OPS_FL_ENABLED)
6587591dffdaSSteven Rostedt (Red Hat) 		ftrace_shutdown(ops, 0);
6588591dffdaSSteven Rostedt (Red Hat) 	ops->flags |= FTRACE_OPS_FL_DELETED;
65892840f84fSSteven Rostedt (VMware) 	ftrace_free_filter(ops);
6590591dffdaSSteven Rostedt (Red Hat) 	mutex_unlock(&ftrace_lock);
6591591dffdaSSteven Rostedt (Red Hat) }
6592591dffdaSSteven Rostedt (Red Hat) 
65938434dc93SSteven Rostedt (Red Hat) static __init int ftrace_init_dyn_tracefs(struct dentry *d_tracer)
65945072c59fSSteven Rostedt {
65955072c59fSSteven Rostedt 
659621ccc9cdSSteven Rostedt (VMware) 	trace_create_file("available_filter_functions", TRACE_MODE_READ,
65975072c59fSSteven Rostedt 			d_tracer, NULL, &ftrace_avail_fops);
65985072c59fSSteven Rostedt 
659921ccc9cdSSteven Rostedt (VMware) 	trace_create_file("enabled_functions", TRACE_MODE_READ,
6600647bcd03SSteven Rostedt 			d_tracer, NULL, &ftrace_enabled_fops);
6601647bcd03SSteven Rostedt 
6602591dffdaSSteven Rostedt (Red Hat) 	ftrace_create_filter_files(&global_ops, d_tracer);
6603ad90c0e3SSteven Rostedt 
6604ea4e2bc4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
660521ccc9cdSSteven Rostedt (VMware) 	trace_create_file("set_graph_function", TRACE_MODE_WRITE, d_tracer,
6606ea4e2bc4SSteven Rostedt 				    NULL,
6607ea4e2bc4SSteven Rostedt 				    &ftrace_graph_fops);
660821ccc9cdSSteven Rostedt (VMware) 	trace_create_file("set_graph_notrace", TRACE_MODE_WRITE, d_tracer,
660929ad23b0SNamhyung Kim 				    NULL,
661029ad23b0SNamhyung Kim 				    &ftrace_graph_notrace_fops);
6611ea4e2bc4SSteven Rostedt #endif /* CONFIG_FUNCTION_GRAPH_TRACER */
6612ea4e2bc4SSteven Rostedt 
66135072c59fSSteven Rostedt 	return 0;
66145072c59fSSteven Rostedt }
66155072c59fSSteven Rostedt 
66169fd49328SSteven Rostedt static int ftrace_cmp_ips(const void *a, const void *b)
661768950619SSteven Rostedt {
66189fd49328SSteven Rostedt 	const unsigned long *ipa = a;
66199fd49328SSteven Rostedt 	const unsigned long *ipb = b;
662068950619SSteven Rostedt 
66219fd49328SSteven Rostedt 	if (*ipa > *ipb)
66229fd49328SSteven Rostedt 		return 1;
66239fd49328SSteven Rostedt 	if (*ipa < *ipb)
66249fd49328SSteven Rostedt 		return -1;
66259fd49328SSteven Rostedt 	return 0;
66269fd49328SSteven Rostedt }
66279fd49328SSteven Rostedt 
66288147dc78SSteven Rostedt (VMware) #ifdef CONFIG_FTRACE_SORT_STARTUP_TEST
66298147dc78SSteven Rostedt (VMware) static void test_is_sorted(unsigned long *start, unsigned long count)
66308147dc78SSteven Rostedt (VMware) {
66318147dc78SSteven Rostedt (VMware) 	int i;
66328147dc78SSteven Rostedt (VMware) 
66338147dc78SSteven Rostedt (VMware) 	for (i = 1; i < count; i++) {
66348147dc78SSteven Rostedt (VMware) 		if (WARN(start[i - 1] > start[i],
66358147dc78SSteven Rostedt (VMware) 			 "[%d] %pS at %lx is not sorted with %pS at %lx\n", i,
66368147dc78SSteven Rostedt (VMware) 			 (void *)start[i - 1], start[i - 1],
66378147dc78SSteven Rostedt (VMware) 			 (void *)start[i], start[i]))
66388147dc78SSteven Rostedt (VMware) 			break;
66398147dc78SSteven Rostedt (VMware) 	}
66408147dc78SSteven Rostedt (VMware) 	if (i == count)
66418147dc78SSteven Rostedt (VMware) 		pr_info("ftrace section at %px sorted properly\n", start);
66428147dc78SSteven Rostedt (VMware) }
66438147dc78SSteven Rostedt (VMware) #else
66448147dc78SSteven Rostedt (VMware) static void test_is_sorted(unsigned long *start, unsigned long count)
66458147dc78SSteven Rostedt (VMware) {
66468147dc78SSteven Rostedt (VMware) }
66478147dc78SSteven Rostedt (VMware) #endif
66488147dc78SSteven Rostedt (VMware) 
66495cb084bbSJiri Olsa static int ftrace_process_locs(struct module *mod,
665031e88909SSteven Rostedt 			       unsigned long *start,
665168bf21aaSSteven Rostedt 			       unsigned long *end)
665268bf21aaSSteven Rostedt {
6653706c81f8SSteven Rostedt 	struct ftrace_page *start_pg;
6654a7900875SSteven Rostedt 	struct ftrace_page *pg;
6655706c81f8SSteven Rostedt 	struct dyn_ftrace *rec;
6656a7900875SSteven Rostedt 	unsigned long count;
665768bf21aaSSteven Rostedt 	unsigned long *p;
665868bf21aaSSteven Rostedt 	unsigned long addr;
66594376cac6SSteven Rostedt 	unsigned long flags = 0; /* Shut up gcc */
6660a7900875SSteven Rostedt 	int ret = -ENOMEM;
6661a7900875SSteven Rostedt 
6662a7900875SSteven Rostedt 	count = end - start;
6663a7900875SSteven Rostedt 
6664a7900875SSteven Rostedt 	if (!count)
6665a7900875SSteven Rostedt 		return 0;
6666a7900875SSteven Rostedt 
666772b3942aSYinan Liu 	/*
666872b3942aSYinan Liu 	 * Sorting mcount in vmlinux at build time depend on
66696b9b6413SSteven Rostedt (Google) 	 * CONFIG_BUILDTIME_MCOUNT_SORT, while mcount loc in
667072b3942aSYinan Liu 	 * modules can not be sorted at build time.
667172b3942aSYinan Liu 	 */
66726b9b6413SSteven Rostedt (Google) 	if (!IS_ENABLED(CONFIG_BUILDTIME_MCOUNT_SORT) || mod) {
66739fd49328SSteven Rostedt 		sort(start, count, sizeof(*start),
66746db02903SRasmus Villemoes 		     ftrace_cmp_ips, NULL);
66758147dc78SSteven Rostedt (VMware) 	} else {
66768147dc78SSteven Rostedt (VMware) 		test_is_sorted(start, count);
667772b3942aSYinan Liu 	}
66789fd49328SSteven Rostedt 
6679706c81f8SSteven Rostedt 	start_pg = ftrace_allocate_pages(count);
6680706c81f8SSteven Rostedt 	if (!start_pg)
6681a7900875SSteven Rostedt 		return -ENOMEM;
668268bf21aaSSteven Rostedt 
6683e6ea44e9SSteven Rostedt 	mutex_lock(&ftrace_lock);
6684a7900875SSteven Rostedt 
668532082309SSteven Rostedt 	/*
668632082309SSteven Rostedt 	 * Core and each module needs their own pages, as
668732082309SSteven Rostedt 	 * modules will free them when they are removed.
668832082309SSteven Rostedt 	 * Force a new page to be allocated for modules.
668932082309SSteven Rostedt 	 */
6690a7900875SSteven Rostedt 	if (!mod) {
6691a7900875SSteven Rostedt 		WARN_ON(ftrace_pages || ftrace_pages_start);
6692a7900875SSteven Rostedt 		/* First initialization */
6693706c81f8SSteven Rostedt 		ftrace_pages = ftrace_pages_start = start_pg;
6694a7900875SSteven Rostedt 	} else {
669532082309SSteven Rostedt 		if (!ftrace_pages)
6696a7900875SSteven Rostedt 			goto out;
669732082309SSteven Rostedt 
6698a7900875SSteven Rostedt 		if (WARN_ON(ftrace_pages->next)) {
6699a7900875SSteven Rostedt 			/* Hmm, we have free pages? */
6700a7900875SSteven Rostedt 			while (ftrace_pages->next)
670132082309SSteven Rostedt 				ftrace_pages = ftrace_pages->next;
670232082309SSteven Rostedt 		}
6703a7900875SSteven Rostedt 
6704706c81f8SSteven Rostedt 		ftrace_pages->next = start_pg;
670532082309SSteven Rostedt 	}
670632082309SSteven Rostedt 
670768bf21aaSSteven Rostedt 	p = start;
6708706c81f8SSteven Rostedt 	pg = start_pg;
670968bf21aaSSteven Rostedt 	while (p < end) {
6710db42523bSLinus Torvalds 		unsigned long end_offset;
671168bf21aaSSteven Rostedt 		addr = ftrace_call_adjust(*p++);
671220e5227eSSteven Rostedt 		/*
671320e5227eSSteven Rostedt 		 * Some architecture linkers will pad between
671420e5227eSSteven Rostedt 		 * the different mcount_loc sections of different
671520e5227eSSteven Rostedt 		 * object files to satisfy alignments.
671620e5227eSSteven Rostedt 		 * Skip any NULL pointers.
671720e5227eSSteven Rostedt 		 */
671820e5227eSSteven Rostedt 		if (!addr)
671920e5227eSSteven Rostedt 			continue;
6720706c81f8SSteven Rostedt 
6721db42523bSLinus Torvalds 		end_offset = (pg->index+1) * sizeof(pg->records[0]);
6722db42523bSLinus Torvalds 		if (end_offset > PAGE_SIZE << pg->order) {
6723706c81f8SSteven Rostedt 			/* We should have allocated enough */
6724706c81f8SSteven Rostedt 			if (WARN_ON(!pg->next))
6725a7900875SSteven Rostedt 				break;
6726706c81f8SSteven Rostedt 			pg = pg->next;
672768bf21aaSSteven Rostedt 		}
672868bf21aaSSteven Rostedt 
6729706c81f8SSteven Rostedt 		rec = &pg->records[pg->index++];
6730706c81f8SSteven Rostedt 		rec->ip = addr;
6731706c81f8SSteven Rostedt 	}
6732706c81f8SSteven Rostedt 
6733706c81f8SSteven Rostedt 	/* We should have used all pages */
6734706c81f8SSteven Rostedt 	WARN_ON(pg->next);
6735706c81f8SSteven Rostedt 
6736706c81f8SSteven Rostedt 	/* Assign the last page to ftrace_pages */
6737706c81f8SSteven Rostedt 	ftrace_pages = pg;
6738706c81f8SSteven Rostedt 
6739a4f18ed1SSteven Rostedt 	/*
67404376cac6SSteven Rostedt 	 * We only need to disable interrupts on start up
67414376cac6SSteven Rostedt 	 * because we are modifying code that an interrupt
67424376cac6SSteven Rostedt 	 * may execute, and the modification is not atomic.
67434376cac6SSteven Rostedt 	 * But for modules, nothing runs the code we modify
67444376cac6SSteven Rostedt 	 * until we are finished with it, and there's no
67454376cac6SSteven Rostedt 	 * reason to cause large interrupt latencies while we do it.
6746a4f18ed1SSteven Rostedt 	 */
67474376cac6SSteven Rostedt 	if (!mod)
6748a4f18ed1SSteven Rostedt 		local_irq_save(flags);
67491dc43cf0SJiri Slaby 	ftrace_update_code(mod, start_pg);
67504376cac6SSteven Rostedt 	if (!mod)
6751a4f18ed1SSteven Rostedt 		local_irq_restore(flags);
6752a7900875SSteven Rostedt 	ret = 0;
6753a7900875SSteven Rostedt  out:
6754e6ea44e9SSteven Rostedt 	mutex_unlock(&ftrace_lock);
675568bf21aaSSteven Rostedt 
6756a7900875SSteven Rostedt 	return ret;
675768bf21aaSSteven Rostedt }
675868bf21aaSSteven Rostedt 
6759aba4b5c2SSteven Rostedt (VMware) struct ftrace_mod_func {
6760aba4b5c2SSteven Rostedt (VMware) 	struct list_head	list;
6761aba4b5c2SSteven Rostedt (VMware) 	char			*name;
6762aba4b5c2SSteven Rostedt (VMware) 	unsigned long		ip;
6763aba4b5c2SSteven Rostedt (VMware) 	unsigned int		size;
6764aba4b5c2SSteven Rostedt (VMware) };
6765aba4b5c2SSteven Rostedt (VMware) 
6766aba4b5c2SSteven Rostedt (VMware) struct ftrace_mod_map {
67676aa69784SSteven Rostedt (VMware) 	struct rcu_head		rcu;
6768aba4b5c2SSteven Rostedt (VMware) 	struct list_head	list;
6769aba4b5c2SSteven Rostedt (VMware) 	struct module		*mod;
6770aba4b5c2SSteven Rostedt (VMware) 	unsigned long		start_addr;
6771aba4b5c2SSteven Rostedt (VMware) 	unsigned long		end_addr;
6772aba4b5c2SSteven Rostedt (VMware) 	struct list_head	funcs;
67736171a031SSteven Rostedt (VMware) 	unsigned int		num_funcs;
6774aba4b5c2SSteven Rostedt (VMware) };
6775aba4b5c2SSteven Rostedt (VMware) 
6776fc0ea795SAdrian Hunter static int ftrace_get_trampoline_kallsym(unsigned int symnum,
6777fc0ea795SAdrian Hunter 					 unsigned long *value, char *type,
6778fc0ea795SAdrian Hunter 					 char *name, char *module_name,
6779fc0ea795SAdrian Hunter 					 int *exported)
6780fc0ea795SAdrian Hunter {
6781fc0ea795SAdrian Hunter 	struct ftrace_ops *op;
6782fc0ea795SAdrian Hunter 
6783fc0ea795SAdrian Hunter 	list_for_each_entry_rcu(op, &ftrace_ops_trampoline_list, list) {
6784fc0ea795SAdrian Hunter 		if (!op->trampoline || symnum--)
6785fc0ea795SAdrian Hunter 			continue;
6786fc0ea795SAdrian Hunter 		*value = op->trampoline;
6787fc0ea795SAdrian Hunter 		*type = 't';
6788fc0ea795SAdrian Hunter 		strlcpy(name, FTRACE_TRAMPOLINE_SYM, KSYM_NAME_LEN);
6789fc0ea795SAdrian Hunter 		strlcpy(module_name, FTRACE_TRAMPOLINE_MOD, MODULE_NAME_LEN);
6790fc0ea795SAdrian Hunter 		*exported = 0;
6791fc0ea795SAdrian Hunter 		return 0;
6792fc0ea795SAdrian Hunter 	}
6793fc0ea795SAdrian Hunter 
6794fc0ea795SAdrian Hunter 	return -ERANGE;
6795fc0ea795SAdrian Hunter }
6796fc0ea795SAdrian Hunter 
6797123d6455SWang Jingjin #if defined(CONFIG_DYNAMIC_FTRACE_WITH_DIRECT_CALLS) || defined(CONFIG_MODULES)
6798123d6455SWang Jingjin /*
6799123d6455SWang Jingjin  * Check if the current ops references the given ip.
6800123d6455SWang Jingjin  *
6801123d6455SWang Jingjin  * If the ops traces all functions, then it was already accounted for.
6802123d6455SWang Jingjin  * If the ops does not trace the current record function, skip it.
6803123d6455SWang Jingjin  * If the ops ignores the function via notrace filter, skip it.
6804123d6455SWang Jingjin  */
6805123d6455SWang Jingjin static bool
6806123d6455SWang Jingjin ops_references_ip(struct ftrace_ops *ops, unsigned long ip)
6807123d6455SWang Jingjin {
6808123d6455SWang Jingjin 	/* If ops isn't enabled, ignore it */
6809123d6455SWang Jingjin 	if (!(ops->flags & FTRACE_OPS_FL_ENABLED))
6810123d6455SWang Jingjin 		return false;
6811123d6455SWang Jingjin 
6812123d6455SWang Jingjin 	/* If ops traces all then it includes this function */
6813123d6455SWang Jingjin 	if (ops_traces_mod(ops))
6814123d6455SWang Jingjin 		return true;
6815123d6455SWang Jingjin 
6816123d6455SWang Jingjin 	/* The function must be in the filter */
6817123d6455SWang Jingjin 	if (!ftrace_hash_empty(ops->func_hash->filter_hash) &&
6818123d6455SWang Jingjin 	    !__ftrace_lookup_ip(ops->func_hash->filter_hash, ip))
6819123d6455SWang Jingjin 		return false;
6820123d6455SWang Jingjin 
6821123d6455SWang Jingjin 	/* If in notrace hash, we ignore it too */
6822123d6455SWang Jingjin 	if (ftrace_lookup_ip(ops->func_hash->notrace_hash, ip))
6823123d6455SWang Jingjin 		return false;
6824123d6455SWang Jingjin 
6825123d6455SWang Jingjin 	return true;
6826123d6455SWang Jingjin }
6827123d6455SWang Jingjin #endif
6828123d6455SWang Jingjin 
682993eb677dSSteven Rostedt #ifdef CONFIG_MODULES
683032082309SSteven Rostedt 
683132082309SSteven Rostedt #define next_to_ftrace_page(p) container_of(p, struct ftrace_page, next)
683232082309SSteven Rostedt 
68336aa69784SSteven Rostedt (VMware) static LIST_HEAD(ftrace_mod_maps);
68346aa69784SSteven Rostedt (VMware) 
6835b7ffffbbSSteven Rostedt (Red Hat) static int referenced_filters(struct dyn_ftrace *rec)
6836b7ffffbbSSteven Rostedt (Red Hat) {
6837b7ffffbbSSteven Rostedt (Red Hat) 	struct ftrace_ops *ops;
6838b7ffffbbSSteven Rostedt (Red Hat) 	int cnt = 0;
6839b7ffffbbSSteven Rostedt (Red Hat) 
6840b7ffffbbSSteven Rostedt (Red Hat) 	for (ops = ftrace_ops_list; ops != &ftrace_list_end; ops = ops->next) {
6841123d6455SWang Jingjin 		if (ops_references_ip(ops, rec->ip)) {
6842c5f51572SChengming Zhou 			if (WARN_ON_ONCE(ops->flags & FTRACE_OPS_FL_DIRECT))
6843c5f51572SChengming Zhou 				continue;
6844c5f51572SChengming Zhou 			if (WARN_ON_ONCE(ops->flags & FTRACE_OPS_FL_IPMODIFY))
6845c5f51572SChengming Zhou 				continue;
6846b7ffffbbSSteven Rostedt (Red Hat) 			cnt++;
68478a224ffbSChengming Zhou 			if (ops->flags & FTRACE_OPS_FL_SAVE_REGS)
68488a224ffbSChengming Zhou 				rec->flags |= FTRACE_FL_REGS;
6849c5f51572SChengming Zhou 			if (cnt == 1 && ops->trampoline)
6850c5f51572SChengming Zhou 				rec->flags |= FTRACE_FL_TRAMP;
6851c5f51572SChengming Zhou 			else
6852c5f51572SChengming Zhou 				rec->flags &= ~FTRACE_FL_TRAMP;
68538a224ffbSChengming Zhou 		}
6854b7ffffbbSSteven Rostedt (Red Hat) 	}
6855b7ffffbbSSteven Rostedt (Red Hat) 
6856b7ffffbbSSteven Rostedt (Red Hat) 	return cnt;
6857b7ffffbbSSteven Rostedt (Red Hat) }
6858b7ffffbbSSteven Rostedt (Red Hat) 
68592a5bfe47SSteven Rostedt (VMware) static void
68602a5bfe47SSteven Rostedt (VMware) clear_mod_from_hash(struct ftrace_page *pg, struct ftrace_hash *hash)
68612a5bfe47SSteven Rostedt (VMware) {
68622a5bfe47SSteven Rostedt (VMware) 	struct ftrace_func_entry *entry;
68632a5bfe47SSteven Rostedt (VMware) 	struct dyn_ftrace *rec;
68642a5bfe47SSteven Rostedt (VMware) 	int i;
68652a5bfe47SSteven Rostedt (VMware) 
68662a5bfe47SSteven Rostedt (VMware) 	if (ftrace_hash_empty(hash))
68672a5bfe47SSteven Rostedt (VMware) 		return;
68682a5bfe47SSteven Rostedt (VMware) 
68692a5bfe47SSteven Rostedt (VMware) 	for (i = 0; i < pg->index; i++) {
68702a5bfe47SSteven Rostedt (VMware) 		rec = &pg->records[i];
68712a5bfe47SSteven Rostedt (VMware) 		entry = __ftrace_lookup_ip(hash, rec->ip);
68722a5bfe47SSteven Rostedt (VMware) 		/*
68732a5bfe47SSteven Rostedt (VMware) 		 * Do not allow this rec to match again.
68742a5bfe47SSteven Rostedt (VMware) 		 * Yeah, it may waste some memory, but will be removed
68752a5bfe47SSteven Rostedt (VMware) 		 * if/when the hash is modified again.
68762a5bfe47SSteven Rostedt (VMware) 		 */
68772a5bfe47SSteven Rostedt (VMware) 		if (entry)
68782a5bfe47SSteven Rostedt (VMware) 			entry->ip = 0;
68792a5bfe47SSteven Rostedt (VMware) 	}
68802a5bfe47SSteven Rostedt (VMware) }
68812a5bfe47SSteven Rostedt (VMware) 
6882f2cc020dSIngo Molnar /* Clear any records from hashes */
68832a5bfe47SSteven Rostedt (VMware) static void clear_mod_from_hashes(struct ftrace_page *pg)
68842a5bfe47SSteven Rostedt (VMware) {
68852a5bfe47SSteven Rostedt (VMware) 	struct trace_array *tr;
68862a5bfe47SSteven Rostedt (VMware) 
68872a5bfe47SSteven Rostedt (VMware) 	mutex_lock(&trace_types_lock);
68882a5bfe47SSteven Rostedt (VMware) 	list_for_each_entry(tr, &ftrace_trace_arrays, list) {
68892a5bfe47SSteven Rostedt (VMware) 		if (!tr->ops || !tr->ops->func_hash)
68902a5bfe47SSteven Rostedt (VMware) 			continue;
68912a5bfe47SSteven Rostedt (VMware) 		mutex_lock(&tr->ops->func_hash->regex_lock);
68922a5bfe47SSteven Rostedt (VMware) 		clear_mod_from_hash(pg, tr->ops->func_hash->filter_hash);
68932a5bfe47SSteven Rostedt (VMware) 		clear_mod_from_hash(pg, tr->ops->func_hash->notrace_hash);
68942a5bfe47SSteven Rostedt (VMware) 		mutex_unlock(&tr->ops->func_hash->regex_lock);
68952a5bfe47SSteven Rostedt (VMware) 	}
68962a5bfe47SSteven Rostedt (VMware) 	mutex_unlock(&trace_types_lock);
68972a5bfe47SSteven Rostedt (VMware) }
68982a5bfe47SSteven Rostedt (VMware) 
68996aa69784SSteven Rostedt (VMware) static void ftrace_free_mod_map(struct rcu_head *rcu)
69006aa69784SSteven Rostedt (VMware) {
69016aa69784SSteven Rostedt (VMware) 	struct ftrace_mod_map *mod_map = container_of(rcu, struct ftrace_mod_map, rcu);
69026aa69784SSteven Rostedt (VMware) 	struct ftrace_mod_func *mod_func;
69036aa69784SSteven Rostedt (VMware) 	struct ftrace_mod_func *n;
69046aa69784SSteven Rostedt (VMware) 
69056aa69784SSteven Rostedt (VMware) 	/* All the contents of mod_map are now not visible to readers */
69066aa69784SSteven Rostedt (VMware) 	list_for_each_entry_safe(mod_func, n, &mod_map->funcs, list) {
69076aa69784SSteven Rostedt (VMware) 		kfree(mod_func->name);
69086aa69784SSteven Rostedt (VMware) 		list_del(&mod_func->list);
69096aa69784SSteven Rostedt (VMware) 		kfree(mod_func);
69106aa69784SSteven Rostedt (VMware) 	}
69116aa69784SSteven Rostedt (VMware) 
69126aa69784SSteven Rostedt (VMware) 	kfree(mod_map);
69136aa69784SSteven Rostedt (VMware) }
69146aa69784SSteven Rostedt (VMware) 
6915e7247a15S[email protected] void ftrace_release_mod(struct module *mod)
691693eb677dSSteven Rostedt {
69176aa69784SSteven Rostedt (VMware) 	struct ftrace_mod_map *mod_map;
69186aa69784SSteven Rostedt (VMware) 	struct ftrace_mod_map *n;
691993eb677dSSteven Rostedt 	struct dyn_ftrace *rec;
692032082309SSteven Rostedt 	struct ftrace_page **last_pg;
69212a5bfe47SSteven Rostedt (VMware) 	struct ftrace_page *tmp_page = NULL;
692293eb677dSSteven Rostedt 	struct ftrace_page *pg;
692393eb677dSSteven Rostedt 
692493eb677dSSteven Rostedt 	mutex_lock(&ftrace_lock);
692545a4a237SSteven Rostedt 
692645a4a237SSteven Rostedt 	if (ftrace_disabled)
692745a4a237SSteven Rostedt 		goto out_unlock;
692845a4a237SSteven Rostedt 
69296aa69784SSteven Rostedt (VMware) 	list_for_each_entry_safe(mod_map, n, &ftrace_mod_maps, list) {
69306aa69784SSteven Rostedt (VMware) 		if (mod_map->mod == mod) {
69316aa69784SSteven Rostedt (VMware) 			list_del_rcu(&mod_map->list);
693274401729SPaul E. McKenney 			call_rcu(&mod_map->rcu, ftrace_free_mod_map);
69336aa69784SSteven Rostedt (VMware) 			break;
69346aa69784SSteven Rostedt (VMware) 		}
69356aa69784SSteven Rostedt (VMware) 	}
69366aa69784SSteven Rostedt (VMware) 
693732082309SSteven Rostedt 	/*
693832082309SSteven Rostedt 	 * Each module has its own ftrace_pages, remove
693932082309SSteven Rostedt 	 * them from the list.
694032082309SSteven Rostedt 	 */
694132082309SSteven Rostedt 	last_pg = &ftrace_pages_start;
694232082309SSteven Rostedt 	for (pg = ftrace_pages_start; pg; pg = *last_pg) {
694332082309SSteven Rostedt 		rec = &pg->records[0];
69443e234289SSteven Rostedt (VMware) 		if (within_module_core(rec->ip, mod) ||
69453e234289SSteven Rostedt (VMware) 		    within_module_init(rec->ip, mod)) {
694693eb677dSSteven Rostedt 			/*
694732082309SSteven Rostedt 			 * As core pages are first, the first
694832082309SSteven Rostedt 			 * page should never be a module page.
694993eb677dSSteven Rostedt 			 */
695032082309SSteven Rostedt 			if (WARN_ON(pg == ftrace_pages_start))
695132082309SSteven Rostedt 				goto out_unlock;
695232082309SSteven Rostedt 
695332082309SSteven Rostedt 			/* Check if we are deleting the last page */
695432082309SSteven Rostedt 			if (pg == ftrace_pages)
695532082309SSteven Rostedt 				ftrace_pages = next_to_ftrace_page(last_pg);
695632082309SSteven Rostedt 
695783dd1493SSteven Rostedt (VMware) 			ftrace_update_tot_cnt -= pg->index;
695832082309SSteven Rostedt 			*last_pg = pg->next;
69592a5bfe47SSteven Rostedt (VMware) 
69602a5bfe47SSteven Rostedt (VMware) 			pg->next = tmp_page;
69612a5bfe47SSteven Rostedt (VMware) 			tmp_page = pg;
696232082309SSteven Rostedt 		} else
696332082309SSteven Rostedt 			last_pg = &pg->next;
696493eb677dSSteven Rostedt 	}
696545a4a237SSteven Rostedt  out_unlock:
696693eb677dSSteven Rostedt 	mutex_unlock(&ftrace_lock);
69672a5bfe47SSteven Rostedt (VMware) 
69682a5bfe47SSteven Rostedt (VMware) 	for (pg = tmp_page; pg; pg = tmp_page) {
69692a5bfe47SSteven Rostedt (VMware) 
69702a5bfe47SSteven Rostedt (VMware) 		/* Needs to be called outside of ftrace_lock */
69712a5bfe47SSteven Rostedt (VMware) 		clear_mod_from_hashes(pg);
69722a5bfe47SSteven Rostedt (VMware) 
6973db42523bSLinus Torvalds 		if (pg->records) {
6974db42523bSLinus Torvalds 			free_pages((unsigned long)pg->records, pg->order);
6975db42523bSLinus Torvalds 			ftrace_number_of_pages -= 1 << pg->order;
6976db42523bSLinus Torvalds 		}
69772a5bfe47SSteven Rostedt (VMware) 		tmp_page = pg->next;
69782a5bfe47SSteven Rostedt (VMware) 		kfree(pg);
6979da537f0aSSteven Rostedt (VMware) 		ftrace_number_of_groups--;
69802a5bfe47SSteven Rostedt (VMware) 	}
698193eb677dSSteven Rostedt }
698293eb677dSSteven Rostedt 
69837dcd182bSJessica Yu void ftrace_module_enable(struct module *mod)
6984b7ffffbbSSteven Rostedt (Red Hat) {
6985b7ffffbbSSteven Rostedt (Red Hat) 	struct dyn_ftrace *rec;
6986b7ffffbbSSteven Rostedt (Red Hat) 	struct ftrace_page *pg;
6987b7ffffbbSSteven Rostedt (Red Hat) 
6988b7ffffbbSSteven Rostedt (Red Hat) 	mutex_lock(&ftrace_lock);
6989b7ffffbbSSteven Rostedt (Red Hat) 
6990b7ffffbbSSteven Rostedt (Red Hat) 	if (ftrace_disabled)
6991b7ffffbbSSteven Rostedt (Red Hat) 		goto out_unlock;
6992b7ffffbbSSteven Rostedt (Red Hat) 
6993b7ffffbbSSteven Rostedt (Red Hat) 	/*
6994b7ffffbbSSteven Rostedt (Red Hat) 	 * If the tracing is enabled, go ahead and enable the record.
6995b7ffffbbSSteven Rostedt (Red Hat) 	 *
69969efb85c5SHariprasad Kelam 	 * The reason not to enable the record immediately is the
6997b7ffffbbSSteven Rostedt (Red Hat) 	 * inherent check of ftrace_make_nop/ftrace_make_call for
6998b7ffffbbSSteven Rostedt (Red Hat) 	 * correct previous instructions.  Making first the NOP
6999b7ffffbbSSteven Rostedt (Red Hat) 	 * conversion puts the module to the correct state, thus
7000b7ffffbbSSteven Rostedt (Red Hat) 	 * passing the ftrace_make_call check.
7001b7ffffbbSSteven Rostedt (Red Hat) 	 *
7002b7ffffbbSSteven Rostedt (Red Hat) 	 * We also delay this to after the module code already set the
7003b7ffffbbSSteven Rostedt (Red Hat) 	 * text to read-only, as we now need to set it back to read-write
7004b7ffffbbSSteven Rostedt (Red Hat) 	 * so that we can modify the text.
7005b7ffffbbSSteven Rostedt (Red Hat) 	 */
7006b7ffffbbSSteven Rostedt (Red Hat) 	if (ftrace_start_up)
7007b7ffffbbSSteven Rostedt (Red Hat) 		ftrace_arch_code_modify_prepare();
7008b7ffffbbSSteven Rostedt (Red Hat) 
7009b7ffffbbSSteven Rostedt (Red Hat) 	do_for_each_ftrace_rec(pg, rec) {
7010b7ffffbbSSteven Rostedt (Red Hat) 		int cnt;
7011b7ffffbbSSteven Rostedt (Red Hat) 		/*
7012b7ffffbbSSteven Rostedt (Red Hat) 		 * do_for_each_ftrace_rec() is a double loop.
7013b7ffffbbSSteven Rostedt (Red Hat) 		 * module text shares the pg. If a record is
7014b7ffffbbSSteven Rostedt (Red Hat) 		 * not part of this module, then skip this pg,
7015b7ffffbbSSteven Rostedt (Red Hat) 		 * which the "break" will do.
7016b7ffffbbSSteven Rostedt (Red Hat) 		 */
70173e234289SSteven Rostedt (VMware) 		if (!within_module_core(rec->ip, mod) &&
70183e234289SSteven Rostedt (VMware) 		    !within_module_init(rec->ip, mod))
7019b7ffffbbSSteven Rostedt (Red Hat) 			break;
7020b7ffffbbSSteven Rostedt (Red Hat) 
7021b39181f7SSteven Rostedt (Google) 		/* Weak functions should still be ignored */
7022b39181f7SSteven Rostedt (Google) 		if (!test_for_valid_rec(rec)) {
7023b39181f7SSteven Rostedt (Google) 			/* Clear all other flags. Should not be enabled anyway */
7024b39181f7SSteven Rostedt (Google) 			rec->flags = FTRACE_FL_DISABLED;
7025b39181f7SSteven Rostedt (Google) 			continue;
7026b39181f7SSteven Rostedt (Google) 		}
7027b39181f7SSteven Rostedt (Google) 
7028b7ffffbbSSteven Rostedt (Red Hat) 		cnt = 0;
7029b7ffffbbSSteven Rostedt (Red Hat) 
7030b7ffffbbSSteven Rostedt (Red Hat) 		/*
7031b7ffffbbSSteven Rostedt (Red Hat) 		 * When adding a module, we need to check if tracers are
7032b7ffffbbSSteven Rostedt (Red Hat) 		 * currently enabled and if they are, and can trace this record,
7033b7ffffbbSSteven Rostedt (Red Hat) 		 * we need to enable the module functions as well as update the
7034b7ffffbbSSteven Rostedt (Red Hat) 		 * reference counts for those function records.
7035b7ffffbbSSteven Rostedt (Red Hat) 		 */
7036b7ffffbbSSteven Rostedt (Red Hat) 		if (ftrace_start_up)
7037b7ffffbbSSteven Rostedt (Red Hat) 			cnt += referenced_filters(rec);
7038b7ffffbbSSteven Rostedt (Red Hat) 
70398a224ffbSChengming Zhou 		rec->flags &= ~FTRACE_FL_DISABLED;
70408a224ffbSChengming Zhou 		rec->flags += cnt;
7041b7ffffbbSSteven Rostedt (Red Hat) 
7042b7ffffbbSSteven Rostedt (Red Hat) 		if (ftrace_start_up && cnt) {
7043b7ffffbbSSteven Rostedt (Red Hat) 			int failed = __ftrace_replace_code(rec, 1);
7044b7ffffbbSSteven Rostedt (Red Hat) 			if (failed) {
7045b7ffffbbSSteven Rostedt (Red Hat) 				ftrace_bug(failed, rec);
7046b7ffffbbSSteven Rostedt (Red Hat) 				goto out_loop;
7047b7ffffbbSSteven Rostedt (Red Hat) 			}
7048b7ffffbbSSteven Rostedt (Red Hat) 		}
7049b7ffffbbSSteven Rostedt (Red Hat) 
7050b7ffffbbSSteven Rostedt (Red Hat) 	} while_for_each_ftrace_rec();
7051b7ffffbbSSteven Rostedt (Red Hat) 
7052b7ffffbbSSteven Rostedt (Red Hat)  out_loop:
7053b7ffffbbSSteven Rostedt (Red Hat) 	if (ftrace_start_up)
7054b7ffffbbSSteven Rostedt (Red Hat) 		ftrace_arch_code_modify_post_process();
7055b7ffffbbSSteven Rostedt (Red Hat) 
7056b7ffffbbSSteven Rostedt (Red Hat)  out_unlock:
7057b7ffffbbSSteven Rostedt (Red Hat) 	mutex_unlock(&ftrace_lock);
7058d7fbf8dfSSteven Rostedt (VMware) 
7059d7fbf8dfSSteven Rostedt (VMware) 	process_cached_mods(mod->name);
7060b7ffffbbSSteven Rostedt (Red Hat) }
7061b7ffffbbSSteven Rostedt (Red Hat) 
7062a949ae56SSteven Rostedt (Red Hat) void ftrace_module_init(struct module *mod)
706393eb677dSSteven Rostedt {
70642889c658SYuntao Wang 	int ret;
70652889c658SYuntao Wang 
706697e9b4fcSSteven Rostedt (Red Hat) 	if (ftrace_disabled || !mod->num_ftrace_callsites)
7067b6b71f66SAbel Vesa 		return;
7068b6b71f66SAbel Vesa 
70692889c658SYuntao Wang 	ret = ftrace_process_locs(mod, mod->ftrace_callsites,
707097e9b4fcSSteven Rostedt (Red Hat) 				  mod->ftrace_callsites + mod->num_ftrace_callsites);
70712889c658SYuntao Wang 	if (ret)
70722889c658SYuntao Wang 		pr_warn("ftrace: failed to allocate entries for module '%s' functions\n",
70732889c658SYuntao Wang 			mod->name);
707493eb677dSSteven Rostedt }
7075aba4b5c2SSteven Rostedt (VMware) 
7076aba4b5c2SSteven Rostedt (VMware) static void save_ftrace_mod_rec(struct ftrace_mod_map *mod_map,
7077aba4b5c2SSteven Rostedt (VMware) 				struct dyn_ftrace *rec)
7078aba4b5c2SSteven Rostedt (VMware) {
7079aba4b5c2SSteven Rostedt (VMware) 	struct ftrace_mod_func *mod_func;
7080aba4b5c2SSteven Rostedt (VMware) 	unsigned long symsize;
7081aba4b5c2SSteven Rostedt (VMware) 	unsigned long offset;
7082aba4b5c2SSteven Rostedt (VMware) 	char str[KSYM_SYMBOL_LEN];
7083aba4b5c2SSteven Rostedt (VMware) 	char *modname;
7084aba4b5c2SSteven Rostedt (VMware) 	const char *ret;
7085aba4b5c2SSteven Rostedt (VMware) 
7086aba4b5c2SSteven Rostedt (VMware) 	ret = kallsyms_lookup(rec->ip, &symsize, &offset, &modname, str);
7087aba4b5c2SSteven Rostedt (VMware) 	if (!ret)
7088aba4b5c2SSteven Rostedt (VMware) 		return;
7089aba4b5c2SSteven Rostedt (VMware) 
7090aba4b5c2SSteven Rostedt (VMware) 	mod_func = kmalloc(sizeof(*mod_func), GFP_KERNEL);
7091aba4b5c2SSteven Rostedt (VMware) 	if (!mod_func)
7092aba4b5c2SSteven Rostedt (VMware) 		return;
7093aba4b5c2SSteven Rostedt (VMware) 
7094aba4b5c2SSteven Rostedt (VMware) 	mod_func->name = kstrdup(str, GFP_KERNEL);
7095aba4b5c2SSteven Rostedt (VMware) 	if (!mod_func->name) {
7096aba4b5c2SSteven Rostedt (VMware) 		kfree(mod_func);
7097aba4b5c2SSteven Rostedt (VMware) 		return;
7098aba4b5c2SSteven Rostedt (VMware) 	}
7099aba4b5c2SSteven Rostedt (VMware) 
7100aba4b5c2SSteven Rostedt (VMware) 	mod_func->ip = rec->ip - offset;
7101aba4b5c2SSteven Rostedt (VMware) 	mod_func->size = symsize;
7102aba4b5c2SSteven Rostedt (VMware) 
71036171a031SSteven Rostedt (VMware) 	mod_map->num_funcs++;
71046171a031SSteven Rostedt (VMware) 
7105aba4b5c2SSteven Rostedt (VMware) 	list_add_rcu(&mod_func->list, &mod_map->funcs);
7106aba4b5c2SSteven Rostedt (VMware) }
7107aba4b5c2SSteven Rostedt (VMware) 
7108aba4b5c2SSteven Rostedt (VMware) static struct ftrace_mod_map *
7109aba4b5c2SSteven Rostedt (VMware) allocate_ftrace_mod_map(struct module *mod,
7110aba4b5c2SSteven Rostedt (VMware) 			unsigned long start, unsigned long end)
7111aba4b5c2SSteven Rostedt (VMware) {
7112aba4b5c2SSteven Rostedt (VMware) 	struct ftrace_mod_map *mod_map;
7113aba4b5c2SSteven Rostedt (VMware) 
7114aba4b5c2SSteven Rostedt (VMware) 	mod_map = kmalloc(sizeof(*mod_map), GFP_KERNEL);
7115aba4b5c2SSteven Rostedt (VMware) 	if (!mod_map)
7116aba4b5c2SSteven Rostedt (VMware) 		return NULL;
7117aba4b5c2SSteven Rostedt (VMware) 
7118aba4b5c2SSteven Rostedt (VMware) 	mod_map->mod = mod;
7119aba4b5c2SSteven Rostedt (VMware) 	mod_map->start_addr = start;
7120aba4b5c2SSteven Rostedt (VMware) 	mod_map->end_addr = end;
71216171a031SSteven Rostedt (VMware) 	mod_map->num_funcs = 0;
7122aba4b5c2SSteven Rostedt (VMware) 
7123aba4b5c2SSteven Rostedt (VMware) 	INIT_LIST_HEAD_RCU(&mod_map->funcs);
7124aba4b5c2SSteven Rostedt (VMware) 
7125aba4b5c2SSteven Rostedt (VMware) 	list_add_rcu(&mod_map->list, &ftrace_mod_maps);
7126aba4b5c2SSteven Rostedt (VMware) 
7127aba4b5c2SSteven Rostedt (VMware) 	return mod_map;
7128aba4b5c2SSteven Rostedt (VMware) }
7129aba4b5c2SSteven Rostedt (VMware) 
7130aba4b5c2SSteven Rostedt (VMware) static const char *
7131aba4b5c2SSteven Rostedt (VMware) ftrace_func_address_lookup(struct ftrace_mod_map *mod_map,
7132aba4b5c2SSteven Rostedt (VMware) 			   unsigned long addr, unsigned long *size,
7133aba4b5c2SSteven Rostedt (VMware) 			   unsigned long *off, char *sym)
7134aba4b5c2SSteven Rostedt (VMware) {
7135aba4b5c2SSteven Rostedt (VMware) 	struct ftrace_mod_func *found_func =  NULL;
7136aba4b5c2SSteven Rostedt (VMware) 	struct ftrace_mod_func *mod_func;
7137aba4b5c2SSteven Rostedt (VMware) 
7138aba4b5c2SSteven Rostedt (VMware) 	list_for_each_entry_rcu(mod_func, &mod_map->funcs, list) {
7139aba4b5c2SSteven Rostedt (VMware) 		if (addr >= mod_func->ip &&
7140aba4b5c2SSteven Rostedt (VMware) 		    addr < mod_func->ip + mod_func->size) {
7141aba4b5c2SSteven Rostedt (VMware) 			found_func = mod_func;
7142aba4b5c2SSteven Rostedt (VMware) 			break;
7143aba4b5c2SSteven Rostedt (VMware) 		}
7144aba4b5c2SSteven Rostedt (VMware) 	}
7145aba4b5c2SSteven Rostedt (VMware) 
7146aba4b5c2SSteven Rostedt (VMware) 	if (found_func) {
7147aba4b5c2SSteven Rostedt (VMware) 		if (size)
7148aba4b5c2SSteven Rostedt (VMware) 			*size = found_func->size;
7149aba4b5c2SSteven Rostedt (VMware) 		if (off)
7150aba4b5c2SSteven Rostedt (VMware) 			*off = addr - found_func->ip;
7151aba4b5c2SSteven Rostedt (VMware) 		if (sym)
7152aba4b5c2SSteven Rostedt (VMware) 			strlcpy(sym, found_func->name, KSYM_NAME_LEN);
7153aba4b5c2SSteven Rostedt (VMware) 
7154aba4b5c2SSteven Rostedt (VMware) 		return found_func->name;
7155aba4b5c2SSteven Rostedt (VMware) 	}
7156aba4b5c2SSteven Rostedt (VMware) 
7157aba4b5c2SSteven Rostedt (VMware) 	return NULL;
7158aba4b5c2SSteven Rostedt (VMware) }
7159aba4b5c2SSteven Rostedt (VMware) 
7160aba4b5c2SSteven Rostedt (VMware) const char *
7161aba4b5c2SSteven Rostedt (VMware) ftrace_mod_address_lookup(unsigned long addr, unsigned long *size,
7162aba4b5c2SSteven Rostedt (VMware) 		   unsigned long *off, char **modname, char *sym)
7163aba4b5c2SSteven Rostedt (VMware) {
7164aba4b5c2SSteven Rostedt (VMware) 	struct ftrace_mod_map *mod_map;
7165aba4b5c2SSteven Rostedt (VMware) 	const char *ret = NULL;
7166aba4b5c2SSteven Rostedt (VMware) 
716774401729SPaul E. McKenney 	/* mod_map is freed via call_rcu() */
7168aba4b5c2SSteven Rostedt (VMware) 	preempt_disable();
7169aba4b5c2SSteven Rostedt (VMware) 	list_for_each_entry_rcu(mod_map, &ftrace_mod_maps, list) {
7170aba4b5c2SSteven Rostedt (VMware) 		ret = ftrace_func_address_lookup(mod_map, addr, size, off, sym);
7171aba4b5c2SSteven Rostedt (VMware) 		if (ret) {
7172aba4b5c2SSteven Rostedt (VMware) 			if (modname)
7173aba4b5c2SSteven Rostedt (VMware) 				*modname = mod_map->mod->name;
7174aba4b5c2SSteven Rostedt (VMware) 			break;
7175aba4b5c2SSteven Rostedt (VMware) 		}
7176aba4b5c2SSteven Rostedt (VMware) 	}
7177aba4b5c2SSteven Rostedt (VMware) 	preempt_enable();
7178aba4b5c2SSteven Rostedt (VMware) 
7179aba4b5c2SSteven Rostedt (VMware) 	return ret;
7180aba4b5c2SSteven Rostedt (VMware) }
7181aba4b5c2SSteven Rostedt (VMware) 
71826171a031SSteven Rostedt (VMware) int ftrace_mod_get_kallsym(unsigned int symnum, unsigned long *value,
71836171a031SSteven Rostedt (VMware) 			   char *type, char *name,
71846171a031SSteven Rostedt (VMware) 			   char *module_name, int *exported)
71856171a031SSteven Rostedt (VMware) {
71866171a031SSteven Rostedt (VMware) 	struct ftrace_mod_map *mod_map;
71876171a031SSteven Rostedt (VMware) 	struct ftrace_mod_func *mod_func;
7188fc0ea795SAdrian Hunter 	int ret;
71896171a031SSteven Rostedt (VMware) 
71906171a031SSteven Rostedt (VMware) 	preempt_disable();
71916171a031SSteven Rostedt (VMware) 	list_for_each_entry_rcu(mod_map, &ftrace_mod_maps, list) {
71926171a031SSteven Rostedt (VMware) 
71936171a031SSteven Rostedt (VMware) 		if (symnum >= mod_map->num_funcs) {
71946171a031SSteven Rostedt (VMware) 			symnum -= mod_map->num_funcs;
71956171a031SSteven Rostedt (VMware) 			continue;
71966171a031SSteven Rostedt (VMware) 		}
71976171a031SSteven Rostedt (VMware) 
71986171a031SSteven Rostedt (VMware) 		list_for_each_entry_rcu(mod_func, &mod_map->funcs, list) {
71996171a031SSteven Rostedt (VMware) 			if (symnum > 1) {
72006171a031SSteven Rostedt (VMware) 				symnum--;
72016171a031SSteven Rostedt (VMware) 				continue;
72026171a031SSteven Rostedt (VMware) 			}
72036171a031SSteven Rostedt (VMware) 
72046171a031SSteven Rostedt (VMware) 			*value = mod_func->ip;
72056171a031SSteven Rostedt (VMware) 			*type = 'T';
72066171a031SSteven Rostedt (VMware) 			strlcpy(name, mod_func->name, KSYM_NAME_LEN);
72076171a031SSteven Rostedt (VMware) 			strlcpy(module_name, mod_map->mod->name, MODULE_NAME_LEN);
72086171a031SSteven Rostedt (VMware) 			*exported = 1;
72096171a031SSteven Rostedt (VMware) 			preempt_enable();
72106171a031SSteven Rostedt (VMware) 			return 0;
72116171a031SSteven Rostedt (VMware) 		}
72126171a031SSteven Rostedt (VMware) 		WARN_ON(1);
72136171a031SSteven Rostedt (VMware) 		break;
72146171a031SSteven Rostedt (VMware) 	}
7215fc0ea795SAdrian Hunter 	ret = ftrace_get_trampoline_kallsym(symnum, value, type, name,
7216fc0ea795SAdrian Hunter 					    module_name, exported);
72176171a031SSteven Rostedt (VMware) 	preempt_enable();
7218fc0ea795SAdrian Hunter 	return ret;
72196171a031SSteven Rostedt (VMware) }
72206171a031SSteven Rostedt (VMware) 
7221aba4b5c2SSteven Rostedt (VMware) #else
7222aba4b5c2SSteven Rostedt (VMware) static void save_ftrace_mod_rec(struct ftrace_mod_map *mod_map,
7223aba4b5c2SSteven Rostedt (VMware) 				struct dyn_ftrace *rec) { }
7224aba4b5c2SSteven Rostedt (VMware) static inline struct ftrace_mod_map *
7225aba4b5c2SSteven Rostedt (VMware) allocate_ftrace_mod_map(struct module *mod,
7226aba4b5c2SSteven Rostedt (VMware) 			unsigned long start, unsigned long end)
7227aba4b5c2SSteven Rostedt (VMware) {
7228aba4b5c2SSteven Rostedt (VMware) 	return NULL;
7229aba4b5c2SSteven Rostedt (VMware) }
7230fc0ea795SAdrian Hunter int ftrace_mod_get_kallsym(unsigned int symnum, unsigned long *value,
7231fc0ea795SAdrian Hunter 			   char *type, char *name, char *module_name,
7232fc0ea795SAdrian Hunter 			   int *exported)
7233fc0ea795SAdrian Hunter {
7234fc0ea795SAdrian Hunter 	int ret;
7235fc0ea795SAdrian Hunter 
7236fc0ea795SAdrian Hunter 	preempt_disable();
7237fc0ea795SAdrian Hunter 	ret = ftrace_get_trampoline_kallsym(symnum, value, type, name,
7238fc0ea795SAdrian Hunter 					    module_name, exported);
7239fc0ea795SAdrian Hunter 	preempt_enable();
7240fc0ea795SAdrian Hunter 	return ret;
7241fc0ea795SAdrian Hunter }
724293eb677dSSteven Rostedt #endif /* CONFIG_MODULES */
724393eb677dSSteven Rostedt 
72448715b108SJoel Fernandes struct ftrace_init_func {
72458715b108SJoel Fernandes 	struct list_head list;
72468715b108SJoel Fernandes 	unsigned long ip;
72478715b108SJoel Fernandes };
72488715b108SJoel Fernandes 
72498715b108SJoel Fernandes /* Clear any init ips from hashes */
72508715b108SJoel Fernandes static void
72518715b108SJoel Fernandes clear_func_from_hash(struct ftrace_init_func *func, struct ftrace_hash *hash)
725242c269c8SSteven Rostedt (VMware) {
72538715b108SJoel Fernandes 	struct ftrace_func_entry *entry;
72548715b108SJoel Fernandes 
725508468754SChangbin Du 	entry = ftrace_lookup_ip(hash, func->ip);
72568715b108SJoel Fernandes 	/*
72578715b108SJoel Fernandes 	 * Do not allow this rec to match again.
72588715b108SJoel Fernandes 	 * Yeah, it may waste some memory, but will be removed
72598715b108SJoel Fernandes 	 * if/when the hash is modified again.
72608715b108SJoel Fernandes 	 */
72618715b108SJoel Fernandes 	if (entry)
72628715b108SJoel Fernandes 		entry->ip = 0;
72638715b108SJoel Fernandes }
72648715b108SJoel Fernandes 
72658715b108SJoel Fernandes static void
72668715b108SJoel Fernandes clear_func_from_hashes(struct ftrace_init_func *func)
72678715b108SJoel Fernandes {
72688715b108SJoel Fernandes 	struct trace_array *tr;
72698715b108SJoel Fernandes 
72708715b108SJoel Fernandes 	mutex_lock(&trace_types_lock);
72718715b108SJoel Fernandes 	list_for_each_entry(tr, &ftrace_trace_arrays, list) {
72728715b108SJoel Fernandes 		if (!tr->ops || !tr->ops->func_hash)
72738715b108SJoel Fernandes 			continue;
72748715b108SJoel Fernandes 		mutex_lock(&tr->ops->func_hash->regex_lock);
72758715b108SJoel Fernandes 		clear_func_from_hash(func, tr->ops->func_hash->filter_hash);
72768715b108SJoel Fernandes 		clear_func_from_hash(func, tr->ops->func_hash->notrace_hash);
72778715b108SJoel Fernandes 		mutex_unlock(&tr->ops->func_hash->regex_lock);
72788715b108SJoel Fernandes 	}
72798715b108SJoel Fernandes 	mutex_unlock(&trace_types_lock);
72808715b108SJoel Fernandes }
72818715b108SJoel Fernandes 
72828715b108SJoel Fernandes static void add_to_clear_hash_list(struct list_head *clear_list,
72838715b108SJoel Fernandes 				   struct dyn_ftrace *rec)
72848715b108SJoel Fernandes {
72858715b108SJoel Fernandes 	struct ftrace_init_func *func;
72868715b108SJoel Fernandes 
72878715b108SJoel Fernandes 	func = kmalloc(sizeof(*func), GFP_KERNEL);
72888715b108SJoel Fernandes 	if (!func) {
728924589e3aSSteven Rostedt (VMware) 		MEM_FAIL(1, "alloc failure, ftrace filter could be stale\n");
72908715b108SJoel Fernandes 		return;
72918715b108SJoel Fernandes 	}
72928715b108SJoel Fernandes 
72938715b108SJoel Fernandes 	func->ip = rec->ip;
72948715b108SJoel Fernandes 	list_add(&func->list, clear_list);
72958715b108SJoel Fernandes }
72968715b108SJoel Fernandes 
7297aba4b5c2SSteven Rostedt (VMware) void ftrace_free_mem(struct module *mod, void *start_ptr, void *end_ptr)
729842c269c8SSteven Rostedt (VMware) {
72996cafbe15SSteven Rostedt (VMware) 	unsigned long start = (unsigned long)(start_ptr);
73006cafbe15SSteven Rostedt (VMware) 	unsigned long end = (unsigned long)(end_ptr);
730142c269c8SSteven Rostedt (VMware) 	struct ftrace_page **last_pg = &ftrace_pages_start;
730242c269c8SSteven Rostedt (VMware) 	struct ftrace_page *pg;
730342c269c8SSteven Rostedt (VMware) 	struct dyn_ftrace *rec;
730442c269c8SSteven Rostedt (VMware) 	struct dyn_ftrace key;
7305aba4b5c2SSteven Rostedt (VMware) 	struct ftrace_mod_map *mod_map = NULL;
73068715b108SJoel Fernandes 	struct ftrace_init_func *func, *func_next;
73078715b108SJoel Fernandes 	struct list_head clear_hash;
730842c269c8SSteven Rostedt (VMware) 
73098715b108SJoel Fernandes 	INIT_LIST_HEAD(&clear_hash);
73108715b108SJoel Fernandes 
731142c269c8SSteven Rostedt (VMware) 	key.ip = start;
731242c269c8SSteven Rostedt (VMware) 	key.flags = end;	/* overload flags, as it is unsigned long */
731342c269c8SSteven Rostedt (VMware) 
731442c269c8SSteven Rostedt (VMware) 	mutex_lock(&ftrace_lock);
731542c269c8SSteven Rostedt (VMware) 
7316aba4b5c2SSteven Rostedt (VMware) 	/*
7317aba4b5c2SSteven Rostedt (VMware) 	 * If we are freeing module init memory, then check if
7318aba4b5c2SSteven Rostedt (VMware) 	 * any tracer is active. If so, we need to save a mapping of
7319aba4b5c2SSteven Rostedt (VMware) 	 * the module functions being freed with the address.
7320aba4b5c2SSteven Rostedt (VMware) 	 */
7321aba4b5c2SSteven Rostedt (VMware) 	if (mod && ftrace_ops_list != &ftrace_list_end)
7322aba4b5c2SSteven Rostedt (VMware) 		mod_map = allocate_ftrace_mod_map(mod, start, end);
7323aba4b5c2SSteven Rostedt (VMware) 
732442c269c8SSteven Rostedt (VMware) 	for (pg = ftrace_pages_start; pg; last_pg = &pg->next, pg = *last_pg) {
732542c269c8SSteven Rostedt (VMware) 		if (end < pg->records[0].ip ||
732642c269c8SSteven Rostedt (VMware) 		    start >= (pg->records[pg->index - 1].ip + MCOUNT_INSN_SIZE))
732742c269c8SSteven Rostedt (VMware) 			continue;
732842c269c8SSteven Rostedt (VMware)  again:
732942c269c8SSteven Rostedt (VMware) 		rec = bsearch(&key, pg->records, pg->index,
733042c269c8SSteven Rostedt (VMware) 			      sizeof(struct dyn_ftrace),
733142c269c8SSteven Rostedt (VMware) 			      ftrace_cmp_recs);
733242c269c8SSteven Rostedt (VMware) 		if (!rec)
733342c269c8SSteven Rostedt (VMware) 			continue;
7334aba4b5c2SSteven Rostedt (VMware) 
73358715b108SJoel Fernandes 		/* rec will be cleared from hashes after ftrace_lock unlock */
73368715b108SJoel Fernandes 		add_to_clear_hash_list(&clear_hash, rec);
73378715b108SJoel Fernandes 
7338aba4b5c2SSteven Rostedt (VMware) 		if (mod_map)
7339aba4b5c2SSteven Rostedt (VMware) 			save_ftrace_mod_rec(mod_map, rec);
7340aba4b5c2SSteven Rostedt (VMware) 
734142c269c8SSteven Rostedt (VMware) 		pg->index--;
73424ec78467SSteven Rostedt (VMware) 		ftrace_update_tot_cnt--;
734342c269c8SSteven Rostedt (VMware) 		if (!pg->index) {
734442c269c8SSteven Rostedt (VMware) 			*last_pg = pg->next;
7345db42523bSLinus Torvalds 			if (pg->records) {
7346db42523bSLinus Torvalds 				free_pages((unsigned long)pg->records, pg->order);
7347db42523bSLinus Torvalds 				ftrace_number_of_pages -= 1 << pg->order;
7348db42523bSLinus Torvalds 			}
7349da537f0aSSteven Rostedt (VMware) 			ftrace_number_of_groups--;
735042c269c8SSteven Rostedt (VMware) 			kfree(pg);
735142c269c8SSteven Rostedt (VMware) 			pg = container_of(last_pg, struct ftrace_page, next);
735242c269c8SSteven Rostedt (VMware) 			if (!(*last_pg))
735342c269c8SSteven Rostedt (VMware) 				ftrace_pages = pg;
735442c269c8SSteven Rostedt (VMware) 			continue;
735542c269c8SSteven Rostedt (VMware) 		}
735642c269c8SSteven Rostedt (VMware) 		memmove(rec, rec + 1,
735742c269c8SSteven Rostedt (VMware) 			(pg->index - (rec - pg->records)) * sizeof(*rec));
735842c269c8SSteven Rostedt (VMware) 		/* More than one function may be in this block */
735942c269c8SSteven Rostedt (VMware) 		goto again;
736042c269c8SSteven Rostedt (VMware) 	}
736142c269c8SSteven Rostedt (VMware) 	mutex_unlock(&ftrace_lock);
73628715b108SJoel Fernandes 
73638715b108SJoel Fernandes 	list_for_each_entry_safe(func, func_next, &clear_hash, list) {
73648715b108SJoel Fernandes 		clear_func_from_hashes(func);
73658715b108SJoel Fernandes 		kfree(func);
73668715b108SJoel Fernandes 	}
736742c269c8SSteven Rostedt (VMware) }
736842c269c8SSteven Rostedt (VMware) 
73696cafbe15SSteven Rostedt (VMware) void __init ftrace_free_init_mem(void)
73706cafbe15SSteven Rostedt (VMware) {
73716cafbe15SSteven Rostedt (VMware) 	void *start = (void *)(&__init_begin);
73726cafbe15SSteven Rostedt (VMware) 	void *end = (void *)(&__init_end);
73736cafbe15SSteven Rostedt (VMware) 
7374380af29bSSteven Rostedt (Google) 	ftrace_boot_snapshot();
7375380af29bSSteven Rostedt (Google) 
7376aba4b5c2SSteven Rostedt (VMware) 	ftrace_free_mem(NULL, start, end);
737793eb677dSSteven Rostedt }
737893eb677dSSteven Rostedt 
73796644c654SWeizhao Ouyang int __init __weak ftrace_dyn_arch_init(void)
73806644c654SWeizhao Ouyang {
73816644c654SWeizhao Ouyang 	return 0;
73826644c654SWeizhao Ouyang }
73836644c654SWeizhao Ouyang 
738468bf21aaSSteven Rostedt void __init ftrace_init(void)
738568bf21aaSSteven Rostedt {
73861dc43cf0SJiri Slaby 	extern unsigned long __start_mcount_loc[];
73871dc43cf0SJiri Slaby 	extern unsigned long __stop_mcount_loc[];
73883a36cb11SJiri Slaby 	unsigned long count, flags;
738968bf21aaSSteven Rostedt 	int ret;
739068bf21aaSSteven Rostedt 
739168bf21aaSSteven Rostedt 	local_irq_save(flags);
73923a36cb11SJiri Slaby 	ret = ftrace_dyn_arch_init();
739368bf21aaSSteven Rostedt 	local_irq_restore(flags);
7394af64a7cbSJiri Slaby 	if (ret)
739568bf21aaSSteven Rostedt 		goto failed;
739668bf21aaSSteven Rostedt 
739768bf21aaSSteven Rostedt 	count = __stop_mcount_loc - __start_mcount_loc;
7398c867ccd8SJiri Slaby 	if (!count) {
7399c867ccd8SJiri Slaby 		pr_info("ftrace: No functions to be traced?\n");
740068bf21aaSSteven Rostedt 		goto failed;
7401c867ccd8SJiri Slaby 	}
7402c867ccd8SJiri Slaby 
7403c867ccd8SJiri Slaby 	pr_info("ftrace: allocating %ld entries in %ld pages\n",
7404c867ccd8SJiri Slaby 		count, count / ENTRIES_PER_PAGE + 1);
740568bf21aaSSteven Rostedt 
74065cb084bbSJiri Olsa 	ret = ftrace_process_locs(NULL,
740731e88909SSteven Rostedt 				  __start_mcount_loc,
740868bf21aaSSteven Rostedt 				  __stop_mcount_loc);
74092889c658SYuntao Wang 	if (ret) {
74102889c658SYuntao Wang 		pr_warn("ftrace: failed to allocate entries for functions\n");
74112889c658SYuntao Wang 		goto failed;
74122889c658SYuntao Wang 	}
741368bf21aaSSteven Rostedt 
7414da537f0aSSteven Rostedt (VMware) 	pr_info("ftrace: allocated %ld pages with %ld groups\n",
7415da537f0aSSteven Rostedt (VMware) 		ftrace_number_of_pages, ftrace_number_of_groups);
7416da537f0aSSteven Rostedt (VMware) 
74172889c658SYuntao Wang 	last_ftrace_enabled = ftrace_enabled = 1;
74182889c658SYuntao Wang 
74192af15d6aSSteven Rostedt 	set_ftrace_early_filters();
74202af15d6aSSteven Rostedt 
742168bf21aaSSteven Rostedt 	return;
742268bf21aaSSteven Rostedt  failed:
742368bf21aaSSteven Rostedt 	ftrace_disabled = 1;
742468bf21aaSSteven Rostedt }
742568bf21aaSSteven Rostedt 
7426f3bea491SSteven Rostedt (Red Hat) /* Do nothing if arch does not support this */
7427f3bea491SSteven Rostedt (Red Hat) void __weak arch_ftrace_update_trampoline(struct ftrace_ops *ops)
7428f3bea491SSteven Rostedt (Red Hat) {
7429f3bea491SSteven Rostedt (Red Hat) }
7430f3bea491SSteven Rostedt (Red Hat) 
7431f3bea491SSteven Rostedt (Red Hat) static void ftrace_update_trampoline(struct ftrace_ops *ops)
7432f3bea491SSteven Rostedt (Red Hat) {
7433fc0ea795SAdrian Hunter 	unsigned long trampoline = ops->trampoline;
7434fc0ea795SAdrian Hunter 
7435f3bea491SSteven Rostedt (Red Hat) 	arch_ftrace_update_trampoline(ops);
7436fc0ea795SAdrian Hunter 	if (ops->trampoline && ops->trampoline != trampoline &&
7437dd9ddf46SAdrian Hunter 	    (ops->flags & FTRACE_OPS_FL_ALLOC_TRAMP)) {
7438dd9ddf46SAdrian Hunter 		/* Add to kallsyms before the perf events */
7439fc0ea795SAdrian Hunter 		ftrace_add_trampoline_to_kallsyms(ops);
7440dd9ddf46SAdrian Hunter 		perf_event_ksymbol(PERF_RECORD_KSYMBOL_TYPE_OOL,
7441dd9ddf46SAdrian Hunter 				   ops->trampoline, ops->trampoline_size, false,
7442dd9ddf46SAdrian Hunter 				   FTRACE_TRAMPOLINE_SYM);
7443548e1f6cSAdrian Hunter 		/*
7444548e1f6cSAdrian Hunter 		 * Record the perf text poke event after the ksymbol register
7445548e1f6cSAdrian Hunter 		 * event.
7446548e1f6cSAdrian Hunter 		 */
7447548e1f6cSAdrian Hunter 		perf_event_text_poke((void *)ops->trampoline, NULL, 0,
7448548e1f6cSAdrian Hunter 				     (void *)ops->trampoline,
7449548e1f6cSAdrian Hunter 				     ops->trampoline_size);
7450dd9ddf46SAdrian Hunter 	}
7451f3bea491SSteven Rostedt (Red Hat) }
7452f3bea491SSteven Rostedt (Red Hat) 
745304ec7bb6SSteven Rostedt (VMware) void ftrace_init_trace_array(struct trace_array *tr)
745404ec7bb6SSteven Rostedt (VMware) {
745504ec7bb6SSteven Rostedt (VMware) 	INIT_LIST_HEAD(&tr->func_probes);
7456673feb9dSSteven Rostedt (VMware) 	INIT_LIST_HEAD(&tr->mod_trace);
7457673feb9dSSteven Rostedt (VMware) 	INIT_LIST_HEAD(&tr->mod_notrace);
745804ec7bb6SSteven Rostedt (VMware) }
74593d083395SSteven Rostedt #else
74600b6e4d56SFrederic Weisbecker 
74613306fc4aSSteven Rostedt (VMware) struct ftrace_ops global_ops = {
7462bd69c30bSSteven Rostedt 	.func			= ftrace_stub,
7463a25d036dSSteven Rostedt (VMware) 	.flags			= FTRACE_OPS_FL_INITIALIZED |
7464e3eea140SSteven Rostedt (Red Hat) 				  FTRACE_OPS_FL_PID,
7465bd69c30bSSteven Rostedt };
7466bd69c30bSSteven Rostedt 
74670b6e4d56SFrederic Weisbecker static int __init ftrace_nodyn_init(void)
74680b6e4d56SFrederic Weisbecker {
74690b6e4d56SFrederic Weisbecker 	ftrace_enabled = 1;
74700b6e4d56SFrederic Weisbecker 	return 0;
74710b6e4d56SFrederic Weisbecker }
74726f415672SSteven Rostedt core_initcall(ftrace_nodyn_init);
74730b6e4d56SFrederic Weisbecker 
74748434dc93SSteven Rostedt (Red Hat) static inline int ftrace_init_dyn_tracefs(struct dentry *d_tracer) { return 0; }
7475e1effa01SSteven Rostedt (Red Hat) static inline void ftrace_startup_all(int command) { }
74768a56d776SSteven Rostedt (Red Hat) 
7477f3bea491SSteven Rostedt (Red Hat) static void ftrace_update_trampoline(struct ftrace_ops *ops)
7478f3bea491SSteven Rostedt (Red Hat) {
7479f3bea491SSteven Rostedt (Red Hat) }
7480f3bea491SSteven Rostedt (Red Hat) 
74813d083395SSteven Rostedt #endif /* CONFIG_DYNAMIC_FTRACE */
74823d083395SSteven Rostedt 
74834104d326SSteven Rostedt (Red Hat) __init void ftrace_init_global_array_ops(struct trace_array *tr)
74844104d326SSteven Rostedt (Red Hat) {
74854104d326SSteven Rostedt (Red Hat) 	tr->ops = &global_ops;
74864104d326SSteven Rostedt (Red Hat) 	tr->ops->private = tr;
748704ec7bb6SSteven Rostedt (VMware) 	ftrace_init_trace_array(tr);
74884104d326SSteven Rostedt (Red Hat) }
74894104d326SSteven Rostedt (Red Hat) 
74904104d326SSteven Rostedt (Red Hat) void ftrace_init_array_ops(struct trace_array *tr, ftrace_func_t func)
74914104d326SSteven Rostedt (Red Hat) {
74924104d326SSteven Rostedt (Red Hat) 	/* If we filter on pids, update to use the pid function */
74934104d326SSteven Rostedt (Red Hat) 	if (tr->flags & TRACE_ARRAY_FL_GLOBAL) {
74944104d326SSteven Rostedt (Red Hat) 		if (WARN_ON(tr->ops->func != ftrace_stub))
74954104d326SSteven Rostedt (Red Hat) 			printk("ftrace ops had %pS for function\n",
74964104d326SSteven Rostedt (Red Hat) 			       tr->ops->func);
74974104d326SSteven Rostedt (Red Hat) 	}
74984104d326SSteven Rostedt (Red Hat) 	tr->ops->func = func;
74994104d326SSteven Rostedt (Red Hat) 	tr->ops->private = tr;
75004104d326SSteven Rostedt (Red Hat) }
75014104d326SSteven Rostedt (Red Hat) 
75024104d326SSteven Rostedt (Red Hat) void ftrace_reset_array_ops(struct trace_array *tr)
75034104d326SSteven Rostedt (Red Hat) {
75044104d326SSteven Rostedt (Red Hat) 	tr->ops->func = ftrace_stub;
75054104d326SSteven Rostedt (Red Hat) }
75064104d326SSteven Rostedt (Red Hat) 
7507fabe38abSMasami Hiramatsu static nokprobe_inline void
75082f5f6ad9SSteven Rostedt __ftrace_ops_list_func(unsigned long ip, unsigned long parent_ip,
7509d19ad077SSteven Rostedt (VMware) 		       struct ftrace_ops *ignored, struct ftrace_regs *fregs)
7510b848914cSSteven Rostedt {
7511d19ad077SSteven Rostedt (VMware) 	struct pt_regs *regs = ftrace_get_regs(fregs);
7512cdbe61bfSSteven Rostedt 	struct ftrace_ops *op;
7513edc15cafSSteven Rostedt 	int bit;
7514b848914cSSteven Rostedt 
7515ce5e4803S王贇 	/*
7516ce5e4803S王贇 	 * The ftrace_test_and_set_recursion() will disable preemption,
7517ce5e4803S王贇 	 * which is required since some of the ops may be dynamically
7518ce5e4803S王贇 	 * allocated, they must be freed after a synchronize_rcu().
7519ce5e4803S王贇 	 */
7520ed65df63SSteven Rostedt (VMware) 	bit = trace_test_and_set_recursion(ip, parent_ip, TRACE_LIST_START);
7521edc15cafSSteven Rostedt 	if (bit < 0)
7522b1cff0adSSteven Rostedt 		return;
7523b1cff0adSSteven Rostedt 
75240a016409SSteven Rostedt 	do_for_each_ftrace_op(op, ftrace_ops_list) {
75252fa717a0SSteven Rostedt (VMware) 		/* Stub functions don't need to be called nor tested */
75262fa717a0SSteven Rostedt (VMware) 		if (op->flags & FTRACE_OPS_FL_STUB)
75272fa717a0SSteven Rostedt (VMware) 			continue;
7528ba27f2bcSSteven Rostedt (Red Hat) 		/*
7529ba27f2bcSSteven Rostedt (Red Hat) 		 * Check the following for each ops before calling their func:
7530ba27f2bcSSteven Rostedt (Red Hat) 		 *  if RCU flag is set, then rcu_is_watching() must be true
7531ba27f2bcSSteven Rostedt (Red Hat) 		 *  if PER_CPU is set, then ftrace_function_local_disable()
7532ba27f2bcSSteven Rostedt (Red Hat) 		 *                          must be false
7533ba27f2bcSSteven Rostedt (Red Hat) 		 *  Otherwise test if the ip matches the ops filter
7534ba27f2bcSSteven Rostedt (Red Hat) 		 *
7535ba27f2bcSSteven Rostedt (Red Hat) 		 * If any of the above fails then the op->func() is not executed.
7536ba27f2bcSSteven Rostedt (Red Hat) 		 */
7537ba27f2bcSSteven Rostedt (Red Hat) 		if ((!(op->flags & FTRACE_OPS_FL_RCU) || rcu_is_watching()) &&
7538ba27f2bcSSteven Rostedt (Red Hat) 		    ftrace_ops_test(op, ip, regs)) {
75391d48d596SSteven Rostedt (Red Hat) 			if (FTRACE_WARN_ON(!op->func)) {
75401d48d596SSteven Rostedt (Red Hat) 				pr_warn("op=%p %pS\n", op, op);
75414104d326SSteven Rostedt (Red Hat) 				goto out;
75424104d326SSteven Rostedt (Red Hat) 			}
7543d19ad077SSteven Rostedt (VMware) 			op->func(ip, parent_ip, op, fregs);
75444104d326SSteven Rostedt (Red Hat) 		}
75450a016409SSteven Rostedt 	} while_for_each_ftrace_op(op);
75464104d326SSteven Rostedt (Red Hat) out:
7547edc15cafSSteven Rostedt 	trace_clear_recursion(bit);
7548b848914cSSteven Rostedt }
7549b848914cSSteven Rostedt 
75502f5f6ad9SSteven Rostedt /*
75512f5f6ad9SSteven Rostedt  * Some archs only support passing ip and parent_ip. Even though
75522f5f6ad9SSteven Rostedt  * the list function ignores the op parameter, we do not want any
75532f5f6ad9SSteven Rostedt  * C side effects, where a function is called without the caller
75542f5f6ad9SSteven Rostedt  * sending a third parameter.
7555a1e2e31dSSteven Rostedt  * Archs are to support both the regs and ftrace_ops at the same time.
7556a1e2e31dSSteven Rostedt  * If they support ftrace_ops, it is assumed they support regs.
7557a1e2e31dSSteven Rostedt  * If call backs want to use regs, they must either check for regs
755806aeaaeaSMasami Hiramatsu  * being NULL, or CONFIG_DYNAMIC_FTRACE_WITH_REGS.
755906aeaaeaSMasami Hiramatsu  * Note, CONFIG_DYNAMIC_FTRACE_WITH_REGS expects a full regs to be saved.
7560a1e2e31dSSteven Rostedt  * An architecture can pass partial regs with ftrace_ops and still
7561b8ec330aSLi Bin  * set the ARCH_SUPPORTS_FTRACE_OPS.
756234cdd18bSSteven Rostedt (VMware)  *
756334cdd18bSSteven Rostedt (VMware)  * In vmlinux.lds.h, ftrace_ops_list_func() is defined to be
756434cdd18bSSteven Rostedt (VMware)  * arch_ftrace_ops_list_func.
75652f5f6ad9SSteven Rostedt  */
75662f5f6ad9SSteven Rostedt #if ARCH_SUPPORTS_FTRACE_OPS
756734cdd18bSSteven Rostedt (VMware) void arch_ftrace_ops_list_func(unsigned long ip, unsigned long parent_ip,
7568d19ad077SSteven Rostedt (VMware) 			       struct ftrace_ops *op, struct ftrace_regs *fregs)
75692f5f6ad9SSteven Rostedt {
7570d19ad077SSteven Rostedt (VMware) 	__ftrace_ops_list_func(ip, parent_ip, NULL, fregs);
75712f5f6ad9SSteven Rostedt }
75722f5f6ad9SSteven Rostedt #else
757334cdd18bSSteven Rostedt (VMware) void arch_ftrace_ops_list_func(unsigned long ip, unsigned long parent_ip)
75742f5f6ad9SSteven Rostedt {
7575a1e2e31dSSteven Rostedt 	__ftrace_ops_list_func(ip, parent_ip, NULL, NULL);
75762f5f6ad9SSteven Rostedt }
75772f5f6ad9SSteven Rostedt #endif
757834cdd18bSSteven Rostedt (VMware) NOKPROBE_SYMBOL(arch_ftrace_ops_list_func);
75792f5f6ad9SSteven Rostedt 
7580f1ff6348SSteven Rostedt (Red Hat) /*
7581f1ff6348SSteven Rostedt (Red Hat)  * If there's only one function registered but it does not support
7582c68c0fa2SSteven Rostedt (Red Hat)  * recursion, needs RCU protection and/or requires per cpu handling, then
7583c68c0fa2SSteven Rostedt (Red Hat)  * this function will be called by the mcount trampoline.
7584f1ff6348SSteven Rostedt (Red Hat)  */
7585c68c0fa2SSteven Rostedt (Red Hat) static void ftrace_ops_assist_func(unsigned long ip, unsigned long parent_ip,
7586d19ad077SSteven Rostedt (VMware) 				   struct ftrace_ops *op, struct ftrace_regs *fregs)
7587f1ff6348SSteven Rostedt (Red Hat) {
7588f1ff6348SSteven Rostedt (Red Hat) 	int bit;
7589f1ff6348SSteven Rostedt (Red Hat) 
7590ed65df63SSteven Rostedt (VMware) 	bit = trace_test_and_set_recursion(ip, parent_ip, TRACE_LIST_START);
7591f1ff6348SSteven Rostedt (Red Hat) 	if (bit < 0)
7592f1ff6348SSteven Rostedt (Red Hat) 		return;
7593f1ff6348SSteven Rostedt (Red Hat) 
7594b40341faSSteven Rostedt (VMware) 	if (!(op->flags & FTRACE_OPS_FL_RCU) || rcu_is_watching())
7595d19ad077SSteven Rostedt (VMware) 		op->func(ip, parent_ip, op, fregs);
7596c68c0fa2SSteven Rostedt (Red Hat) 
7597f1ff6348SSteven Rostedt (Red Hat) 	trace_clear_recursion(bit);
7598f1ff6348SSteven Rostedt (Red Hat) }
7599fabe38abSMasami Hiramatsu NOKPROBE_SYMBOL(ftrace_ops_assist_func);
7600f1ff6348SSteven Rostedt (Red Hat) 
760187354059SSteven Rostedt (Red Hat) /**
760287354059SSteven Rostedt (Red Hat)  * ftrace_ops_get_func - get the function a trampoline should call
760387354059SSteven Rostedt (Red Hat)  * @ops: the ops to get the function for
760487354059SSteven Rostedt (Red Hat)  *
760587354059SSteven Rostedt (Red Hat)  * Normally the mcount trampoline will call the ops->func, but there
760687354059SSteven Rostedt (Red Hat)  * are times that it should not. For example, if the ops does not
760787354059SSteven Rostedt (Red Hat)  * have its own recursion protection, then it should call the
76083a150df9SChunyu Hu  * ftrace_ops_assist_func() instead.
760987354059SSteven Rostedt (Red Hat)  *
761087354059SSteven Rostedt (Red Hat)  * Returns the function that the trampoline should call for @ops.
761187354059SSteven Rostedt (Red Hat)  */
761287354059SSteven Rostedt (Red Hat) ftrace_func_t ftrace_ops_get_func(struct ftrace_ops *ops)
761387354059SSteven Rostedt (Red Hat) {
761487354059SSteven Rostedt (Red Hat) 	/*
7615a25d036dSSteven Rostedt (VMware) 	 * If the function does not handle recursion or needs to be RCU safe,
7616a25d036dSSteven Rostedt (VMware) 	 * then we need to call the assist handler.
761787354059SSteven Rostedt (Red Hat) 	 */
7618a25d036dSSteven Rostedt (VMware) 	if (ops->flags & (FTRACE_OPS_FL_RECURSION |
7619a25d036dSSteven Rostedt (VMware) 			  FTRACE_OPS_FL_RCU))
7620c68c0fa2SSteven Rostedt (Red Hat) 		return ftrace_ops_assist_func;
762187354059SSteven Rostedt (Red Hat) 
762287354059SSteven Rostedt (Red Hat) 	return ops->func;
762387354059SSteven Rostedt (Red Hat) }
762487354059SSteven Rostedt (Red Hat) 
7625345ddcc8SSteven Rostedt (Red Hat) static void
7626345ddcc8SSteven Rostedt (Red Hat) ftrace_filter_pid_sched_switch_probe(void *data, bool preempt,
7627fa2c3254SValentin Schneider 				     struct task_struct *prev,
76289c2136beSDelyan Kratunov 				     struct task_struct *next,
76299c2136beSDelyan Kratunov 				     unsigned int prev_state)
7630e32d8956SSteven Rostedt {
7631345ddcc8SSteven Rostedt (Red Hat) 	struct trace_array *tr = data;
7632345ddcc8SSteven Rostedt (Red Hat) 	struct trace_pid_list *pid_list;
7633b3b1e6edSSteven Rostedt (VMware) 	struct trace_pid_list *no_pid_list;
7634345ddcc8SSteven Rostedt (Red Hat) 
7635345ddcc8SSteven Rostedt (Red Hat) 	pid_list = rcu_dereference_sched(tr->function_pids);
7636b3b1e6edSSteven Rostedt (VMware) 	no_pid_list = rcu_dereference_sched(tr->function_no_pids);
7637345ddcc8SSteven Rostedt (Red Hat) 
7638b3b1e6edSSteven Rostedt (VMware) 	if (trace_ignore_this_task(pid_list, no_pid_list, next))
76391c5eb448SSteven Rostedt (VMware) 		this_cpu_write(tr->array_buffer.data->ftrace_ignore_pid,
7640717e3f5eSSteven Rostedt (VMware) 			       FTRACE_PID_IGNORE);
7641717e3f5eSSteven Rostedt (VMware) 	else
7642717e3f5eSSteven Rostedt (VMware) 		this_cpu_write(tr->array_buffer.data->ftrace_ignore_pid,
7643717e3f5eSSteven Rostedt (VMware) 			       next->pid);
7644345ddcc8SSteven Rostedt (Red Hat) }
7645345ddcc8SSteven Rostedt (Red Hat) 
76461e10486fSNamhyung Kim static void
76471e10486fSNamhyung Kim ftrace_pid_follow_sched_process_fork(void *data,
76481e10486fSNamhyung Kim 				     struct task_struct *self,
76491e10486fSNamhyung Kim 				     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, self, 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, self, task);
76591e10486fSNamhyung Kim }
76601e10486fSNamhyung Kim 
76611e10486fSNamhyung Kim static void
76621e10486fSNamhyung Kim ftrace_pid_follow_sched_process_exit(void *data, struct task_struct *task)
76631e10486fSNamhyung Kim {
76641e10486fSNamhyung Kim 	struct trace_pid_list *pid_list;
76651e10486fSNamhyung Kim 	struct trace_array *tr = data;
76661e10486fSNamhyung Kim 
76671e10486fSNamhyung Kim 	pid_list = rcu_dereference_sched(tr->function_pids);
76681e10486fSNamhyung Kim 	trace_filter_add_remove_task(pid_list, NULL, task);
7669b3b1e6edSSteven Rostedt (VMware) 
7670b3b1e6edSSteven Rostedt (VMware) 	pid_list = rcu_dereference_sched(tr->function_no_pids);
7671b3b1e6edSSteven Rostedt (VMware) 	trace_filter_add_remove_task(pid_list, NULL, task);
76721e10486fSNamhyung Kim }
76731e10486fSNamhyung Kim 
76741e10486fSNamhyung Kim void ftrace_pid_follow_fork(struct trace_array *tr, bool enable)
76751e10486fSNamhyung Kim {
76761e10486fSNamhyung Kim 	if (enable) {
76771e10486fSNamhyung Kim 		register_trace_sched_process_fork(ftrace_pid_follow_sched_process_fork,
76781e10486fSNamhyung Kim 						  tr);
7679afcab636SSteven Rostedt (VMware) 		register_trace_sched_process_free(ftrace_pid_follow_sched_process_exit,
76801e10486fSNamhyung Kim 						  tr);
76811e10486fSNamhyung Kim 	} else {
76821e10486fSNamhyung Kim 		unregister_trace_sched_process_fork(ftrace_pid_follow_sched_process_fork,
76831e10486fSNamhyung Kim 						    tr);
7684afcab636SSteven Rostedt (VMware) 		unregister_trace_sched_process_free(ftrace_pid_follow_sched_process_exit,
76851e10486fSNamhyung Kim 						    tr);
76861e10486fSNamhyung Kim 	}
76871e10486fSNamhyung Kim }
76881e10486fSNamhyung Kim 
7689b3b1e6edSSteven Rostedt (VMware) static void clear_ftrace_pids(struct trace_array *tr, int type)
7690345ddcc8SSteven Rostedt (Red Hat) {
7691345ddcc8SSteven Rostedt (Red Hat) 	struct trace_pid_list *pid_list;
7692b3b1e6edSSteven Rostedt (VMware) 	struct trace_pid_list *no_pid_list;
7693e32d8956SSteven Rostedt 	int cpu;
7694e32d8956SSteven Rostedt 
7695345ddcc8SSteven Rostedt (Red Hat) 	pid_list = rcu_dereference_protected(tr->function_pids,
7696345ddcc8SSteven Rostedt (Red Hat) 					     lockdep_is_held(&ftrace_lock));
7697b3b1e6edSSteven Rostedt (VMware) 	no_pid_list = rcu_dereference_protected(tr->function_no_pids,
7698b3b1e6edSSteven Rostedt (VMware) 						lockdep_is_held(&ftrace_lock));
7699b3b1e6edSSteven Rostedt (VMware) 
7700b3b1e6edSSteven Rostedt (VMware) 	/* Make sure there's something to do */
770127683626SSteven Rostedt (VMware) 	if (!pid_type_enabled(type, pid_list, no_pid_list))
7702345ddcc8SSteven Rostedt (Red Hat) 		return;
7703345ddcc8SSteven Rostedt (Red Hat) 
7704b3b1e6edSSteven Rostedt (VMware) 	/* See if the pids still need to be checked after this */
770527683626SSteven Rostedt (VMware) 	if (!still_need_pid_events(type, pid_list, no_pid_list)) {
7706345ddcc8SSteven Rostedt (Red Hat) 		unregister_trace_sched_switch(ftrace_filter_pid_sched_switch_probe, tr);
7707345ddcc8SSteven Rostedt (Red Hat) 		for_each_possible_cpu(cpu)
7708717e3f5eSSteven Rostedt (VMware) 			per_cpu_ptr(tr->array_buffer.data, cpu)->ftrace_ignore_pid = FTRACE_PID_TRACE;
7709b3b1e6edSSteven Rostedt (VMware) 	}
7710345ddcc8SSteven Rostedt (Red Hat) 
7711b3b1e6edSSteven Rostedt (VMware) 	if (type & TRACE_PIDS)
7712345ddcc8SSteven Rostedt (Red Hat) 		rcu_assign_pointer(tr->function_pids, NULL);
7713345ddcc8SSteven Rostedt (Red Hat) 
7714b3b1e6edSSteven Rostedt (VMware) 	if (type & TRACE_NO_PIDS)
7715b3b1e6edSSteven Rostedt (VMware) 		rcu_assign_pointer(tr->function_no_pids, NULL);
7716b3b1e6edSSteven Rostedt (VMware) 
7717345ddcc8SSteven Rostedt (Red Hat) 	/* Wait till all users are no longer using pid filtering */
771874401729SPaul E. McKenney 	synchronize_rcu();
7719345ddcc8SSteven Rostedt (Red Hat) 
7720b3b1e6edSSteven Rostedt (VMware) 	if ((type & TRACE_PIDS) && pid_list)
77216954e415SSteven Rostedt (VMware) 		trace_pid_list_free(pid_list);
7722b3b1e6edSSteven Rostedt (VMware) 
7723b3b1e6edSSteven Rostedt (VMware) 	if ((type & TRACE_NO_PIDS) && no_pid_list)
77246954e415SSteven Rostedt (VMware) 		trace_pid_list_free(no_pid_list);
7725e32d8956SSteven Rostedt }
7726e32d8956SSteven Rostedt 
7727d879d0b8SNamhyung Kim void ftrace_clear_pids(struct trace_array *tr)
7728d879d0b8SNamhyung Kim {
7729d879d0b8SNamhyung Kim 	mutex_lock(&ftrace_lock);
7730d879d0b8SNamhyung Kim 
7731b3b1e6edSSteven Rostedt (VMware) 	clear_ftrace_pids(tr, TRACE_PIDS | TRACE_NO_PIDS);
7732d879d0b8SNamhyung Kim 
7733d879d0b8SNamhyung Kim 	mutex_unlock(&ftrace_lock);
7734d879d0b8SNamhyung Kim }
7735d879d0b8SNamhyung Kim 
7736b3b1e6edSSteven Rostedt (VMware) static void ftrace_pid_reset(struct trace_array *tr, int type)
7737e32d8956SSteven Rostedt {
7738756d17eeS[email protected] 	mutex_lock(&ftrace_lock);
7739b3b1e6edSSteven Rostedt (VMware) 	clear_ftrace_pids(tr, type);
7740756d17eeS[email protected] 
7741756d17eeS[email protected] 	ftrace_update_pid_func();
7742e1effa01SSteven Rostedt (Red Hat) 	ftrace_startup_all(0);
7743756d17eeS[email protected] 
7744756d17eeS[email protected] 	mutex_unlock(&ftrace_lock);
7745756d17eeS[email protected] }
7746756d17eeS[email protected] 
7747345ddcc8SSteven Rostedt (Red Hat) /* Greater than any max PID */
7748345ddcc8SSteven Rostedt (Red Hat) #define FTRACE_NO_PIDS		(void *)(PID_MAX_LIMIT + 1)
7749345ddcc8SSteven Rostedt (Red Hat) 
7750756d17eeS[email protected] static void *fpid_start(struct seq_file *m, loff_t *pos)
7751345ddcc8SSteven Rostedt (Red Hat) 	__acquires(RCU)
7752756d17eeS[email protected] {
7753345ddcc8SSteven Rostedt (Red Hat) 	struct trace_pid_list *pid_list;
7754345ddcc8SSteven Rostedt (Red Hat) 	struct trace_array *tr = m->private;
7755345ddcc8SSteven Rostedt (Red Hat) 
7756756d17eeS[email protected] 	mutex_lock(&ftrace_lock);
7757345ddcc8SSteven Rostedt (Red Hat) 	rcu_read_lock_sched();
7758756d17eeS[email protected] 
7759345ddcc8SSteven Rostedt (Red Hat) 	pid_list = rcu_dereference_sched(tr->function_pids);
7760756d17eeS[email protected] 
7761345ddcc8SSteven Rostedt (Red Hat) 	if (!pid_list)
7762345ddcc8SSteven Rostedt (Red Hat) 		return !(*pos) ? FTRACE_NO_PIDS : NULL;
7763345ddcc8SSteven Rostedt (Red Hat) 
7764345ddcc8SSteven Rostedt (Red Hat) 	return trace_pid_start(pid_list, pos);
7765756d17eeS[email protected] }
7766756d17eeS[email protected] 
7767756d17eeS[email protected] static void *fpid_next(struct seq_file *m, void *v, loff_t *pos)
7768756d17eeS[email protected] {
7769345ddcc8SSteven Rostedt (Red Hat) 	struct trace_array *tr = m->private;
7770345ddcc8SSteven Rostedt (Red Hat) 	struct trace_pid_list *pid_list = rcu_dereference_sched(tr->function_pids);
7771345ddcc8SSteven Rostedt (Red Hat) 
7772e4075e8bSVasily Averin 	if (v == FTRACE_NO_PIDS) {
7773e4075e8bSVasily Averin 		(*pos)++;
7774756d17eeS[email protected] 		return NULL;
7775e4075e8bSVasily Averin 	}
7776345ddcc8SSteven Rostedt (Red Hat) 	return trace_pid_next(pid_list, v, pos);
7777756d17eeS[email protected] }
7778756d17eeS[email protected] 
7779756d17eeS[email protected] static void fpid_stop(struct seq_file *m, void *p)
7780345ddcc8SSteven Rostedt (Red Hat) 	__releases(RCU)
7781756d17eeS[email protected] {
7782345ddcc8SSteven Rostedt (Red Hat) 	rcu_read_unlock_sched();
7783756d17eeS[email protected] 	mutex_unlock(&ftrace_lock);
7784756d17eeS[email protected] }
7785756d17eeS[email protected] 
7786756d17eeS[email protected] static int fpid_show(struct seq_file *m, void *v)
7787756d17eeS[email protected] {
7788345ddcc8SSteven Rostedt (Red Hat) 	if (v == FTRACE_NO_PIDS) {
7789fa6f0cc7SRasmus Villemoes 		seq_puts(m, "no pid\n");
7790756d17eeS[email protected] 		return 0;
7791756d17eeS[email protected] 	}
7792756d17eeS[email protected] 
7793345ddcc8SSteven Rostedt (Red Hat) 	return trace_pid_show(m, v);
7794756d17eeS[email protected] }
7795756d17eeS[email protected] 
7796756d17eeS[email protected] static const struct seq_operations ftrace_pid_sops = {
7797756d17eeS[email protected] 	.start = fpid_start,
7798756d17eeS[email protected] 	.next = fpid_next,
7799756d17eeS[email protected] 	.stop = fpid_stop,
7800756d17eeS[email protected] 	.show = fpid_show,
7801756d17eeS[email protected] };
7802756d17eeS[email protected] 
7803b3b1e6edSSteven Rostedt (VMware) static void *fnpid_start(struct seq_file *m, loff_t *pos)
7804b3b1e6edSSteven Rostedt (VMware) 	__acquires(RCU)
7805756d17eeS[email protected] {
7806b3b1e6edSSteven Rostedt (VMware) 	struct trace_pid_list *pid_list;
7807b3b1e6edSSteven Rostedt (VMware) 	struct trace_array *tr = m->private;
7808b3b1e6edSSteven Rostedt (VMware) 
7809b3b1e6edSSteven Rostedt (VMware) 	mutex_lock(&ftrace_lock);
7810b3b1e6edSSteven Rostedt (VMware) 	rcu_read_lock_sched();
7811b3b1e6edSSteven Rostedt (VMware) 
7812b3b1e6edSSteven Rostedt (VMware) 	pid_list = rcu_dereference_sched(tr->function_no_pids);
7813b3b1e6edSSteven Rostedt (VMware) 
7814b3b1e6edSSteven Rostedt (VMware) 	if (!pid_list)
7815b3b1e6edSSteven Rostedt (VMware) 		return !(*pos) ? FTRACE_NO_PIDS : NULL;
7816b3b1e6edSSteven Rostedt (VMware) 
7817b3b1e6edSSteven Rostedt (VMware) 	return trace_pid_start(pid_list, pos);
7818b3b1e6edSSteven Rostedt (VMware) }
7819b3b1e6edSSteven Rostedt (VMware) 
7820b3b1e6edSSteven Rostedt (VMware) static void *fnpid_next(struct seq_file *m, void *v, loff_t *pos)
7821b3b1e6edSSteven Rostedt (VMware) {
7822b3b1e6edSSteven Rostedt (VMware) 	struct trace_array *tr = m->private;
7823b3b1e6edSSteven Rostedt (VMware) 	struct trace_pid_list *pid_list = rcu_dereference_sched(tr->function_no_pids);
7824b3b1e6edSSteven Rostedt (VMware) 
7825b3b1e6edSSteven Rostedt (VMware) 	if (v == FTRACE_NO_PIDS) {
7826b3b1e6edSSteven Rostedt (VMware) 		(*pos)++;
7827b3b1e6edSSteven Rostedt (VMware) 		return NULL;
7828b3b1e6edSSteven Rostedt (VMware) 	}
7829b3b1e6edSSteven Rostedt (VMware) 	return trace_pid_next(pid_list, v, pos);
7830b3b1e6edSSteven Rostedt (VMware) }
7831b3b1e6edSSteven Rostedt (VMware) 
7832b3b1e6edSSteven Rostedt (VMware) static const struct seq_operations ftrace_no_pid_sops = {
7833b3b1e6edSSteven Rostedt (VMware) 	.start = fnpid_start,
7834b3b1e6edSSteven Rostedt (VMware) 	.next = fnpid_next,
7835b3b1e6edSSteven Rostedt (VMware) 	.stop = fpid_stop,
7836b3b1e6edSSteven Rostedt (VMware) 	.show = fpid_show,
7837b3b1e6edSSteven Rostedt (VMware) };
7838b3b1e6edSSteven Rostedt (VMware) 
7839b3b1e6edSSteven Rostedt (VMware) static int pid_open(struct inode *inode, struct file *file, int type)
7840b3b1e6edSSteven Rostedt (VMware) {
7841b3b1e6edSSteven Rostedt (VMware) 	const struct seq_operations *seq_ops;
7842345ddcc8SSteven Rostedt (Red Hat) 	struct trace_array *tr = inode->i_private;
7843345ddcc8SSteven Rostedt (Red Hat) 	struct seq_file *m;
7844756d17eeS[email protected] 	int ret = 0;
7845756d17eeS[email protected] 
78468530dec6SSteven Rostedt (VMware) 	ret = tracing_check_open_get_tr(tr);
78478530dec6SSteven Rostedt (VMware) 	if (ret)
78488530dec6SSteven Rostedt (VMware) 		return ret;
7849345ddcc8SSteven Rostedt (Red Hat) 
7850756d17eeS[email protected] 	if ((file->f_mode & FMODE_WRITE) &&
7851756d17eeS[email protected] 	    (file->f_flags & O_TRUNC))
7852b3b1e6edSSteven Rostedt (VMware) 		ftrace_pid_reset(tr, type);
7853756d17eeS[email protected] 
7854b3b1e6edSSteven Rostedt (VMware) 	switch (type) {
7855b3b1e6edSSteven Rostedt (VMware) 	case TRACE_PIDS:
7856b3b1e6edSSteven Rostedt (VMware) 		seq_ops = &ftrace_pid_sops;
7857b3b1e6edSSteven Rostedt (VMware) 		break;
7858b3b1e6edSSteven Rostedt (VMware) 	case TRACE_NO_PIDS:
7859b3b1e6edSSteven Rostedt (VMware) 		seq_ops = &ftrace_no_pid_sops;
7860b3b1e6edSSteven Rostedt (VMware) 		break;
7861026bb845SKaitao Cheng 	default:
7862026bb845SKaitao Cheng 		trace_array_put(tr);
7863026bb845SKaitao Cheng 		WARN_ON_ONCE(1);
7864026bb845SKaitao Cheng 		return -EINVAL;
7865b3b1e6edSSteven Rostedt (VMware) 	}
7866b3b1e6edSSteven Rostedt (VMware) 
7867b3b1e6edSSteven Rostedt (VMware) 	ret = seq_open(file, seq_ops);
7868345ddcc8SSteven Rostedt (Red Hat) 	if (ret < 0) {
7869345ddcc8SSteven Rostedt (Red Hat) 		trace_array_put(tr);
7870345ddcc8SSteven Rostedt (Red Hat) 	} else {
7871345ddcc8SSteven Rostedt (Red Hat) 		m = file->private_data;
7872345ddcc8SSteven Rostedt (Red Hat) 		/* copy tr over to seq ops */
7873345ddcc8SSteven Rostedt (Red Hat) 		m->private = tr;
7874345ddcc8SSteven Rostedt (Red Hat) 	}
7875756d17eeS[email protected] 
7876756d17eeS[email protected] 	return ret;
7877756d17eeS[email protected] }
7878756d17eeS[email protected] 
7879b3b1e6edSSteven Rostedt (VMware) static int
7880b3b1e6edSSteven Rostedt (VMware) ftrace_pid_open(struct inode *inode, struct file *file)
7881b3b1e6edSSteven Rostedt (VMware) {
7882b3b1e6edSSteven Rostedt (VMware) 	return pid_open(inode, file, TRACE_PIDS);
7883b3b1e6edSSteven Rostedt (VMware) }
7884b3b1e6edSSteven Rostedt (VMware) 
7885b3b1e6edSSteven Rostedt (VMware) static int
7886b3b1e6edSSteven Rostedt (VMware) ftrace_no_pid_open(struct inode *inode, struct file *file)
7887b3b1e6edSSteven Rostedt (VMware) {
7888b3b1e6edSSteven Rostedt (VMware) 	return pid_open(inode, file, TRACE_NO_PIDS);
7889b3b1e6edSSteven Rostedt (VMware) }
7890b3b1e6edSSteven Rostedt (VMware) 
7891345ddcc8SSteven Rostedt (Red Hat) static void ignore_task_cpu(void *data)
7892345ddcc8SSteven Rostedt (Red Hat) {
7893345ddcc8SSteven Rostedt (Red Hat) 	struct trace_array *tr = data;
7894345ddcc8SSteven Rostedt (Red Hat) 	struct trace_pid_list *pid_list;
7895b3b1e6edSSteven Rostedt (VMware) 	struct trace_pid_list *no_pid_list;
7896345ddcc8SSteven Rostedt (Red Hat) 
7897345ddcc8SSteven Rostedt (Red Hat) 	/*
7898345ddcc8SSteven Rostedt (Red Hat) 	 * This function is called by on_each_cpu() while the
7899345ddcc8SSteven Rostedt (Red Hat) 	 * event_mutex is held.
7900345ddcc8SSteven Rostedt (Red Hat) 	 */
7901345ddcc8SSteven Rostedt (Red Hat) 	pid_list = rcu_dereference_protected(tr->function_pids,
7902345ddcc8SSteven Rostedt (Red Hat) 					     mutex_is_locked(&ftrace_lock));
7903b3b1e6edSSteven Rostedt (VMware) 	no_pid_list = rcu_dereference_protected(tr->function_no_pids,
7904b3b1e6edSSteven Rostedt (VMware) 						mutex_is_locked(&ftrace_lock));
7905345ddcc8SSteven Rostedt (Red Hat) 
7906b3b1e6edSSteven Rostedt (VMware) 	if (trace_ignore_this_task(pid_list, no_pid_list, current))
79071c5eb448SSteven Rostedt (VMware) 		this_cpu_write(tr->array_buffer.data->ftrace_ignore_pid,
7908717e3f5eSSteven Rostedt (VMware) 			       FTRACE_PID_IGNORE);
7909717e3f5eSSteven Rostedt (VMware) 	else
7910717e3f5eSSteven Rostedt (VMware) 		this_cpu_write(tr->array_buffer.data->ftrace_ignore_pid,
7911717e3f5eSSteven Rostedt (VMware) 			       current->pid);
7912345ddcc8SSteven Rostedt (Red Hat) }
7913345ddcc8SSteven Rostedt (Red Hat) 
7914df4fc315SSteven Rostedt static ssize_t
7915b3b1e6edSSteven Rostedt (VMware) pid_write(struct file *filp, const char __user *ubuf,
7916b3b1e6edSSteven Rostedt (VMware) 	  size_t cnt, loff_t *ppos, int type)
7917df4fc315SSteven Rostedt {
7918345ddcc8SSteven Rostedt (Red Hat) 	struct seq_file *m = filp->private_data;
7919345ddcc8SSteven Rostedt (Red Hat) 	struct trace_array *tr = m->private;
7920b3b1e6edSSteven Rostedt (VMware) 	struct trace_pid_list *filtered_pids;
7921b3b1e6edSSteven Rostedt (VMware) 	struct trace_pid_list *other_pids;
7922345ddcc8SSteven Rostedt (Red Hat) 	struct trace_pid_list *pid_list;
7923345ddcc8SSteven Rostedt (Red Hat) 	ssize_t ret;
7924df4fc315SSteven Rostedt 
7925345ddcc8SSteven Rostedt (Red Hat) 	if (!cnt)
7926345ddcc8SSteven Rostedt (Red Hat) 		return 0;
7927df4fc315SSteven Rostedt 
7928345ddcc8SSteven Rostedt (Red Hat) 	mutex_lock(&ftrace_lock);
7929df4fc315SSteven Rostedt 
7930b3b1e6edSSteven Rostedt (VMware) 	switch (type) {
7931b3b1e6edSSteven Rostedt (VMware) 	case TRACE_PIDS:
7932345ddcc8SSteven Rostedt (Red Hat) 		filtered_pids = rcu_dereference_protected(tr->function_pids,
7933345ddcc8SSteven Rostedt (Red Hat) 					     lockdep_is_held(&ftrace_lock));
7934b3b1e6edSSteven Rostedt (VMware) 		other_pids = rcu_dereference_protected(tr->function_no_pids,
7935b3b1e6edSSteven Rostedt (VMware) 					     lockdep_is_held(&ftrace_lock));
7936b3b1e6edSSteven Rostedt (VMware) 		break;
7937b3b1e6edSSteven Rostedt (VMware) 	case TRACE_NO_PIDS:
7938b3b1e6edSSteven Rostedt (VMware) 		filtered_pids = rcu_dereference_protected(tr->function_no_pids,
7939b3b1e6edSSteven Rostedt (VMware) 					     lockdep_is_held(&ftrace_lock));
7940b3b1e6edSSteven Rostedt (VMware) 		other_pids = rcu_dereference_protected(tr->function_pids,
7941b3b1e6edSSteven Rostedt (VMware) 					     lockdep_is_held(&ftrace_lock));
7942b3b1e6edSSteven Rostedt (VMware) 		break;
7943026bb845SKaitao Cheng 	default:
7944026bb845SKaitao Cheng 		ret = -EINVAL;
7945026bb845SKaitao Cheng 		WARN_ON_ONCE(1);
7946026bb845SKaitao Cheng 		goto out;
7947b3b1e6edSSteven Rostedt (VMware) 	}
7948345ddcc8SSteven Rostedt (Red Hat) 
7949345ddcc8SSteven Rostedt (Red Hat) 	ret = trace_pid_write(filtered_pids, &pid_list, ubuf, cnt);
7950345ddcc8SSteven Rostedt (Red Hat) 	if (ret < 0)
7951345ddcc8SSteven Rostedt (Red Hat) 		goto out;
7952345ddcc8SSteven Rostedt (Red Hat) 
7953b3b1e6edSSteven Rostedt (VMware) 	switch (type) {
7954b3b1e6edSSteven Rostedt (VMware) 	case TRACE_PIDS:
7955345ddcc8SSteven Rostedt (Red Hat) 		rcu_assign_pointer(tr->function_pids, pid_list);
7956b3b1e6edSSteven Rostedt (VMware) 		break;
7957b3b1e6edSSteven Rostedt (VMware) 	case TRACE_NO_PIDS:
7958b3b1e6edSSteven Rostedt (VMware) 		rcu_assign_pointer(tr->function_no_pids, pid_list);
7959b3b1e6edSSteven Rostedt (VMware) 		break;
7960b3b1e6edSSteven Rostedt (VMware) 	}
7961b3b1e6edSSteven Rostedt (VMware) 
7962345ddcc8SSteven Rostedt (Red Hat) 
7963345ddcc8SSteven Rostedt (Red Hat) 	if (filtered_pids) {
796474401729SPaul E. McKenney 		synchronize_rcu();
79656954e415SSteven Rostedt (VMware) 		trace_pid_list_free(filtered_pids);
7966b3b1e6edSSteven Rostedt (VMware) 	} else if (pid_list && !other_pids) {
7967345ddcc8SSteven Rostedt (Red Hat) 		/* Register a probe to set whether to ignore the tracing of a task */
7968345ddcc8SSteven Rostedt (Red Hat) 		register_trace_sched_switch(ftrace_filter_pid_sched_switch_probe, tr);
7969345ddcc8SSteven Rostedt (Red Hat) 	}
7970df4fc315SSteven Rostedt 
7971756d17eeS[email protected] 	/*
7972345ddcc8SSteven Rostedt (Red Hat) 	 * Ignoring of pids is done at task switch. But we have to
7973345ddcc8SSteven Rostedt (Red Hat) 	 * check for those tasks that are currently running.
7974345ddcc8SSteven Rostedt (Red Hat) 	 * Always do this in case a pid was appended or removed.
7975756d17eeS[email protected] 	 */
7976345ddcc8SSteven Rostedt (Red Hat) 	on_each_cpu(ignore_task_cpu, tr, 1);
7977756d17eeS[email protected] 
7978345ddcc8SSteven Rostedt (Red Hat) 	ftrace_update_pid_func();
7979345ddcc8SSteven Rostedt (Red Hat) 	ftrace_startup_all(0);
7980345ddcc8SSteven Rostedt (Red Hat)  out:
7981345ddcc8SSteven Rostedt (Red Hat) 	mutex_unlock(&ftrace_lock);
7982345ddcc8SSteven Rostedt (Red Hat) 
7983345ddcc8SSteven Rostedt (Red Hat) 	if (ret > 0)
7984345ddcc8SSteven Rostedt (Red Hat) 		*ppos += ret;
7985345ddcc8SSteven Rostedt (Red Hat) 
7986df4fc315SSteven Rostedt 	return ret;
7987e32d8956SSteven Rostedt }
7988978f3a45SSteven Rostedt 
7989b3b1e6edSSteven Rostedt (VMware) static ssize_t
7990b3b1e6edSSteven Rostedt (VMware) ftrace_pid_write(struct file *filp, const char __user *ubuf,
7991b3b1e6edSSteven Rostedt (VMware) 		 size_t cnt, loff_t *ppos)
7992b3b1e6edSSteven Rostedt (VMware) {
7993b3b1e6edSSteven Rostedt (VMware) 	return pid_write(filp, ubuf, cnt, ppos, TRACE_PIDS);
7994b3b1e6edSSteven Rostedt (VMware) }
7995b3b1e6edSSteven Rostedt (VMware) 
7996b3b1e6edSSteven Rostedt (VMware) static ssize_t
7997b3b1e6edSSteven Rostedt (VMware) ftrace_no_pid_write(struct file *filp, const char __user *ubuf,
7998b3b1e6edSSteven Rostedt (VMware) 		    size_t cnt, loff_t *ppos)
7999b3b1e6edSSteven Rostedt (VMware) {
8000b3b1e6edSSteven Rostedt (VMware) 	return pid_write(filp, ubuf, cnt, ppos, TRACE_NO_PIDS);
8001b3b1e6edSSteven Rostedt (VMware) }
8002b3b1e6edSSteven Rostedt (VMware) 
8003756d17eeS[email protected] static int
8004756d17eeS[email protected] ftrace_pid_release(struct inode *inode, struct file *file)
8005756d17eeS[email protected] {
8006345ddcc8SSteven Rostedt (Red Hat) 	struct trace_array *tr = inode->i_private;
8007978f3a45SSteven Rostedt 
8008345ddcc8SSteven Rostedt (Red Hat) 	trace_array_put(tr);
8009345ddcc8SSteven Rostedt (Red Hat) 
8010345ddcc8SSteven Rostedt (Red Hat) 	return seq_release(inode, file);
8011df4fc315SSteven Rostedt }
8012df4fc315SSteven Rostedt 
80135e2336a0SSteven Rostedt static const struct file_operations ftrace_pid_fops = {
8014756d17eeS[email protected] 	.open		= ftrace_pid_open,
8015df4fc315SSteven Rostedt 	.write		= ftrace_pid_write,
8016756d17eeS[email protected] 	.read		= seq_read,
8017098c879eSSteven Rostedt (Red Hat) 	.llseek		= tracing_lseek,
8018756d17eeS[email protected] 	.release	= ftrace_pid_release,
8019df4fc315SSteven Rostedt };
8020df4fc315SSteven Rostedt 
8021b3b1e6edSSteven Rostedt (VMware) static const struct file_operations ftrace_no_pid_fops = {
8022b3b1e6edSSteven Rostedt (VMware) 	.open		= ftrace_no_pid_open,
8023b3b1e6edSSteven Rostedt (VMware) 	.write		= ftrace_no_pid_write,
8024b3b1e6edSSteven Rostedt (VMware) 	.read		= seq_read,
8025b3b1e6edSSteven Rostedt (VMware) 	.llseek		= tracing_lseek,
8026b3b1e6edSSteven Rostedt (VMware) 	.release	= ftrace_pid_release,
8027b3b1e6edSSteven Rostedt (VMware) };
8028b3b1e6edSSteven Rostedt (VMware) 
8029345ddcc8SSteven Rostedt (Red Hat) void ftrace_init_tracefs(struct trace_array *tr, struct dentry *d_tracer)
8030df4fc315SSteven Rostedt {
803121ccc9cdSSteven Rostedt (VMware) 	trace_create_file("set_ftrace_pid", TRACE_MODE_WRITE, d_tracer,
8032345ddcc8SSteven Rostedt (Red Hat) 			    tr, &ftrace_pid_fops);
803321ccc9cdSSteven Rostedt (VMware) 	trace_create_file("set_ftrace_notrace_pid", TRACE_MODE_WRITE,
803421ccc9cdSSteven Rostedt (VMware) 			  d_tracer, tr, &ftrace_no_pid_fops);
8035df4fc315SSteven Rostedt }
8036df4fc315SSteven Rostedt 
8037501c2375SSteven Rostedt (Red Hat) void __init ftrace_init_tracefs_toplevel(struct trace_array *tr,
8038501c2375SSteven Rostedt (Red Hat) 					 struct dentry *d_tracer)
8039501c2375SSteven Rostedt (Red Hat) {
8040501c2375SSteven Rostedt (Red Hat) 	/* Only the top level directory has the dyn_tracefs and profile */
8041501c2375SSteven Rostedt (Red Hat) 	WARN_ON(!(tr->flags & TRACE_ARRAY_FL_GLOBAL));
8042501c2375SSteven Rostedt (Red Hat) 
8043501c2375SSteven Rostedt (Red Hat) 	ftrace_init_dyn_tracefs(d_tracer);
8044501c2375SSteven Rostedt (Red Hat) 	ftrace_profile_tracefs(d_tracer);
8045501c2375SSteven Rostedt (Red Hat) }
8046501c2375SSteven Rostedt (Red Hat) 
80473d083395SSteven Rostedt /**
804881adbdc0SSteven Rostedt  * ftrace_kill - kill ftrace
8049a2bb6a3dSSteven Rostedt  *
8050a2bb6a3dSSteven Rostedt  * This function should be used by panic code. It stops ftrace
8051a2bb6a3dSSteven Rostedt  * but in a not so nice way. If you need to simply kill ftrace
8052a2bb6a3dSSteven Rostedt  * from a non-atomic section, use ftrace_kill.
8053a2bb6a3dSSteven Rostedt  */
805481adbdc0SSteven Rostedt void ftrace_kill(void)
8055a2bb6a3dSSteven Rostedt {
8056a2bb6a3dSSteven Rostedt 	ftrace_disabled = 1;
8057a2bb6a3dSSteven Rostedt 	ftrace_enabled = 0;
80585ccba64aSYisheng Xie 	ftrace_trace_function = ftrace_stub;
8059a2bb6a3dSSteven Rostedt }
8060a2bb6a3dSSteven Rostedt 
8061a2bb6a3dSSteven Rostedt /**
80626130722fSSteven Rostedt (VMware)  * ftrace_is_dead - Test if ftrace is dead or not.
80636130722fSSteven Rostedt (VMware)  *
80646130722fSSteven Rostedt (VMware)  * Returns 1 if ftrace is "dead", zero otherwise.
8065e0a413f6SSteven Rostedt  */
8066e0a413f6SSteven Rostedt int ftrace_is_dead(void)
8067e0a413f6SSteven Rostedt {
8068e0a413f6SSteven Rostedt 	return ftrace_disabled;
8069e0a413f6SSteven Rostedt }
8070e0a413f6SSteven Rostedt 
807153cd885bSSong Liu #ifdef CONFIG_DYNAMIC_FTRACE_WITH_DIRECT_CALLS
807253cd885bSSong Liu /*
807353cd885bSSong Liu  * When registering ftrace_ops with IPMODIFY, it is necessary to make sure
807453cd885bSSong Liu  * it doesn't conflict with any direct ftrace_ops. If there is existing
807553cd885bSSong Liu  * direct ftrace_ops on a kernel function being patched, call
807653cd885bSSong Liu  * FTRACE_OPS_CMD_ENABLE_SHARE_IPMODIFY_PEER on it to enable sharing.
807753cd885bSSong Liu  *
807853cd885bSSong Liu  * @ops:     ftrace_ops being registered.
807953cd885bSSong Liu  *
808053cd885bSSong Liu  * Returns:
808153cd885bSSong Liu  *         0 on success;
808253cd885bSSong Liu  *         Negative on failure.
808353cd885bSSong Liu  */
808453cd885bSSong Liu static int prepare_direct_functions_for_ipmodify(struct ftrace_ops *ops)
808553cd885bSSong Liu {
808653cd885bSSong Liu 	struct ftrace_func_entry *entry;
808753cd885bSSong Liu 	struct ftrace_hash *hash;
808853cd885bSSong Liu 	struct ftrace_ops *op;
808953cd885bSSong Liu 	int size, i, ret;
809053cd885bSSong Liu 
809153cd885bSSong Liu 	lockdep_assert_held_once(&direct_mutex);
809253cd885bSSong Liu 
809353cd885bSSong Liu 	if (!(ops->flags & FTRACE_OPS_FL_IPMODIFY))
809453cd885bSSong Liu 		return 0;
809553cd885bSSong Liu 
809653cd885bSSong Liu 	hash = ops->func_hash->filter_hash;
809753cd885bSSong Liu 	size = 1 << hash->size_bits;
809853cd885bSSong Liu 	for (i = 0; i < size; i++) {
809953cd885bSSong Liu 		hlist_for_each_entry(entry, &hash->buckets[i], hlist) {
810053cd885bSSong Liu 			unsigned long ip = entry->ip;
810153cd885bSSong Liu 			bool found_op = false;
810253cd885bSSong Liu 
810353cd885bSSong Liu 			mutex_lock(&ftrace_lock);
810453cd885bSSong Liu 			do_for_each_ftrace_op(op, ftrace_ops_list) {
810553cd885bSSong Liu 				if (!(op->flags & FTRACE_OPS_FL_DIRECT))
810653cd885bSSong Liu 					continue;
810753cd885bSSong Liu 				if (ops_references_ip(op, ip)) {
810853cd885bSSong Liu 					found_op = true;
810953cd885bSSong Liu 					break;
811053cd885bSSong Liu 				}
811153cd885bSSong Liu 			} while_for_each_ftrace_op(op);
811253cd885bSSong Liu 			mutex_unlock(&ftrace_lock);
811353cd885bSSong Liu 
811453cd885bSSong Liu 			if (found_op) {
811553cd885bSSong Liu 				if (!op->ops_func)
811653cd885bSSong Liu 					return -EBUSY;
811753cd885bSSong Liu 
811853cd885bSSong Liu 				ret = op->ops_func(op, FTRACE_OPS_CMD_ENABLE_SHARE_IPMODIFY_PEER);
811953cd885bSSong Liu 				if (ret)
812053cd885bSSong Liu 					return ret;
812153cd885bSSong Liu 			}
812253cd885bSSong Liu 		}
812353cd885bSSong Liu 	}
812453cd885bSSong Liu 
812553cd885bSSong Liu 	return 0;
812653cd885bSSong Liu }
812753cd885bSSong Liu 
812853cd885bSSong Liu /*
812953cd885bSSong Liu  * Similar to prepare_direct_functions_for_ipmodify, clean up after ops
813053cd885bSSong Liu  * with IPMODIFY is unregistered. The cleanup is optional for most DIRECT
813153cd885bSSong Liu  * ops.
813253cd885bSSong Liu  */
813353cd885bSSong Liu static void cleanup_direct_functions_after_ipmodify(struct ftrace_ops *ops)
813453cd885bSSong Liu {
813553cd885bSSong Liu 	struct ftrace_func_entry *entry;
813653cd885bSSong Liu 	struct ftrace_hash *hash;
813753cd885bSSong Liu 	struct ftrace_ops *op;
813853cd885bSSong Liu 	int size, i;
813953cd885bSSong Liu 
814053cd885bSSong Liu 	if (!(ops->flags & FTRACE_OPS_FL_IPMODIFY))
814153cd885bSSong Liu 		return;
814253cd885bSSong Liu 
814353cd885bSSong Liu 	mutex_lock(&direct_mutex);
814453cd885bSSong Liu 
814553cd885bSSong Liu 	hash = ops->func_hash->filter_hash;
814653cd885bSSong Liu 	size = 1 << hash->size_bits;
814753cd885bSSong Liu 	for (i = 0; i < size; i++) {
814853cd885bSSong Liu 		hlist_for_each_entry(entry, &hash->buckets[i], hlist) {
814953cd885bSSong Liu 			unsigned long ip = entry->ip;
815053cd885bSSong Liu 			bool found_op = false;
815153cd885bSSong Liu 
815253cd885bSSong Liu 			mutex_lock(&ftrace_lock);
815353cd885bSSong Liu 			do_for_each_ftrace_op(op, ftrace_ops_list) {
815453cd885bSSong Liu 				if (!(op->flags & FTRACE_OPS_FL_DIRECT))
815553cd885bSSong Liu 					continue;
815653cd885bSSong Liu 				if (ops_references_ip(op, ip)) {
815753cd885bSSong Liu 					found_op = true;
815853cd885bSSong Liu 					break;
815953cd885bSSong Liu 				}
816053cd885bSSong Liu 			} while_for_each_ftrace_op(op);
816153cd885bSSong Liu 			mutex_unlock(&ftrace_lock);
816253cd885bSSong Liu 
816353cd885bSSong Liu 			/* The cleanup is optional, ignore any errors */
816453cd885bSSong Liu 			if (found_op && op->ops_func)
816553cd885bSSong Liu 				op->ops_func(op, FTRACE_OPS_CMD_DISABLE_SHARE_IPMODIFY_PEER);
816653cd885bSSong Liu 		}
816753cd885bSSong Liu 	}
816853cd885bSSong Liu 	mutex_unlock(&direct_mutex);
816953cd885bSSong Liu }
817053cd885bSSong Liu 
817153cd885bSSong Liu #define lock_direct_mutex()	mutex_lock(&direct_mutex)
817253cd885bSSong Liu #define unlock_direct_mutex()	mutex_unlock(&direct_mutex)
817353cd885bSSong Liu 
817453cd885bSSong Liu #else  /* CONFIG_DYNAMIC_FTRACE_WITH_DIRECT_CALLS */
817553cd885bSSong Liu 
817653cd885bSSong Liu static int prepare_direct_functions_for_ipmodify(struct ftrace_ops *ops)
817753cd885bSSong Liu {
817853cd885bSSong Liu 	return 0;
817953cd885bSSong Liu }
818053cd885bSSong Liu 
818153cd885bSSong Liu static void cleanup_direct_functions_after_ipmodify(struct ftrace_ops *ops)
818253cd885bSSong Liu {
818353cd885bSSong Liu }
818453cd885bSSong Liu 
818553cd885bSSong Liu #define lock_direct_mutex()	do { } while (0)
818653cd885bSSong Liu #define unlock_direct_mutex()	do { } while (0)
818753cd885bSSong Liu 
818853cd885bSSong Liu #endif  /* CONFIG_DYNAMIC_FTRACE_WITH_DIRECT_CALLS */
818953cd885bSSong Liu 
819053cd885bSSong Liu /*
819153cd885bSSong Liu  * Similar to register_ftrace_function, except we don't lock direct_mutex.
819253cd885bSSong Liu  */
819353cd885bSSong Liu static int register_ftrace_function_nolock(struct ftrace_ops *ops)
819453cd885bSSong Liu {
819553cd885bSSong Liu 	int ret;
819653cd885bSSong Liu 
819753cd885bSSong Liu 	ftrace_ops_init(ops);
819853cd885bSSong Liu 
819953cd885bSSong Liu 	mutex_lock(&ftrace_lock);
820053cd885bSSong Liu 
820153cd885bSSong Liu 	ret = ftrace_startup(ops, 0);
820253cd885bSSong Liu 
820353cd885bSSong Liu 	mutex_unlock(&ftrace_lock);
820453cd885bSSong Liu 
820553cd885bSSong Liu 	return ret;
820653cd885bSSong Liu }
820753cd885bSSong Liu 
8208e0a413f6SSteven Rostedt /**
82093d083395SSteven Rostedt  * register_ftrace_function - register a function for profiling
821078cbc651SJiapeng Chong  * @ops:	ops structure that holds the function for profiling.
82113d083395SSteven Rostedt  *
82123d083395SSteven Rostedt  * Register a function to be called by all functions in the
82133d083395SSteven Rostedt  * kernel.
82143d083395SSteven Rostedt  *
82153d083395SSteven Rostedt  * Note: @ops->func and all the functions it calls must be labeled
82163d083395SSteven Rostedt  *       with "notrace", otherwise it will go into a
82173d083395SSteven Rostedt  *       recursive loop.
82183d083395SSteven Rostedt  */
82193d083395SSteven Rostedt int register_ftrace_function(struct ftrace_ops *ops)
82203d083395SSteven Rostedt {
82213b1a8f45SColin Ian King 	int ret;
82224eebcc81SSteven Rostedt 
822353cd885bSSong Liu 	lock_direct_mutex();
822453cd885bSSong Liu 	ret = prepare_direct_functions_for_ipmodify(ops);
822553cd885bSSong Liu 	if (ret < 0)
822653cd885bSSong Liu 		goto out_unlock;
8227f04f24fbSMasami Hiramatsu 
822853cd885bSSong Liu 	ret = register_ftrace_function_nolock(ops);
8229e7d3737eSFrederic Weisbecker 
823053cd885bSSong Liu out_unlock:
823153cd885bSSong Liu 	unlock_direct_mutex();
8232b0fc494fSSteven Rostedt 	return ret;
82333d083395SSteven Rostedt }
8234cdbe61bfSSteven Rostedt EXPORT_SYMBOL_GPL(register_ftrace_function);
82353d083395SSteven Rostedt 
82363d083395SSteven Rostedt /**
823732632920SUwe Kleine-Koenig  * unregister_ftrace_function - unregister a function for profiling.
823878cbc651SJiapeng Chong  * @ops:	ops structure that holds the function to unregister
82393d083395SSteven Rostedt  *
82403d083395SSteven Rostedt  * Unregister a function that was added to be called by ftrace profiling.
82413d083395SSteven Rostedt  */
82423d083395SSteven Rostedt int unregister_ftrace_function(struct ftrace_ops *ops)
82433d083395SSteven Rostedt {
82443d083395SSteven Rostedt 	int ret;
82453d083395SSteven Rostedt 
8246e6ea44e9SSteven Rostedt 	mutex_lock(&ftrace_lock);
82478a56d776SSteven Rostedt (Red Hat) 	ret = ftrace_shutdown(ops, 0);
8248e6ea44e9SSteven Rostedt 	mutex_unlock(&ftrace_lock);
8249b0fc494fSSteven Rostedt 
825053cd885bSSong Liu 	cleanup_direct_functions_after_ipmodify(ops);
8251b0fc494fSSteven Rostedt 	return ret;
8252b0fc494fSSteven Rostedt }
8253cdbe61bfSSteven Rostedt EXPORT_SYMBOL_GPL(unregister_ftrace_function);
8254b0fc494fSSteven Rostedt 
8255bed0d9a5SJiri Olsa static int symbols_cmp(const void *a, const void *b)
8256bed0d9a5SJiri Olsa {
8257bed0d9a5SJiri Olsa 	const char **str_a = (const char **) a;
8258bed0d9a5SJiri Olsa 	const char **str_b = (const char **) b;
8259bed0d9a5SJiri Olsa 
8260bed0d9a5SJiri Olsa 	return strcmp(*str_a, *str_b);
8261bed0d9a5SJiri Olsa }
8262bed0d9a5SJiri Olsa 
8263bed0d9a5SJiri Olsa struct kallsyms_data {
8264bed0d9a5SJiri Olsa 	unsigned long *addrs;
8265bed0d9a5SJiri Olsa 	const char **syms;
8266bed0d9a5SJiri Olsa 	size_t cnt;
8267bed0d9a5SJiri Olsa 	size_t found;
8268bed0d9a5SJiri Olsa };
8269bed0d9a5SJiri Olsa 
8270bed0d9a5SJiri Olsa static int kallsyms_callback(void *data, const char *name,
8271bed0d9a5SJiri Olsa 			     struct module *mod, unsigned long addr)
8272bed0d9a5SJiri Olsa {
8273bed0d9a5SJiri Olsa 	struct kallsyms_data *args = data;
8274eb1b2985SJiri Olsa 	const char **sym;
8275eb1b2985SJiri Olsa 	int idx;
8276bed0d9a5SJiri Olsa 
8277eb1b2985SJiri Olsa 	sym = bsearch(&name, args->syms, args->cnt, sizeof(*args->syms), symbols_cmp);
8278eb1b2985SJiri Olsa 	if (!sym)
8279eb1b2985SJiri Olsa 		return 0;
8280eb1b2985SJiri Olsa 
8281eb1b2985SJiri Olsa 	idx = sym - args->syms;
8282eb1b2985SJiri Olsa 	if (args->addrs[idx])
8283bed0d9a5SJiri Olsa 		return 0;
8284bed0d9a5SJiri Olsa 
8285bed0d9a5SJiri Olsa 	addr = ftrace_location(addr);
8286bed0d9a5SJiri Olsa 	if (!addr)
8287bed0d9a5SJiri Olsa 		return 0;
8288bed0d9a5SJiri Olsa 
8289eb1b2985SJiri Olsa 	args->addrs[idx] = addr;
8290eb1b2985SJiri Olsa 	args->found++;
8291bed0d9a5SJiri Olsa 	return args->found == args->cnt ? 1 : 0;
8292bed0d9a5SJiri Olsa }
8293bed0d9a5SJiri Olsa 
8294bed0d9a5SJiri Olsa /**
8295bed0d9a5SJiri Olsa  * ftrace_lookup_symbols - Lookup addresses for array of symbols
8296bed0d9a5SJiri Olsa  *
8297bed0d9a5SJiri Olsa  * @sorted_syms: array of symbols pointers symbols to resolve,
8298bed0d9a5SJiri Olsa  * must be alphabetically sorted
8299bed0d9a5SJiri Olsa  * @cnt: number of symbols/addresses in @syms/@addrs arrays
8300bed0d9a5SJiri Olsa  * @addrs: array for storing resulting addresses
8301bed0d9a5SJiri Olsa  *
8302bed0d9a5SJiri Olsa  * This function looks up addresses for array of symbols provided in
8303bed0d9a5SJiri Olsa  * @syms array (must be alphabetically sorted) and stores them in
8304bed0d9a5SJiri Olsa  * @addrs array, which needs to be big enough to store at least @cnt
8305bed0d9a5SJiri Olsa  * addresses.
8306bed0d9a5SJiri Olsa  *
8307bed0d9a5SJiri Olsa  * This function returns 0 if all provided symbols are found,
8308bed0d9a5SJiri Olsa  * -ESRCH otherwise.
8309bed0d9a5SJiri Olsa  */
8310bed0d9a5SJiri Olsa int ftrace_lookup_symbols(const char **sorted_syms, size_t cnt, unsigned long *addrs)
8311bed0d9a5SJiri Olsa {
8312bed0d9a5SJiri Olsa 	struct kallsyms_data args;
8313bed0d9a5SJiri Olsa 	int err;
8314bed0d9a5SJiri Olsa 
8315eb1b2985SJiri Olsa 	memset(addrs, 0, sizeof(*addrs) * cnt);
8316bed0d9a5SJiri Olsa 	args.addrs = addrs;
8317bed0d9a5SJiri Olsa 	args.syms = sorted_syms;
8318bed0d9a5SJiri Olsa 	args.cnt = cnt;
8319bed0d9a5SJiri Olsa 	args.found = 0;
8320bed0d9a5SJiri Olsa 	err = kallsyms_on_each_symbol(kallsyms_callback, &args);
8321bed0d9a5SJiri Olsa 	if (err < 0)
8322bed0d9a5SJiri Olsa 		return err;
8323bed0d9a5SJiri Olsa 	return args.found == args.cnt ? 0 : -ESRCH;
8324bed0d9a5SJiri Olsa }
832544d35720SLinus Torvalds 
83265d79fa0dSYueHaibing #ifdef CONFIG_SYSCTL
83278fd7c214SLuis Chamberlain 
83288fd7c214SLuis Chamberlain #ifdef CONFIG_DYNAMIC_FTRACE
8329f8b7d2b4SLuis Chamberlain static void ftrace_startup_sysctl(void)
8330f8b7d2b4SLuis Chamberlain {
8331f8b7d2b4SLuis Chamberlain 	int command;
8332f8b7d2b4SLuis Chamberlain 
8333f8b7d2b4SLuis Chamberlain 	if (unlikely(ftrace_disabled))
8334f8b7d2b4SLuis Chamberlain 		return;
8335f8b7d2b4SLuis Chamberlain 
8336f8b7d2b4SLuis Chamberlain 	/* Force update next time */
8337f8b7d2b4SLuis Chamberlain 	saved_ftrace_func = NULL;
8338f8b7d2b4SLuis Chamberlain 	/* ftrace_start_up is true if we want ftrace running */
8339f8b7d2b4SLuis Chamberlain 	if (ftrace_start_up) {
8340f8b7d2b4SLuis Chamberlain 		command = FTRACE_UPDATE_CALLS;
8341f8b7d2b4SLuis Chamberlain 		if (ftrace_graph_active)
8342f8b7d2b4SLuis Chamberlain 			command |= FTRACE_START_FUNC_RET;
8343f8b7d2b4SLuis Chamberlain 		ftrace_startup_enable(command);
8344f8b7d2b4SLuis Chamberlain 	}
8345f8b7d2b4SLuis Chamberlain }
8346f8b7d2b4SLuis Chamberlain 
8347f8b7d2b4SLuis Chamberlain static void ftrace_shutdown_sysctl(void)
8348f8b7d2b4SLuis Chamberlain {
8349f8b7d2b4SLuis Chamberlain 	int command;
8350f8b7d2b4SLuis Chamberlain 
8351f8b7d2b4SLuis Chamberlain 	if (unlikely(ftrace_disabled))
8352f8b7d2b4SLuis Chamberlain 		return;
8353f8b7d2b4SLuis Chamberlain 
8354f8b7d2b4SLuis Chamberlain 	/* ftrace_start_up is true if ftrace is running */
8355f8b7d2b4SLuis Chamberlain 	if (ftrace_start_up) {
8356f8b7d2b4SLuis Chamberlain 		command = FTRACE_DISABLE_CALLS;
8357f8b7d2b4SLuis Chamberlain 		if (ftrace_graph_active)
8358f8b7d2b4SLuis Chamberlain 			command |= FTRACE_STOP_FUNC_RET;
8359f8b7d2b4SLuis Chamberlain 		ftrace_run_update_code(command);
8360f8b7d2b4SLuis Chamberlain 	}
8361f8b7d2b4SLuis Chamberlain }
83628fd7c214SLuis Chamberlain #else
83638fd7c214SLuis Chamberlain # define ftrace_startup_sysctl()       do { } while (0)
83648fd7c214SLuis Chamberlain # define ftrace_shutdown_sysctl()      do { } while (0)
83658fd7c214SLuis Chamberlain #endif /* CONFIG_DYNAMIC_FTRACE */
8366f8b7d2b4SLuis Chamberlain 
83677162431dSMiroslav Benes static bool is_permanent_ops_registered(void)
83687162431dSMiroslav Benes {
83697162431dSMiroslav Benes 	struct ftrace_ops *op;
83707162431dSMiroslav Benes 
83717162431dSMiroslav Benes 	do_for_each_ftrace_op(op, ftrace_ops_list) {
83727162431dSMiroslav Benes 		if (op->flags & FTRACE_OPS_FL_PERMANENT)
83737162431dSMiroslav Benes 			return true;
83747162431dSMiroslav Benes 	} while_for_each_ftrace_op(op);
83757162431dSMiroslav Benes 
83767162431dSMiroslav Benes 	return false;
83777162431dSMiroslav Benes }
83787162431dSMiroslav Benes 
83798e4e83b2SWei Xiao static int
8380b0fc494fSSteven Rostedt ftrace_enable_sysctl(struct ctl_table *table, int write,
838154fa9ba5STobias Klauser 		     void *buffer, size_t *lenp, loff_t *ppos)
8382b0fc494fSSteven Rostedt {
838345a4a237SSteven Rostedt 	int ret = -ENODEV;
83844eebcc81SSteven Rostedt 
8385e6ea44e9SSteven Rostedt 	mutex_lock(&ftrace_lock);
8386b0fc494fSSteven Rostedt 
838745a4a237SSteven Rostedt 	if (unlikely(ftrace_disabled))
838845a4a237SSteven Rostedt 		goto out;
838945a4a237SSteven Rostedt 
83908d65af78SAlexey Dobriyan 	ret = proc_dointvec(table, write, buffer, lenp, ppos);
8391b0fc494fSSteven Rostedt 
8392a32c7765SLi Zefan 	if (ret || !write || (last_ftrace_enabled == !!ftrace_enabled))
8393b0fc494fSSteven Rostedt 		goto out;
8394b0fc494fSSteven Rostedt 
8395b0fc494fSSteven Rostedt 	if (ftrace_enabled) {
8396b0fc494fSSteven Rostedt 
8397b0fc494fSSteven Rostedt 		/* we are starting ftrace again */
8398f86f4180SChunyan Zhang 		if (rcu_dereference_protected(ftrace_ops_list,
8399f86f4180SChunyan Zhang 			lockdep_is_held(&ftrace_lock)) != &ftrace_list_end)
84005000c418SJan Kiszka 			update_ftrace_function();
8401b0fc494fSSteven Rostedt 
8402524a3868SSteven Rostedt (Red Hat) 		ftrace_startup_sysctl();
8403524a3868SSteven Rostedt (Red Hat) 
8404b0fc494fSSteven Rostedt 	} else {
84057162431dSMiroslav Benes 		if (is_permanent_ops_registered()) {
84067162431dSMiroslav Benes 			ftrace_enabled = true;
84077162431dSMiroslav Benes 			ret = -EBUSY;
84087162431dSMiroslav Benes 			goto out;
84097162431dSMiroslav Benes 		}
84107162431dSMiroslav Benes 
8411b0fc494fSSteven Rostedt 		/* stopping ftrace calls (just send to ftrace_stub) */
8412b0fc494fSSteven Rostedt 		ftrace_trace_function = ftrace_stub;
8413b0fc494fSSteven Rostedt 
8414b0fc494fSSteven Rostedt 		ftrace_shutdown_sysctl();
8415b0fc494fSSteven Rostedt 	}
8416b0fc494fSSteven Rostedt 
84177162431dSMiroslav Benes 	last_ftrace_enabled = !!ftrace_enabled;
8418b0fc494fSSteven Rostedt  out:
8419e6ea44e9SSteven Rostedt 	mutex_unlock(&ftrace_lock);
84203d083395SSteven Rostedt 	return ret;
842116444a8aSArnaldo Carvalho de Melo }
84228e4e83b2SWei Xiao 
84238e4e83b2SWei Xiao static struct ctl_table ftrace_sysctls[] = {
84248e4e83b2SWei Xiao 	{
84258e4e83b2SWei Xiao 		.procname       = "ftrace_enabled",
84268e4e83b2SWei Xiao 		.data           = &ftrace_enabled,
84278e4e83b2SWei Xiao 		.maxlen         = sizeof(int),
84288e4e83b2SWei Xiao 		.mode           = 0644,
84298e4e83b2SWei Xiao 		.proc_handler   = ftrace_enable_sysctl,
84308e4e83b2SWei Xiao 	},
84318e4e83b2SWei Xiao 	{}
84328e4e83b2SWei Xiao };
84338e4e83b2SWei Xiao 
84348e4e83b2SWei Xiao static int __init ftrace_sysctl_init(void)
84358e4e83b2SWei Xiao {
84368e4e83b2SWei Xiao 	register_sysctl_init("kernel", ftrace_sysctls);
84378e4e83b2SWei Xiao 	return 0;
84388e4e83b2SWei Xiao }
84398e4e83b2SWei Xiao late_initcall(ftrace_sysctl_init);
84408e4e83b2SWei Xiao #endif
8441