xref: /linux-6.15/kernel/trace/ftrace.c (revision 9705bc70)
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);
203830f7d1caSZheng 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) {
2490763e34e7SSteven Rostedt (VMware) 	unsigned long addr;
2491763e34e7SSteven Rostedt (VMware) 
2492ff205766SAlexei Starovoitov 	addr = ftrace_find_rec_direct(ip);
2493763e34e7SSteven Rostedt (VMware) 	if (!addr)
2494763e34e7SSteven Rostedt (VMware) 		return;
2495763e34e7SSteven Rostedt (VMware) 
2496*9705bc70SMark Rutland 	arch_ftrace_set_direct_caller(fregs, addr);
2497763e34e7SSteven Rostedt (VMware) }
2498763e34e7SSteven Rostedt (VMware) 
2499763e34e7SSteven Rostedt (VMware) struct ftrace_ops direct_ops = {
2500763e34e7SSteven Rostedt (VMware) 	.func		= call_direct_funcs,
250153cd885bSSong Liu 	.flags		= FTRACE_OPS_FL_DIRECT | FTRACE_OPS_FL_SAVE_REGS
2502763e34e7SSteven Rostedt (VMware) 			  | FTRACE_OPS_FL_PERMANENT,
25035da7cd11SSteven Rostedt (VMware) 	/*
25045da7cd11SSteven Rostedt (VMware) 	 * By declaring the main trampoline as this trampoline
25055da7cd11SSteven Rostedt (VMware) 	 * it will never have one allocated for it. Allocated
25065da7cd11SSteven Rostedt (VMware) 	 * trampolines should not call direct functions.
25075da7cd11SSteven Rostedt (VMware) 	 * The direct_ops should only be called by the builtin
25085da7cd11SSteven Rostedt (VMware) 	 * ftrace_regs_caller trampoline.
25095da7cd11SSteven Rostedt (VMware) 	 */
25105da7cd11SSteven Rostedt (VMware) 	.trampoline	= FTRACE_REGS_ADDR,
2511763e34e7SSteven Rostedt (VMware) };
2512763e34e7SSteven Rostedt (VMware) #endif /* CONFIG_DYNAMIC_FTRACE_WITH_DIRECT_CALLS */
2513763e34e7SSteven Rostedt (VMware) 
25147413af1fSSteven Rostedt (Red Hat) /**
25157413af1fSSteven Rostedt (Red Hat)  * ftrace_get_addr_new - Get the call address to set to
25167413af1fSSteven Rostedt (Red Hat)  * @rec:  The ftrace record descriptor
25177413af1fSSteven Rostedt (Red Hat)  *
25187413af1fSSteven Rostedt (Red Hat)  * If the record has the FTRACE_FL_REGS set, that means that it
25197413af1fSSteven Rostedt (Red Hat)  * wants to convert to a callback that saves all regs. If FTRACE_FL_REGS
25205c8c206eSRandy Dunlap  * is not set, then it wants to convert to the normal callback.
25217413af1fSSteven Rostedt (Red Hat)  *
25227413af1fSSteven Rostedt (Red Hat)  * Returns the address of the trampoline to set to
25237413af1fSSteven Rostedt (Red Hat)  */
25247413af1fSSteven Rostedt (Red Hat) unsigned long ftrace_get_addr_new(struct dyn_ftrace *rec)
25257413af1fSSteven Rostedt (Red Hat) {
252679922b80SSteven Rostedt (Red Hat) 	struct ftrace_ops *ops;
2527763e34e7SSteven Rostedt (VMware) 	unsigned long addr;
2528763e34e7SSteven Rostedt (VMware) 
2529763e34e7SSteven Rostedt (VMware) 	if ((rec->flags & FTRACE_FL_DIRECT) &&
2530763e34e7SSteven Rostedt (VMware) 	    (ftrace_rec_count(rec) == 1)) {
2531ff205766SAlexei Starovoitov 		addr = ftrace_find_rec_direct(rec->ip);
2532763e34e7SSteven Rostedt (VMware) 		if (addr)
2533763e34e7SSteven Rostedt (VMware) 			return addr;
2534763e34e7SSteven Rostedt (VMware) 		WARN_ON_ONCE(1);
2535763e34e7SSteven Rostedt (VMware) 	}
253679922b80SSteven Rostedt (Red Hat) 
253779922b80SSteven Rostedt (Red Hat) 	/* Trampolines take precedence over regs */
253879922b80SSteven Rostedt (Red Hat) 	if (rec->flags & FTRACE_FL_TRAMP) {
253979922b80SSteven Rostedt (Red Hat) 		ops = ftrace_find_tramp_ops_new(rec);
254079922b80SSteven Rostedt (Red Hat) 		if (FTRACE_WARN_ON(!ops || !ops->trampoline)) {
2541bce0b6c5SSteven Rostedt (Red Hat) 			pr_warn("Bad trampoline accounting at: %p (%pS) (%lx)\n",
2542bce0b6c5SSteven Rostedt (Red Hat) 				(void *)rec->ip, (void *)rec->ip, rec->flags);
254379922b80SSteven Rostedt (Red Hat) 			/* Ftrace is shutting down, return anything */
254479922b80SSteven Rostedt (Red Hat) 			return (unsigned long)FTRACE_ADDR;
254579922b80SSteven Rostedt (Red Hat) 		}
254679922b80SSteven Rostedt (Red Hat) 		return ops->trampoline;
254779922b80SSteven Rostedt (Red Hat) 	}
254879922b80SSteven Rostedt (Red Hat) 
25497413af1fSSteven Rostedt (Red Hat) 	if (rec->flags & FTRACE_FL_REGS)
25507413af1fSSteven Rostedt (Red Hat) 		return (unsigned long)FTRACE_REGS_ADDR;
25517413af1fSSteven Rostedt (Red Hat) 	else
25527413af1fSSteven Rostedt (Red Hat) 		return (unsigned long)FTRACE_ADDR;
25537413af1fSSteven Rostedt (Red Hat) }
25547413af1fSSteven Rostedt (Red Hat) 
25557413af1fSSteven Rostedt (Red Hat) /**
25567413af1fSSteven Rostedt (Red Hat)  * ftrace_get_addr_curr - Get the call address that is already there
25577413af1fSSteven Rostedt (Red Hat)  * @rec:  The ftrace record descriptor
25587413af1fSSteven Rostedt (Red Hat)  *
25597413af1fSSteven Rostedt (Red Hat)  * The FTRACE_FL_REGS_EN is set when the record already points to
25607413af1fSSteven Rostedt (Red Hat)  * a function that saves all the regs. Basically the '_EN' version
25617413af1fSSteven Rostedt (Red Hat)  * represents the current state of the function.
25627413af1fSSteven Rostedt (Red Hat)  *
25637413af1fSSteven Rostedt (Red Hat)  * Returns the address of the trampoline that is currently being called
25647413af1fSSteven Rostedt (Red Hat)  */
25657413af1fSSteven Rostedt (Red Hat) unsigned long ftrace_get_addr_curr(struct dyn_ftrace *rec)
25667413af1fSSteven Rostedt (Red Hat) {
256779922b80SSteven Rostedt (Red Hat) 	struct ftrace_ops *ops;
2568763e34e7SSteven Rostedt (VMware) 	unsigned long addr;
2569763e34e7SSteven Rostedt (VMware) 
2570763e34e7SSteven Rostedt (VMware) 	/* Direct calls take precedence over trampolines */
2571763e34e7SSteven Rostedt (VMware) 	if (rec->flags & FTRACE_FL_DIRECT_EN) {
2572ff205766SAlexei Starovoitov 		addr = ftrace_find_rec_direct(rec->ip);
2573763e34e7SSteven Rostedt (VMware) 		if (addr)
2574763e34e7SSteven Rostedt (VMware) 			return addr;
2575763e34e7SSteven Rostedt (VMware) 		WARN_ON_ONCE(1);
2576763e34e7SSteven Rostedt (VMware) 	}
257779922b80SSteven Rostedt (Red Hat) 
257879922b80SSteven Rostedt (Red Hat) 	/* Trampolines take precedence over regs */
257979922b80SSteven Rostedt (Red Hat) 	if (rec->flags & FTRACE_FL_TRAMP_EN) {
258079922b80SSteven Rostedt (Red Hat) 		ops = ftrace_find_tramp_ops_curr(rec);
258179922b80SSteven Rostedt (Red Hat) 		if (FTRACE_WARN_ON(!ops)) {
2582a395d6a7SJoe Perches 			pr_warn("Bad trampoline accounting at: %p (%pS)\n",
258379922b80SSteven Rostedt (Red Hat) 				(void *)rec->ip, (void *)rec->ip);
258479922b80SSteven Rostedt (Red Hat) 			/* Ftrace is shutting down, return anything */
258579922b80SSteven Rostedt (Red Hat) 			return (unsigned long)FTRACE_ADDR;
258679922b80SSteven Rostedt (Red Hat) 		}
258779922b80SSteven Rostedt (Red Hat) 		return ops->trampoline;
258879922b80SSteven Rostedt (Red Hat) 	}
258979922b80SSteven Rostedt (Red Hat) 
25907413af1fSSteven Rostedt (Red Hat) 	if (rec->flags & FTRACE_FL_REGS_EN)
25917413af1fSSteven Rostedt (Red Hat) 		return (unsigned long)FTRACE_REGS_ADDR;
25927413af1fSSteven Rostedt (Red Hat) 	else
25937413af1fSSteven Rostedt (Red Hat) 		return (unsigned long)FTRACE_ADDR;
25947413af1fSSteven Rostedt (Red Hat) }
25957413af1fSSteven Rostedt (Red Hat) 
2596c88fd863SSteven Rostedt static int
25977375dca1SSteven Rostedt (VMware) __ftrace_replace_code(struct dyn_ftrace *rec, bool enable)
2598c88fd863SSteven Rostedt {
259908f6fba5SSteven Rostedt 	unsigned long ftrace_old_addr;
2600c88fd863SSteven Rostedt 	unsigned long ftrace_addr;
2601c88fd863SSteven Rostedt 	int ret;
2602c88fd863SSteven Rostedt 
26037c0868e0SSteven Rostedt (Red Hat) 	ftrace_addr = ftrace_get_addr_new(rec);
2604c88fd863SSteven Rostedt 
26057c0868e0SSteven Rostedt (Red Hat) 	/* This needs to be done before we call ftrace_update_record */
26067c0868e0SSteven Rostedt (Red Hat) 	ftrace_old_addr = ftrace_get_addr_curr(rec);
26077c0868e0SSteven Rostedt (Red Hat) 
26087c0868e0SSteven Rostedt (Red Hat) 	ret = ftrace_update_record(rec, enable);
260908f6fba5SSteven Rostedt 
261002a392a0SSteven Rostedt (Red Hat) 	ftrace_bug_type = FTRACE_BUG_UNKNOWN;
261102a392a0SSteven Rostedt (Red Hat) 
2612c88fd863SSteven Rostedt 	switch (ret) {
2613c88fd863SSteven Rostedt 	case FTRACE_UPDATE_IGNORE:
2614c88fd863SSteven Rostedt 		return 0;
2615c88fd863SSteven Rostedt 
2616c88fd863SSteven Rostedt 	case FTRACE_UPDATE_MAKE_CALL:
261702a392a0SSteven Rostedt (Red Hat) 		ftrace_bug_type = FTRACE_BUG_CALL;
2618c88fd863SSteven Rostedt 		return ftrace_make_call(rec, ftrace_addr);
2619c88fd863SSteven Rostedt 
2620c88fd863SSteven Rostedt 	case FTRACE_UPDATE_MAKE_NOP:
262102a392a0SSteven Rostedt (Red Hat) 		ftrace_bug_type = FTRACE_BUG_NOP;
262239b5552cSSteven Rostedt (Red Hat) 		return ftrace_make_nop(NULL, rec, ftrace_old_addr);
262308f6fba5SSteven Rostedt 
262408f6fba5SSteven Rostedt 	case FTRACE_UPDATE_MODIFY_CALL:
262502a392a0SSteven Rostedt (Red Hat) 		ftrace_bug_type = FTRACE_BUG_UPDATE;
262608f6fba5SSteven Rostedt 		return ftrace_modify_call(rec, ftrace_old_addr, ftrace_addr);
26273d083395SSteven Rostedt 	}
26283d083395SSteven Rostedt 
26299efb85c5SHariprasad Kelam 	return -1; /* unknown ftrace bug */
2630c88fd863SSteven Rostedt }
2631c88fd863SSteven Rostedt 
2632a0572f68SSteven Rostedt (VMware) void __weak ftrace_replace_code(int mod_flags)
26333d083395SSteven Rostedt {
26343d083395SSteven Rostedt 	struct dyn_ftrace *rec;
26353d083395SSteven Rostedt 	struct ftrace_page *pg;
26367375dca1SSteven Rostedt (VMware) 	bool enable = mod_flags & FTRACE_MODIFY_ENABLE_FL;
2637a0572f68SSteven Rostedt (VMware) 	int schedulable = mod_flags & FTRACE_MODIFY_MAY_SLEEP_FL;
26386a24a244SSteven Rostedt 	int failed;
26393d083395SSteven Rostedt 
264045a4a237SSteven Rostedt 	if (unlikely(ftrace_disabled))
264145a4a237SSteven Rostedt 		return;
264245a4a237SSteven Rostedt 
2643265c831cSSteven Rostedt 	do_for_each_ftrace_rec(pg, rec) {
2644546fece4SSteven Rostedt (Red Hat) 
2645cf04f2d5SSteven Rostedt (Google) 		if (skip_record(rec))
2646546fece4SSteven Rostedt (Red Hat) 			continue;
2647546fece4SSteven Rostedt (Red Hat) 
2648e4f5d544SSteven Rostedt 		failed = __ftrace_replace_code(rec, enable);
2649fa9d13cfSZhaolei 		if (failed) {
26504fd3279bSSteven Rostedt (Red Hat) 			ftrace_bug(failed, rec);
26514377245aSSteven Rostedt 			/* Stop processing */
26524377245aSSteven Rostedt 			return;
26534377245aSSteven Rostedt 		}
2654a0572f68SSteven Rostedt (VMware) 		if (schedulable)
2655a0572f68SSteven Rostedt (VMware) 			cond_resched();
2656265c831cSSteven Rostedt 	} while_for_each_ftrace_rec();
26573d083395SSteven Rostedt }
26583c1720f0SSteven Rostedt 
2659c88fd863SSteven Rostedt struct ftrace_rec_iter {
2660c88fd863SSteven Rostedt 	struct ftrace_page	*pg;
2661c88fd863SSteven Rostedt 	int			index;
2662c88fd863SSteven Rostedt };
2663c88fd863SSteven Rostedt 
2664c88fd863SSteven Rostedt /**
26656130722fSSteven Rostedt (VMware)  * ftrace_rec_iter_start - start up iterating over traced functions
2666c88fd863SSteven Rostedt  *
2667c88fd863SSteven Rostedt  * Returns an iterator handle that is used to iterate over all
2668c88fd863SSteven Rostedt  * the records that represent address locations where functions
2669c88fd863SSteven Rostedt  * are traced.
2670c88fd863SSteven Rostedt  *
2671c88fd863SSteven Rostedt  * May return NULL if no records are available.
2672c88fd863SSteven Rostedt  */
2673c88fd863SSteven Rostedt struct ftrace_rec_iter *ftrace_rec_iter_start(void)
2674c88fd863SSteven Rostedt {
2675c88fd863SSteven Rostedt 	/*
2676c88fd863SSteven Rostedt 	 * We only use a single iterator.
2677c88fd863SSteven Rostedt 	 * Protected by the ftrace_lock mutex.
2678c88fd863SSteven Rostedt 	 */
2679c88fd863SSteven Rostedt 	static struct ftrace_rec_iter ftrace_rec_iter;
2680c88fd863SSteven Rostedt 	struct ftrace_rec_iter *iter = &ftrace_rec_iter;
2681c88fd863SSteven Rostedt 
2682c88fd863SSteven Rostedt 	iter->pg = ftrace_pages_start;
2683c88fd863SSteven Rostedt 	iter->index = 0;
2684c88fd863SSteven Rostedt 
2685c88fd863SSteven Rostedt 	/* Could have empty pages */
2686c88fd863SSteven Rostedt 	while (iter->pg && !iter->pg->index)
2687c88fd863SSteven Rostedt 		iter->pg = iter->pg->next;
2688c88fd863SSteven Rostedt 
2689c88fd863SSteven Rostedt 	if (!iter->pg)
2690c88fd863SSteven Rostedt 		return NULL;
2691c88fd863SSteven Rostedt 
2692c88fd863SSteven Rostedt 	return iter;
2693c88fd863SSteven Rostedt }
2694c88fd863SSteven Rostedt 
2695c88fd863SSteven Rostedt /**
26966130722fSSteven Rostedt (VMware)  * ftrace_rec_iter_next - get the next record to process.
2697c88fd863SSteven Rostedt  * @iter: The handle to the iterator.
2698c88fd863SSteven Rostedt  *
2699c88fd863SSteven Rostedt  * Returns the next iterator after the given iterator @iter.
2700c88fd863SSteven Rostedt  */
2701c88fd863SSteven Rostedt struct ftrace_rec_iter *ftrace_rec_iter_next(struct ftrace_rec_iter *iter)
2702c88fd863SSteven Rostedt {
2703c88fd863SSteven Rostedt 	iter->index++;
2704c88fd863SSteven Rostedt 
2705c88fd863SSteven Rostedt 	if (iter->index >= iter->pg->index) {
2706c88fd863SSteven Rostedt 		iter->pg = iter->pg->next;
2707c88fd863SSteven Rostedt 		iter->index = 0;
2708c88fd863SSteven Rostedt 
2709c88fd863SSteven Rostedt 		/* Could have empty pages */
2710c88fd863SSteven Rostedt 		while (iter->pg && !iter->pg->index)
2711c88fd863SSteven Rostedt 			iter->pg = iter->pg->next;
2712c88fd863SSteven Rostedt 	}
2713c88fd863SSteven Rostedt 
2714c88fd863SSteven Rostedt 	if (!iter->pg)
2715c88fd863SSteven Rostedt 		return NULL;
2716c88fd863SSteven Rostedt 
2717c88fd863SSteven Rostedt 	return iter;
2718c88fd863SSteven Rostedt }
2719c88fd863SSteven Rostedt 
2720c88fd863SSteven Rostedt /**
27216130722fSSteven Rostedt (VMware)  * ftrace_rec_iter_record - get the record at the iterator location
2722c88fd863SSteven Rostedt  * @iter: The current iterator location
2723c88fd863SSteven Rostedt  *
2724c88fd863SSteven Rostedt  * Returns the record that the current @iter is at.
2725c88fd863SSteven Rostedt  */
2726c88fd863SSteven Rostedt struct dyn_ftrace *ftrace_rec_iter_record(struct ftrace_rec_iter *iter)
2727c88fd863SSteven Rostedt {
2728c88fd863SSteven Rostedt 	return &iter->pg->records[iter->index];
2729c88fd863SSteven Rostedt }
2730c88fd863SSteven Rostedt 
27313b47bfc1SSteven Rostedt static int
2732fbf6c73cSMark Rutland ftrace_nop_initialize(struct module *mod, struct dyn_ftrace *rec)
27333c1720f0SSteven Rostedt {
2734492a7ea5SAbhishek Sagar 	int ret;
273537ad5084SSteven Rostedt 
273645a4a237SSteven Rostedt 	if (unlikely(ftrace_disabled))
273745a4a237SSteven Rostedt 		return 0;
273845a4a237SSteven Rostedt 
2739fbf6c73cSMark Rutland 	ret = ftrace_init_nop(mod, rec);
27403d083395SSteven Rostedt 	if (ret) {
274102a392a0SSteven Rostedt (Red Hat) 		ftrace_bug_type = FTRACE_BUG_INIT;
27424fd3279bSSteven Rostedt (Red Hat) 		ftrace_bug(ret, rec);
27433d083395SSteven Rostedt 		return 0;
2744d61f82d0SSteven Rostedt 	}
2745d61f82d0SSteven Rostedt 	return 1;
27463d083395SSteven Rostedt }
27473d083395SSteven Rostedt 
2748000ab691SSteven Rostedt /*
2749000ab691SSteven Rostedt  * archs can override this function if they must do something
2750000ab691SSteven Rostedt  * before the modifying code is performed.
2751000ab691SSteven Rostedt  */
27523a2bfec0SLi kunyu void __weak ftrace_arch_code_modify_prepare(void)
2753000ab691SSteven Rostedt {
2754000ab691SSteven Rostedt }
2755000ab691SSteven Rostedt 
2756000ab691SSteven Rostedt /*
2757000ab691SSteven Rostedt  * archs can override this function if they must do something
2758000ab691SSteven Rostedt  * after the modifying code is performed.
2759000ab691SSteven Rostedt  */
27603a2bfec0SLi kunyu void __weak ftrace_arch_code_modify_post_process(void)
2761000ab691SSteven Rostedt {
2762000ab691SSteven Rostedt }
2763000ab691SSteven Rostedt 
27648ed3e2cfSSteven Rostedt void ftrace_modify_all_code(int command)
27658ed3e2cfSSteven Rostedt {
276659338f75SSteven Rostedt (Red Hat) 	int update = command & FTRACE_UPDATE_TRACE_FUNC;
2767a0572f68SSteven Rostedt (VMware) 	int mod_flags = 0;
2768cd21067fSPetr Mladek 	int err = 0;
276959338f75SSteven Rostedt (Red Hat) 
2770a0572f68SSteven Rostedt (VMware) 	if (command & FTRACE_MAY_SLEEP)
2771a0572f68SSteven Rostedt (VMware) 		mod_flags = FTRACE_MODIFY_MAY_SLEEP_FL;
2772a0572f68SSteven Rostedt (VMware) 
277359338f75SSteven Rostedt (Red Hat) 	/*
277459338f75SSteven Rostedt (Red Hat) 	 * If the ftrace_caller calls a ftrace_ops func directly,
277559338f75SSteven Rostedt (Red Hat) 	 * we need to make sure that it only traces functions it
277659338f75SSteven Rostedt (Red Hat) 	 * expects to trace. When doing the switch of functions,
277759338f75SSteven Rostedt (Red Hat) 	 * we need to update to the ftrace_ops_list_func first
277859338f75SSteven Rostedt (Red Hat) 	 * before the transition between old and new calls are set,
277959338f75SSteven Rostedt (Red Hat) 	 * as the ftrace_ops_list_func will check the ops hashes
278059338f75SSteven Rostedt (Red Hat) 	 * to make sure the ops are having the right functions
278159338f75SSteven Rostedt (Red Hat) 	 * traced.
278259338f75SSteven Rostedt (Red Hat) 	 */
2783cd21067fSPetr Mladek 	if (update) {
2784cd21067fSPetr Mladek 		err = ftrace_update_ftrace_func(ftrace_ops_list_func);
2785cd21067fSPetr Mladek 		if (FTRACE_WARN_ON(err))
2786cd21067fSPetr Mladek 			return;
2787cd21067fSPetr Mladek 	}
278859338f75SSteven Rostedt (Red Hat) 
27898ed3e2cfSSteven Rostedt 	if (command & FTRACE_UPDATE_CALLS)
2790a0572f68SSteven Rostedt (VMware) 		ftrace_replace_code(mod_flags | FTRACE_MODIFY_ENABLE_FL);
27918ed3e2cfSSteven Rostedt 	else if (command & FTRACE_DISABLE_CALLS)
2792a0572f68SSteven Rostedt (VMware) 		ftrace_replace_code(mod_flags);
27938ed3e2cfSSteven Rostedt 
2794405e1d83SSteven Rostedt (Red Hat) 	if (update && ftrace_trace_function != ftrace_ops_list_func) {
2795405e1d83SSteven Rostedt (Red Hat) 		function_trace_op = set_function_trace_op;
2796405e1d83SSteven Rostedt (Red Hat) 		smp_wmb();
2797405e1d83SSteven Rostedt (Red Hat) 		/* If irqs are disabled, we are in stop machine */
2798405e1d83SSteven Rostedt (Red Hat) 		if (!irqs_disabled())
2799405e1d83SSteven Rostedt (Red Hat) 			smp_call_function(ftrace_sync_ipi, NULL, 1);
2800cd21067fSPetr Mladek 		err = ftrace_update_ftrace_func(ftrace_trace_function);
2801cd21067fSPetr Mladek 		if (FTRACE_WARN_ON(err))
2802cd21067fSPetr Mladek 			return;
2803405e1d83SSteven Rostedt (Red Hat) 	}
28048ed3e2cfSSteven Rostedt 
28058ed3e2cfSSteven Rostedt 	if (command & FTRACE_START_FUNC_RET)
2806cd21067fSPetr Mladek 		err = ftrace_enable_ftrace_graph_caller();
28078ed3e2cfSSteven Rostedt 	else if (command & FTRACE_STOP_FUNC_RET)
2808cd21067fSPetr Mladek 		err = ftrace_disable_ftrace_graph_caller();
2809cd21067fSPetr Mladek 	FTRACE_WARN_ON(err);
28108ed3e2cfSSteven Rostedt }
28118ed3e2cfSSteven Rostedt 
28123d083395SSteven Rostedt static int __ftrace_modify_code(void *data)
28133d083395SSteven Rostedt {
28143d083395SSteven Rostedt 	int *command = data;
28153d083395SSteven Rostedt 
28168ed3e2cfSSteven Rostedt 	ftrace_modify_all_code(*command);
28175a45cfe1SSteven Rostedt 
2818c88fd863SSteven Rostedt 	return 0;
2819c88fd863SSteven Rostedt }
2820c88fd863SSteven Rostedt 
2821c88fd863SSteven Rostedt /**
28226130722fSSteven Rostedt (VMware)  * ftrace_run_stop_machine - go back to the stop machine method
2823c88fd863SSteven Rostedt  * @command: The command to tell ftrace what to do
2824c88fd863SSteven Rostedt  *
2825c88fd863SSteven Rostedt  * If an arch needs to fall back to the stop machine method, the
2826c88fd863SSteven Rostedt  * it can call this function.
2827c88fd863SSteven Rostedt  */
2828c88fd863SSteven Rostedt void ftrace_run_stop_machine(int command)
2829c88fd863SSteven Rostedt {
2830c88fd863SSteven Rostedt 	stop_machine(__ftrace_modify_code, &command, NULL);
2831c88fd863SSteven Rostedt }
2832c88fd863SSteven Rostedt 
2833c88fd863SSteven Rostedt /**
28346130722fSSteven Rostedt (VMware)  * arch_ftrace_update_code - modify the code to trace or not trace
2835c88fd863SSteven Rostedt  * @command: The command that needs to be done
2836c88fd863SSteven Rostedt  *
2837c88fd863SSteven Rostedt  * Archs can override this function if it does not need to
2838c88fd863SSteven Rostedt  * run stop_machine() to modify code.
2839c88fd863SSteven Rostedt  */
2840c88fd863SSteven Rostedt void __weak arch_ftrace_update_code(int command)
2841c88fd863SSteven Rostedt {
2842c88fd863SSteven Rostedt 	ftrace_run_stop_machine(command);
2843c88fd863SSteven Rostedt }
2844c88fd863SSteven Rostedt 
2845c88fd863SSteven Rostedt static void ftrace_run_update_code(int command)
2846c88fd863SSteven Rostedt {
28473a2bfec0SLi kunyu 	ftrace_arch_code_modify_prepare();
2848c88fd863SSteven Rostedt 
2849c88fd863SSteven Rostedt 	/*
2850c88fd863SSteven Rostedt 	 * By default we use stop_machine() to modify the code.
2851c88fd863SSteven Rostedt 	 * But archs can do what ever they want as long as it
2852c88fd863SSteven Rostedt 	 * is safe. The stop_machine() is the safest, but also
2853c88fd863SSteven Rostedt 	 * produces the most overhead.
2854c88fd863SSteven Rostedt 	 */
2855c88fd863SSteven Rostedt 	arch_ftrace_update_code(command);
2856c88fd863SSteven Rostedt 
28573a2bfec0SLi kunyu 	ftrace_arch_code_modify_post_process();
28583d083395SSteven Rostedt }
28593d083395SSteven Rostedt 
28608252ecf3SSteven Rostedt (Red Hat) static void ftrace_run_modify_code(struct ftrace_ops *ops, int command,
28617485058eSSteven Rostedt (Red Hat) 				   struct ftrace_ops_hash *old_hash)
2862e1effa01SSteven Rostedt (Red Hat) {
2863e1effa01SSteven Rostedt (Red Hat) 	ops->flags |= FTRACE_OPS_FL_MODIFYING;
28647485058eSSteven Rostedt (Red Hat) 	ops->old_hash.filter_hash = old_hash->filter_hash;
28657485058eSSteven Rostedt (Red Hat) 	ops->old_hash.notrace_hash = old_hash->notrace_hash;
2866e1effa01SSteven Rostedt (Red Hat) 	ftrace_run_update_code(command);
28678252ecf3SSteven Rostedt (Red Hat) 	ops->old_hash.filter_hash = NULL;
28687485058eSSteven Rostedt (Red Hat) 	ops->old_hash.notrace_hash = NULL;
2869e1effa01SSteven Rostedt (Red Hat) 	ops->flags &= ~FTRACE_OPS_FL_MODIFYING;
2870e1effa01SSteven Rostedt (Red Hat) }
2871e1effa01SSteven Rostedt (Red Hat) 
28723d083395SSteven Rostedt static ftrace_func_t saved_ftrace_func;
287360a7ecf4SSteven Rostedt static int ftrace_start_up;
2874df4fc315SSteven Rostedt 
287512cce594SSteven Rostedt (Red Hat) void __weak arch_ftrace_trampoline_free(struct ftrace_ops *ops)
287612cce594SSteven Rostedt (Red Hat) {
287712cce594SSteven Rostedt (Red Hat) }
287812cce594SSteven Rostedt (Red Hat) 
2879fc0ea795SAdrian Hunter /* List of trace_ops that have allocated trampolines */
2880fc0ea795SAdrian Hunter static LIST_HEAD(ftrace_ops_trampoline_list);
2881fc0ea795SAdrian Hunter 
2882fc0ea795SAdrian Hunter static void ftrace_add_trampoline_to_kallsyms(struct ftrace_ops *ops)
2883fc0ea795SAdrian Hunter {
2884fc0ea795SAdrian Hunter 	lockdep_assert_held(&ftrace_lock);
2885fc0ea795SAdrian Hunter 	list_add_rcu(&ops->list, &ftrace_ops_trampoline_list);
2886fc0ea795SAdrian Hunter }
2887fc0ea795SAdrian Hunter 
2888fc0ea795SAdrian Hunter static void ftrace_remove_trampoline_from_kallsyms(struct ftrace_ops *ops)
2889fc0ea795SAdrian Hunter {
2890fc0ea795SAdrian Hunter 	lockdep_assert_held(&ftrace_lock);
2891fc0ea795SAdrian Hunter 	list_del_rcu(&ops->list);
2892478ece95SAdrian Hunter 	synchronize_rcu();
2893fc0ea795SAdrian Hunter }
2894fc0ea795SAdrian Hunter 
2895fc0ea795SAdrian Hunter /*
2896fc0ea795SAdrian Hunter  * "__builtin__ftrace" is used as a module name in /proc/kallsyms for symbols
2897fc0ea795SAdrian Hunter  * for pages allocated for ftrace purposes, even though "__builtin__ftrace" is
2898fc0ea795SAdrian Hunter  * not a module.
2899fc0ea795SAdrian Hunter  */
2900fc0ea795SAdrian Hunter #define FTRACE_TRAMPOLINE_MOD "__builtin__ftrace"
2901fc0ea795SAdrian Hunter #define FTRACE_TRAMPOLINE_SYM "ftrace_trampoline"
2902fc0ea795SAdrian Hunter 
2903fc0ea795SAdrian Hunter static void ftrace_trampoline_free(struct ftrace_ops *ops)
2904fc0ea795SAdrian Hunter {
2905fc0ea795SAdrian Hunter 	if (ops && (ops->flags & FTRACE_OPS_FL_ALLOC_TRAMP) &&
2906dd9ddf46SAdrian Hunter 	    ops->trampoline) {
2907548e1f6cSAdrian Hunter 		/*
2908548e1f6cSAdrian Hunter 		 * Record the text poke event before the ksymbol unregister
2909548e1f6cSAdrian Hunter 		 * event.
2910548e1f6cSAdrian Hunter 		 */
2911548e1f6cSAdrian Hunter 		perf_event_text_poke((void *)ops->trampoline,
2912548e1f6cSAdrian Hunter 				     (void *)ops->trampoline,
2913548e1f6cSAdrian Hunter 				     ops->trampoline_size, NULL, 0);
2914dd9ddf46SAdrian Hunter 		perf_event_ksymbol(PERF_RECORD_KSYMBOL_TYPE_OOL,
2915dd9ddf46SAdrian Hunter 				   ops->trampoline, ops->trampoline_size,
2916dd9ddf46SAdrian Hunter 				   true, FTRACE_TRAMPOLINE_SYM);
2917dd9ddf46SAdrian Hunter 		/* Remove from kallsyms after the perf events */
2918fc0ea795SAdrian Hunter 		ftrace_remove_trampoline_from_kallsyms(ops);
2919dd9ddf46SAdrian Hunter 	}
2920fc0ea795SAdrian Hunter 
2921fc0ea795SAdrian Hunter 	arch_ftrace_trampoline_free(ops);
2922fc0ea795SAdrian Hunter }
2923fc0ea795SAdrian Hunter 
2924df4fc315SSteven Rostedt static void ftrace_startup_enable(int command)
2925df4fc315SSteven Rostedt {
2926df4fc315SSteven Rostedt 	if (saved_ftrace_func != ftrace_trace_function) {
2927df4fc315SSteven Rostedt 		saved_ftrace_func = ftrace_trace_function;
2928df4fc315SSteven Rostedt 		command |= FTRACE_UPDATE_TRACE_FUNC;
2929df4fc315SSteven Rostedt 	}
2930df4fc315SSteven Rostedt 
2931df4fc315SSteven Rostedt 	if (!command || !ftrace_enabled)
2932df4fc315SSteven Rostedt 		return;
2933df4fc315SSteven Rostedt 
2934df4fc315SSteven Rostedt 	ftrace_run_update_code(command);
2935df4fc315SSteven Rostedt }
29363d083395SSteven Rostedt 
2937e1effa01SSteven Rostedt (Red Hat) static void ftrace_startup_all(int command)
2938e1effa01SSteven Rostedt (Red Hat) {
2939e1effa01SSteven Rostedt (Red Hat) 	update_all_ops = true;
2940e1effa01SSteven Rostedt (Red Hat) 	ftrace_startup_enable(command);
2941e1effa01SSteven Rostedt (Red Hat) 	update_all_ops = false;
2942e1effa01SSteven Rostedt (Red Hat) }
2943e1effa01SSteven Rostedt (Red Hat) 
29443306fc4aSSteven Rostedt (VMware) int ftrace_startup(struct ftrace_ops *ops, int command)
29453d083395SSteven Rostedt {
29468a56d776SSteven Rostedt (Red Hat) 	int ret;
2947b848914cSSteven Rostedt 
29484eebcc81SSteven Rostedt 	if (unlikely(ftrace_disabled))
2949a1cd6173SSteven Rostedt 		return -ENODEV;
29504eebcc81SSteven Rostedt 
29518a56d776SSteven Rostedt (Red Hat) 	ret = __register_ftrace_function(ops);
29528a56d776SSteven Rostedt (Red Hat) 	if (ret)
29538a56d776SSteven Rostedt (Red Hat) 		return ret;
29548a56d776SSteven Rostedt (Red Hat) 
295560a7ecf4SSteven Rostedt 	ftrace_start_up++;
29563d083395SSteven Rostedt 
2957e1effa01SSteven Rostedt (Red Hat) 	/*
2958e1effa01SSteven Rostedt (Red Hat) 	 * Note that ftrace probes uses this to start up
2959e1effa01SSteven Rostedt (Red Hat) 	 * and modify functions it will probe. But we still
2960e1effa01SSteven Rostedt (Red Hat) 	 * set the ADDING flag for modification, as probes
2961e1effa01SSteven Rostedt (Red Hat) 	 * do not have trampolines. If they add them in the
2962e1effa01SSteven Rostedt (Red Hat) 	 * future, then the probes will need to distinguish
2963e1effa01SSteven Rostedt (Red Hat) 	 * between adding and updating probes.
2964e1effa01SSteven Rostedt (Red Hat) 	 */
2965e1effa01SSteven Rostedt (Red Hat) 	ops->flags |= FTRACE_OPS_FL_ENABLED | FTRACE_OPS_FL_ADDING;
296666209a5bSSteven Rostedt (Red Hat) 
2967f8b8be8aSMasami Hiramatsu 	ret = ftrace_hash_ipmodify_enable(ops);
2968f8b8be8aSMasami Hiramatsu 	if (ret < 0) {
2969f8b8be8aSMasami Hiramatsu 		/* Rollback registration process */
2970f8b8be8aSMasami Hiramatsu 		__unregister_ftrace_function(ops);
2971f8b8be8aSMasami Hiramatsu 		ftrace_start_up--;
2972f8b8be8aSMasami Hiramatsu 		ops->flags &= ~FTRACE_OPS_FL_ENABLED;
2973d5e47505SMiroslav Benes 		if (ops->flags & FTRACE_OPS_FL_DYNAMIC)
2974d5e47505SMiroslav Benes 			ftrace_trampoline_free(ops);
2975f8b8be8aSMasami Hiramatsu 		return ret;
2976f8b8be8aSMasami Hiramatsu 	}
2977f8b8be8aSMasami Hiramatsu 
29787f50d06bSJiri Olsa 	if (ftrace_hash_rec_enable(ops, 1))
29797f50d06bSJiri Olsa 		command |= FTRACE_UPDATE_CALLS;
2980ed926f9bSSteven Rostedt 
2981df4fc315SSteven Rostedt 	ftrace_startup_enable(command);
2982a1cd6173SSteven Rostedt 
2983c3b0f72eSYang Jihong 	/*
2984c3b0f72eSYang Jihong 	 * If ftrace is in an undefined state, we just remove ops from list
2985c3b0f72eSYang Jihong 	 * to prevent the NULL pointer, instead of totally rolling it back and
2986c3b0f72eSYang Jihong 	 * free trampoline, because those actions could cause further damage.
2987c3b0f72eSYang Jihong 	 */
2988c3b0f72eSYang Jihong 	if (unlikely(ftrace_disabled)) {
2989c3b0f72eSYang Jihong 		__unregister_ftrace_function(ops);
2990c3b0f72eSYang Jihong 		return -ENODEV;
2991c3b0f72eSYang Jihong 	}
2992c3b0f72eSYang Jihong 
2993e1effa01SSteven Rostedt (Red Hat) 	ops->flags &= ~FTRACE_OPS_FL_ADDING;
2994e1effa01SSteven Rostedt (Red Hat) 
2995a1cd6173SSteven Rostedt 	return 0;
29963d083395SSteven Rostedt }
29973d083395SSteven Rostedt 
29983306fc4aSSteven Rostedt (VMware) int ftrace_shutdown(struct ftrace_ops *ops, int command)
29993d083395SSteven Rostedt {
30008a56d776SSteven Rostedt (Red Hat) 	int ret;
3001b848914cSSteven Rostedt 
30024eebcc81SSteven Rostedt 	if (unlikely(ftrace_disabled))
30038a56d776SSteven Rostedt (Red Hat) 		return -ENODEV;
30048a56d776SSteven Rostedt (Red Hat) 
30058a56d776SSteven Rostedt (Red Hat) 	ret = __unregister_ftrace_function(ops);
30068a56d776SSteven Rostedt (Red Hat) 	if (ret)
30078a56d776SSteven Rostedt (Red Hat) 		return ret;
30084eebcc81SSteven Rostedt 
300960a7ecf4SSteven Rostedt 	ftrace_start_up--;
30109ea1a153SFrederic Weisbecker 	/*
30119ea1a153SFrederic Weisbecker 	 * Just warn in case of unbalance, no need to kill ftrace, it's not
30129ea1a153SFrederic Weisbecker 	 * critical but the ftrace_call callers may be never nopped again after
30139ea1a153SFrederic Weisbecker 	 * further ftrace uses.
30149ea1a153SFrederic Weisbecker 	 */
30159ea1a153SFrederic Weisbecker 	WARN_ON_ONCE(ftrace_start_up < 0);
30169ea1a153SFrederic Weisbecker 
3017f8b8be8aSMasami Hiramatsu 	/* Disabling ipmodify never fails */
3018f8b8be8aSMasami Hiramatsu 	ftrace_hash_ipmodify_disable(ops);
30197f50d06bSJiri Olsa 
30207f50d06bSJiri Olsa 	if (ftrace_hash_rec_disable(ops, 1))
30217f50d06bSJiri Olsa 		command |= FTRACE_UPDATE_CALLS;
3022ed926f9bSSteven Rostedt 
3023ed926f9bSSteven Rostedt 	ops->flags &= ~FTRACE_OPS_FL_ENABLED;
3024b848914cSSteven Rostedt 
3025d61f82d0SSteven Rostedt 	if (saved_ftrace_func != ftrace_trace_function) {
3026d61f82d0SSteven Rostedt 		saved_ftrace_func = ftrace_trace_function;
3027d61f82d0SSteven Rostedt 		command |= FTRACE_UPDATE_TRACE_FUNC;
3028d61f82d0SSteven Rostedt 	}
3029d61f82d0SSteven Rostedt 
30300e792b89SLi Huafei 	if (!command || !ftrace_enabled)
30310e792b89SLi Huafei 		goto out;
30323d083395SSteven Rostedt 
303379922b80SSteven Rostedt (Red Hat) 	/*
303479922b80SSteven Rostedt (Red Hat) 	 * If the ops uses a trampoline, then it needs to be
303579922b80SSteven Rostedt (Red Hat) 	 * tested first on update.
303679922b80SSteven Rostedt (Red Hat) 	 */
3037e1effa01SSteven Rostedt (Red Hat) 	ops->flags |= FTRACE_OPS_FL_REMOVING;
303879922b80SSteven Rostedt (Red Hat) 	removed_ops = ops;
303979922b80SSteven Rostedt (Red Hat) 
3040fef5aeeeSSteven Rostedt (Red Hat) 	/* The trampoline logic checks the old hashes */
3041fef5aeeeSSteven Rostedt (Red Hat) 	ops->old_hash.filter_hash = ops->func_hash->filter_hash;
3042fef5aeeeSSteven Rostedt (Red Hat) 	ops->old_hash.notrace_hash = ops->func_hash->notrace_hash;
3043fef5aeeeSSteven Rostedt (Red Hat) 
3044d61f82d0SSteven Rostedt 	ftrace_run_update_code(command);
3045a4c35ed2SSteven Rostedt (Red Hat) 
304684bde62cSSteven Rostedt (Red Hat) 	/*
304784bde62cSSteven Rostedt (Red Hat) 	 * If there's no more ops registered with ftrace, run a
304884bde62cSSteven Rostedt (Red Hat) 	 * sanity check to make sure all rec flags are cleared.
304984bde62cSSteven Rostedt (Red Hat) 	 */
3050f86f4180SChunyan Zhang 	if (rcu_dereference_protected(ftrace_ops_list,
3051f86f4180SChunyan Zhang 			lockdep_is_held(&ftrace_lock)) == &ftrace_list_end) {
305284bde62cSSteven Rostedt (Red Hat) 		struct ftrace_page *pg;
305384bde62cSSteven Rostedt (Red Hat) 		struct dyn_ftrace *rec;
305484bde62cSSteven Rostedt (Red Hat) 
305584bde62cSSteven Rostedt (Red Hat) 		do_for_each_ftrace_rec(pg, rec) {
3056977c1f9cSAlexei Starovoitov 			if (FTRACE_WARN_ON_ONCE(rec->flags & ~FTRACE_FL_DISABLED))
305784bde62cSSteven Rostedt (Red Hat) 				pr_warn("  %pS flags:%lx\n",
305884bde62cSSteven Rostedt (Red Hat) 					(void *)rec->ip, rec->flags);
305984bde62cSSteven Rostedt (Red Hat) 		} while_for_each_ftrace_rec();
306084bde62cSSteven Rostedt (Red Hat) 	}
306184bde62cSSteven Rostedt (Red Hat) 
3062fef5aeeeSSteven Rostedt (Red Hat) 	ops->old_hash.filter_hash = NULL;
3063fef5aeeeSSteven Rostedt (Red Hat) 	ops->old_hash.notrace_hash = NULL;
3064fef5aeeeSSteven Rostedt (Red Hat) 
3065fef5aeeeSSteven Rostedt (Red Hat) 	removed_ops = NULL;
3066e1effa01SSteven Rostedt (Red Hat) 	ops->flags &= ~FTRACE_OPS_FL_REMOVING;
306779922b80SSteven Rostedt (Red Hat) 
30680e792b89SLi Huafei out:
3069a4c35ed2SSteven Rostedt (Red Hat) 	/*
3070a4c35ed2SSteven Rostedt (Red Hat) 	 * Dynamic ops may be freed, we must make sure that all
3071a4c35ed2SSteven Rostedt (Red Hat) 	 * callers are done before leaving this function.
3072ba27f2bcSSteven Rostedt (Red Hat) 	 * The same goes for freeing the per_cpu data of the per_cpu
3073a4c35ed2SSteven Rostedt (Red Hat) 	 * ops.
30740598e4f0SSteven Rostedt (VMware) 	 */
3075b3a88803SPeter Zijlstra 	if (ops->flags & FTRACE_OPS_FL_DYNAMIC) {
30760598e4f0SSteven Rostedt (VMware) 		/*
3077a4c35ed2SSteven Rostedt (Red Hat) 		 * We need to do a hard force of sched synchronization.
3078a4c35ed2SSteven Rostedt (Red Hat) 		 * This is because we use preempt_disable() to do RCU, but
3079a4c35ed2SSteven Rostedt (Red Hat) 		 * the function tracers can be called where RCU is not watching
3080a4c35ed2SSteven Rostedt (Red Hat) 		 * (like before user_exit()). We can not rely on the RCU
3081a4c35ed2SSteven Rostedt (Red Hat) 		 * infrastructure to do the synchronization, thus we must do it
3082a4c35ed2SSteven Rostedt (Red Hat) 		 * ourselves.
3083a4c35ed2SSteven Rostedt (Red Hat) 		 */
3084e5a971d7SPaul E. McKenney 		synchronize_rcu_tasks_rude();
3085a4c35ed2SSteven Rostedt (Red Hat) 
30860598e4f0SSteven Rostedt (VMware) 		/*
3087fdda88d3SQiujun Huang 		 * When the kernel is preemptive, tasks can be preempted
30880598e4f0SSteven Rostedt (VMware) 		 * while on a ftrace trampoline. Just scheduling a task on
30890598e4f0SSteven Rostedt (VMware) 		 * a CPU is not good enough to flush them. Calling
3090f2cc020dSIngo Molnar 		 * synchronize_rcu_tasks() will wait for those tasks to
30910598e4f0SSteven Rostedt (VMware) 		 * execute and either schedule voluntarily or enter user space.
30920598e4f0SSteven Rostedt (VMware) 		 */
309330c93704SThomas Gleixner 		if (IS_ENABLED(CONFIG_PREEMPTION))
30940598e4f0SSteven Rostedt (VMware) 			synchronize_rcu_tasks();
30950598e4f0SSteven Rostedt (VMware) 
3096fc0ea795SAdrian Hunter 		ftrace_trampoline_free(ops);
3097a4c35ed2SSteven Rostedt (Red Hat) 	}
3098a4c35ed2SSteven Rostedt (Red Hat) 
30998a56d776SSteven Rostedt (Red Hat) 	return 0;
31003d083395SSteven Rostedt }
31013d083395SSteven Rostedt 
3102a5a1d1c2SThomas Gleixner static u64		ftrace_update_time;
31033d083395SSteven Rostedt unsigned long		ftrace_update_tot_cnt;
3104da537f0aSSteven Rostedt (VMware) unsigned long		ftrace_number_of_pages;
3105da537f0aSSteven Rostedt (VMware) unsigned long		ftrace_number_of_groups;
31063d083395SSteven Rostedt 
31078c4f3c3fSSteven Rostedt (Red Hat) static inline int ops_traces_mod(struct ftrace_ops *ops)
3108f7bc8b61SSteven Rostedt {
31098c4f3c3fSSteven Rostedt (Red Hat) 	/*
31108c4f3c3fSSteven Rostedt (Red Hat) 	 * Filter_hash being empty will default to trace module.
31118c4f3c3fSSteven Rostedt (Red Hat) 	 * But notrace hash requires a test of individual module functions.
31128c4f3c3fSSteven Rostedt (Red Hat) 	 */
311333b7f99cSSteven Rostedt (Red Hat) 	return ftrace_hash_empty(ops->func_hash->filter_hash) &&
311433b7f99cSSteven Rostedt (Red Hat) 		ftrace_hash_empty(ops->func_hash->notrace_hash);
31158c4f3c3fSSteven Rostedt (Red Hat) }
3116f7bc8b61SSteven Rostedt 
31171dc43cf0SJiri Slaby static int ftrace_update_code(struct module *mod, struct ftrace_page *new_pgs)
31183d083395SSteven Rostedt {
311967ccddf8SIlya Leoshkevich 	bool init_nop = ftrace_need_init_nop();
312085ae32aeSSteven Rostedt 	struct ftrace_page *pg;
3121e94142a6SLai Jiangshan 	struct dyn_ftrace *p;
3122a5a1d1c2SThomas Gleixner 	u64 start, stop;
31231dc43cf0SJiri Slaby 	unsigned long update_cnt = 0;
3124b7ffffbbSSteven Rostedt (Red Hat) 	unsigned long rec_flags = 0;
312585ae32aeSSteven Rostedt 	int i;
3126f7bc8b61SSteven Rostedt 
3127750ed1a4SIngo Molnar 	start = ftrace_now(raw_smp_processor_id());
31283d083395SSteven Rostedt 
3129b7ffffbbSSteven Rostedt (Red Hat) 	/*
3130b7ffffbbSSteven Rostedt (Red Hat) 	 * When a module is loaded, this function is called to convert
3131b7ffffbbSSteven Rostedt (Red Hat) 	 * the calls to mcount in its text to nops, and also to create
3132b7ffffbbSSteven Rostedt (Red Hat) 	 * an entry in the ftrace data. Now, if ftrace is activated
3133b7ffffbbSSteven Rostedt (Red Hat) 	 * after this call, but before the module sets its text to
3134b7ffffbbSSteven Rostedt (Red Hat) 	 * read-only, the modification of enabling ftrace can fail if
3135b7ffffbbSSteven Rostedt (Red Hat) 	 * the read-only is done while ftrace is converting the calls.
3136b7ffffbbSSteven Rostedt (Red Hat) 	 * To prevent this, the module's records are set as disabled
3137b7ffffbbSSteven Rostedt (Red Hat) 	 * and will be enabled after the call to set the module's text
3138b7ffffbbSSteven Rostedt (Red Hat) 	 * to read-only.
3139b7ffffbbSSteven Rostedt (Red Hat) 	 */
3140b7ffffbbSSteven Rostedt (Red Hat) 	if (mod)
3141b7ffffbbSSteven Rostedt (Red Hat) 		rec_flags |= FTRACE_FL_DISABLED;
3142b7ffffbbSSteven Rostedt (Red Hat) 
31431dc43cf0SJiri Slaby 	for (pg = new_pgs; pg; pg = pg->next) {
3144f22f9a89SAbhishek Sagar 
314585ae32aeSSteven Rostedt 		for (i = 0; i < pg->index; i++) {
31468c4f3c3fSSteven Rostedt (Red Hat) 
314708f5ac90SSteven Rostedt 			/* If something went wrong, bail without enabling anything */
314808f5ac90SSteven Rostedt 			if (unlikely(ftrace_disabled))
314908f5ac90SSteven Rostedt 				return -1;
31503d083395SSteven Rostedt 
315185ae32aeSSteven Rostedt 			p = &pg->records[i];
3152b7ffffbbSSteven Rostedt (Red Hat) 			p->flags = rec_flags;
3153f22f9a89SAbhishek Sagar 
31545cb084bbSJiri Olsa 			/*
315525985edcSLucas De Marchi 			 * Do the initial record conversion from mcount jump
31565cb084bbSJiri Olsa 			 * to the NOP instructions.
31575cb084bbSJiri Olsa 			 */
315867ccddf8SIlya Leoshkevich 			if (init_nop && !ftrace_nop_initialize(mod, p))
3159d2c8c3eaSSteven Rostedt 				break;
31605cb084bbSJiri Olsa 
31611dc43cf0SJiri Slaby 			update_cnt++;
31625cb084bbSJiri Olsa 		}
316385ae32aeSSteven Rostedt 	}
316485ae32aeSSteven Rostedt 
3165750ed1a4SIngo Molnar 	stop = ftrace_now(raw_smp_processor_id());
31663d083395SSteven Rostedt 	ftrace_update_time = stop - start;
31671dc43cf0SJiri Slaby 	ftrace_update_tot_cnt += update_cnt;
31683d083395SSteven Rostedt 
316916444a8aSArnaldo Carvalho de Melo 	return 0;
317016444a8aSArnaldo Carvalho de Melo }
317116444a8aSArnaldo Carvalho de Melo 
3172a7900875SSteven Rostedt static int ftrace_allocate_records(struct ftrace_page *pg, int count)
31733c1720f0SSteven Rostedt {
3174a7900875SSteven Rostedt 	int order;
31757ba031e8SSteven Rostedt (VMware) 	int pages;
31763c1720f0SSteven Rostedt 	int cnt;
31773c1720f0SSteven Rostedt 
3178a7900875SSteven Rostedt 	if (WARN_ON(!count))
3179a7900875SSteven Rostedt 		return -EINVAL;
3180a7900875SSteven Rostedt 
3181ceaaa129SSteven Rostedt (VMware) 	/* We want to fill as much as possible, with no empty pages */
3182b40c6eabSWei Yang 	pages = DIV_ROUND_UP(count, ENTRIES_PER_PAGE);
3183ceaaa129SSteven Rostedt (VMware) 	order = fls(pages) - 1;
31843c1720f0SSteven Rostedt 
3185a7900875SSteven Rostedt  again:
3186a7900875SSteven Rostedt 	pg->records = (void *)__get_free_pages(GFP_KERNEL | __GFP_ZERO, order);
3187a7900875SSteven Rostedt 
3188a7900875SSteven Rostedt 	if (!pg->records) {
3189a7900875SSteven Rostedt 		/* if we can't allocate this size, try something smaller */
3190a7900875SSteven Rostedt 		if (!order)
3191a7900875SSteven Rostedt 			return -ENOMEM;
3192a7900875SSteven Rostedt 		order >>= 1;
3193a7900875SSteven Rostedt 		goto again;
3194a7900875SSteven Rostedt 	}
3195a7900875SSteven Rostedt 
3196da537f0aSSteven Rostedt (VMware) 	ftrace_number_of_pages += 1 << order;
3197da537f0aSSteven Rostedt (VMware) 	ftrace_number_of_groups++;
3198da537f0aSSteven Rostedt (VMware) 
3199a7900875SSteven Rostedt 	cnt = (PAGE_SIZE << order) / ENTRY_SIZE;
3200db42523bSLinus Torvalds 	pg->order = order;
3201a7900875SSteven Rostedt 
3202a7900875SSteven Rostedt 	if (cnt > count)
3203a7900875SSteven Rostedt 		cnt = count;
3204a7900875SSteven Rostedt 
3205a7900875SSteven Rostedt 	return cnt;
3206a7900875SSteven Rostedt }
3207a7900875SSteven Rostedt 
3208a7900875SSteven Rostedt static struct ftrace_page *
3209a7900875SSteven Rostedt ftrace_allocate_pages(unsigned long num_to_init)
3210a7900875SSteven Rostedt {
3211a7900875SSteven Rostedt 	struct ftrace_page *start_pg;
3212a7900875SSteven Rostedt 	struct ftrace_page *pg;
3213a7900875SSteven Rostedt 	int cnt;
3214a7900875SSteven Rostedt 
3215a7900875SSteven Rostedt 	if (!num_to_init)
32169efb85c5SHariprasad Kelam 		return NULL;
3217a7900875SSteven Rostedt 
3218a7900875SSteven Rostedt 	start_pg = pg = kzalloc(sizeof(*pg), GFP_KERNEL);
3219a7900875SSteven Rostedt 	if (!pg)
3220a7900875SSteven Rostedt 		return NULL;
3221a7900875SSteven Rostedt 
3222a7900875SSteven Rostedt 	/*
3223a7900875SSteven Rostedt 	 * Try to allocate as much as possible in one continues
3224a7900875SSteven Rostedt 	 * location that fills in all of the space. We want to
3225a7900875SSteven Rostedt 	 * waste as little space as possible.
3226a7900875SSteven Rostedt 	 */
3227a7900875SSteven Rostedt 	for (;;) {
3228a7900875SSteven Rostedt 		cnt = ftrace_allocate_records(pg, num_to_init);
3229a7900875SSteven Rostedt 		if (cnt < 0)
3230a7900875SSteven Rostedt 			goto free_pages;
3231a7900875SSteven Rostedt 
3232a7900875SSteven Rostedt 		num_to_init -= cnt;
3233a7900875SSteven Rostedt 		if (!num_to_init)
3234a7900875SSteven Rostedt 			break;
3235a7900875SSteven Rostedt 
3236a7900875SSteven Rostedt 		pg->next = kzalloc(sizeof(*pg), GFP_KERNEL);
3237a7900875SSteven Rostedt 		if (!pg->next)
3238a7900875SSteven Rostedt 			goto free_pages;
3239a7900875SSteven Rostedt 
3240a7900875SSteven Rostedt 		pg = pg->next;
3241a7900875SSteven Rostedt 	}
3242a7900875SSteven Rostedt 
3243a7900875SSteven Rostedt 	return start_pg;
3244a7900875SSteven Rostedt 
3245a7900875SSteven Rostedt  free_pages:
32461f61be00SNamhyung Kim 	pg = start_pg;
32471f61be00SNamhyung Kim 	while (pg) {
3248db42523bSLinus Torvalds 		if (pg->records) {
3249db42523bSLinus Torvalds 			free_pages((unsigned long)pg->records, pg->order);
3250db42523bSLinus Torvalds 			ftrace_number_of_pages -= 1 << pg->order;
3251db42523bSLinus Torvalds 		}
3252a7900875SSteven Rostedt 		start_pg = pg->next;
3253a7900875SSteven Rostedt 		kfree(pg);
3254a7900875SSteven Rostedt 		pg = start_pg;
3255da537f0aSSteven Rostedt (VMware) 		ftrace_number_of_groups--;
3256a7900875SSteven Rostedt 	}
3257a7900875SSteven Rostedt 	pr_info("ftrace: FAILED to allocate memory for functions\n");
3258a7900875SSteven Rostedt 	return NULL;
3259a7900875SSteven Rostedt }
3260a7900875SSteven Rostedt 
32615072c59fSSteven Rostedt #define FTRACE_BUFF_MAX (KSYM_SYMBOL_LEN+4) /* room for wildcards */
32625072c59fSSteven Rostedt 
32635072c59fSSteven Rostedt struct ftrace_iterator {
326498c4fd04SSteven Rostedt 	loff_t				pos;
32652bccfffdSSteven Rostedt 	loff_t				func_pos;
32665985ea8bSSteven Rostedt (VMware) 	loff_t				mod_pos;
32675072c59fSSteven Rostedt 	struct ftrace_page		*pg;
32684aeb6967SSteven Rostedt 	struct dyn_ftrace		*func;
32694aeb6967SSteven Rostedt 	struct ftrace_func_probe	*probe;
3270eee8ded1SSteven Rostedt (VMware) 	struct ftrace_func_entry	*probe_entry;
32714aeb6967SSteven Rostedt 	struct trace_parser		parser;
32721cf41dd7SSteven Rostedt 	struct ftrace_hash		*hash;
327333dc9b12SSteven Rostedt 	struct ftrace_ops		*ops;
32745985ea8bSSteven Rostedt (VMware) 	struct trace_array		*tr;
32755985ea8bSSteven Rostedt (VMware) 	struct list_head		*mod_list;
3276eee8ded1SSteven Rostedt (VMware) 	int				pidx;
3277431aa3fbSSteven Rostedt 	int				idx;
32785072c59fSSteven Rostedt 	unsigned			flags;
32795072c59fSSteven Rostedt };
32805072c59fSSteven Rostedt 
3281e309b41dSIngo Molnar static void *
3282eee8ded1SSteven Rostedt (VMware) t_probe_next(struct seq_file *m, loff_t *pos)
32838fc0c701SSteven Rostedt {
32848fc0c701SSteven Rostedt 	struct ftrace_iterator *iter = m->private;
3285d2afd57aSSteven Rostedt (VMware) 	struct trace_array *tr = iter->ops->private;
328604ec7bb6SSteven Rostedt (VMware) 	struct list_head *func_probes;
3287eee8ded1SSteven Rostedt (VMware) 	struct ftrace_hash *hash;
3288eee8ded1SSteven Rostedt (VMware) 	struct list_head *next;
32894aeb6967SSteven Rostedt 	struct hlist_node *hnd = NULL;
32908fc0c701SSteven Rostedt 	struct hlist_head *hhd;
3291eee8ded1SSteven Rostedt (VMware) 	int size;
32928fc0c701SSteven Rostedt 
32938fc0c701SSteven Rostedt 	(*pos)++;
329498c4fd04SSteven Rostedt 	iter->pos = *pos;
32958fc0c701SSteven Rostedt 
329604ec7bb6SSteven Rostedt (VMware) 	if (!tr)
32978fc0c701SSteven Rostedt 		return NULL;
32988fc0c701SSteven Rostedt 
329904ec7bb6SSteven Rostedt (VMware) 	func_probes = &tr->func_probes;
330004ec7bb6SSteven Rostedt (VMware) 	if (list_empty(func_probes))
33018fc0c701SSteven Rostedt 		return NULL;
33028fc0c701SSteven Rostedt 
3303eee8ded1SSteven Rostedt (VMware) 	if (!iter->probe) {
330404ec7bb6SSteven Rostedt (VMware) 		next = func_probes->next;
33057b60f3d8SSteven Rostedt (VMware) 		iter->probe = list_entry(next, struct ftrace_func_probe, list);
3306eee8ded1SSteven Rostedt (VMware) 	}
3307eee8ded1SSteven Rostedt (VMware) 
3308eee8ded1SSteven Rostedt (VMware) 	if (iter->probe_entry)
3309eee8ded1SSteven Rostedt (VMware) 		hnd = &iter->probe_entry->hlist;
3310eee8ded1SSteven Rostedt (VMware) 
3311eee8ded1SSteven Rostedt (VMware) 	hash = iter->probe->ops.func_hash->filter_hash;
33127bd46644SNaveen N. Rao 
3313372e0d01SSteven Rostedt (VMware) 	/*
3314372e0d01SSteven Rostedt (VMware) 	 * A probe being registered may temporarily have an empty hash
3315372e0d01SSteven Rostedt (VMware) 	 * and it's at the end of the func_probes list.
3316372e0d01SSteven Rostedt (VMware) 	 */
3317372e0d01SSteven Rostedt (VMware) 	if (!hash || hash == EMPTY_HASH)
33187bd46644SNaveen N. Rao 		return NULL;
33197bd46644SNaveen N. Rao 
3320eee8ded1SSteven Rostedt (VMware) 	size = 1 << hash->size_bits;
3321eee8ded1SSteven Rostedt (VMware) 
3322eee8ded1SSteven Rostedt (VMware)  retry:
3323eee8ded1SSteven Rostedt (VMware) 	if (iter->pidx >= size) {
332404ec7bb6SSteven Rostedt (VMware) 		if (iter->probe->list.next == func_probes)
3325eee8ded1SSteven Rostedt (VMware) 			return NULL;
3326eee8ded1SSteven Rostedt (VMware) 		next = iter->probe->list.next;
33277b60f3d8SSteven Rostedt (VMware) 		iter->probe = list_entry(next, struct ftrace_func_probe, list);
3328eee8ded1SSteven Rostedt (VMware) 		hash = iter->probe->ops.func_hash->filter_hash;
3329eee8ded1SSteven Rostedt (VMware) 		size = 1 << hash->size_bits;
3330eee8ded1SSteven Rostedt (VMware) 		iter->pidx = 0;
3331eee8ded1SSteven Rostedt (VMware) 	}
3332eee8ded1SSteven Rostedt (VMware) 
3333eee8ded1SSteven Rostedt (VMware) 	hhd = &hash->buckets[iter->pidx];
33348fc0c701SSteven Rostedt 
33358fc0c701SSteven Rostedt 	if (hlist_empty(hhd)) {
3336eee8ded1SSteven Rostedt (VMware) 		iter->pidx++;
33378fc0c701SSteven Rostedt 		hnd = NULL;
33388fc0c701SSteven Rostedt 		goto retry;
33398fc0c701SSteven Rostedt 	}
33408fc0c701SSteven Rostedt 
33418fc0c701SSteven Rostedt 	if (!hnd)
33428fc0c701SSteven Rostedt 		hnd = hhd->first;
33438fc0c701SSteven Rostedt 	else {
33448fc0c701SSteven Rostedt 		hnd = hnd->next;
33458fc0c701SSteven Rostedt 		if (!hnd) {
3346eee8ded1SSteven Rostedt (VMware) 			iter->pidx++;
33478fc0c701SSteven Rostedt 			goto retry;
33488fc0c701SSteven Rostedt 		}
33498fc0c701SSteven Rostedt 	}
33508fc0c701SSteven Rostedt 
33514aeb6967SSteven Rostedt 	if (WARN_ON_ONCE(!hnd))
33524aeb6967SSteven Rostedt 		return NULL;
33534aeb6967SSteven Rostedt 
3354eee8ded1SSteven Rostedt (VMware) 	iter->probe_entry = hlist_entry(hnd, struct ftrace_func_entry, hlist);
33554aeb6967SSteven Rostedt 
33564aeb6967SSteven Rostedt 	return iter;
33578fc0c701SSteven Rostedt }
33588fc0c701SSteven Rostedt 
3359eee8ded1SSteven Rostedt (VMware) static void *t_probe_start(struct seq_file *m, loff_t *pos)
33608fc0c701SSteven Rostedt {
33618fc0c701SSteven Rostedt 	struct ftrace_iterator *iter = m->private;
33628fc0c701SSteven Rostedt 	void *p = NULL;
3363d82d6244SLi Zefan 	loff_t l;
3364d82d6244SLi Zefan 
3365eee8ded1SSteven Rostedt (VMware) 	if (!(iter->flags & FTRACE_ITER_DO_PROBES))
336669a3083cSSteven Rostedt 		return NULL;
336769a3083cSSteven Rostedt 
33685985ea8bSSteven Rostedt (VMware) 	if (iter->mod_pos > *pos)
33692bccfffdSSteven Rostedt 		return NULL;
33708fc0c701SSteven Rostedt 
3371eee8ded1SSteven Rostedt (VMware) 	iter->probe = NULL;
3372eee8ded1SSteven Rostedt (VMware) 	iter->probe_entry = NULL;
3373eee8ded1SSteven Rostedt (VMware) 	iter->pidx = 0;
33745985ea8bSSteven Rostedt (VMware) 	for (l = 0; l <= (*pos - iter->mod_pos); ) {
3375eee8ded1SSteven Rostedt (VMware) 		p = t_probe_next(m, &l);
3376d82d6244SLi Zefan 		if (!p)
3377d82d6244SLi Zefan 			break;
3378d82d6244SLi Zefan 	}
33794aeb6967SSteven Rostedt 	if (!p)
33804aeb6967SSteven Rostedt 		return NULL;
33814aeb6967SSteven Rostedt 
338298c4fd04SSteven Rostedt 	/* Only set this if we have an item */
3383eee8ded1SSteven Rostedt (VMware) 	iter->flags |= FTRACE_ITER_PROBE;
338498c4fd04SSteven Rostedt 
33854aeb6967SSteven Rostedt 	return iter;
33868fc0c701SSteven Rostedt }
33878fc0c701SSteven Rostedt 
33884aeb6967SSteven Rostedt static int
3389eee8ded1SSteven Rostedt (VMware) t_probe_show(struct seq_file *m, struct ftrace_iterator *iter)
33908fc0c701SSteven Rostedt {
3391eee8ded1SSteven Rostedt (VMware) 	struct ftrace_func_entry *probe_entry;
33927b60f3d8SSteven Rostedt (VMware) 	struct ftrace_probe_ops *probe_ops;
33937b60f3d8SSteven Rostedt (VMware) 	struct ftrace_func_probe *probe;
33948fc0c701SSteven Rostedt 
3395eee8ded1SSteven Rostedt (VMware) 	probe = iter->probe;
3396eee8ded1SSteven Rostedt (VMware) 	probe_entry = iter->probe_entry;
3397eee8ded1SSteven Rostedt (VMware) 
3398eee8ded1SSteven Rostedt (VMware) 	if (WARN_ON_ONCE(!probe || !probe_entry))
33994aeb6967SSteven Rostedt 		return -EIO;
34008fc0c701SSteven Rostedt 
34017b60f3d8SSteven Rostedt (VMware) 	probe_ops = probe->probe_ops;
3402809dcf29SSteven Rostedt 
34037b60f3d8SSteven Rostedt (VMware) 	if (probe_ops->print)
34046e444319SSteven Rostedt (VMware) 		return probe_ops->print(m, probe_entry->ip, probe_ops, probe->data);
34058fc0c701SSteven Rostedt 
34067b60f3d8SSteven Rostedt (VMware) 	seq_printf(m, "%ps:%ps\n", (void *)probe_entry->ip,
34077b60f3d8SSteven Rostedt (VMware) 		   (void *)probe_ops->func);
34088fc0c701SSteven Rostedt 
34098fc0c701SSteven Rostedt 	return 0;
34108fc0c701SSteven Rostedt }
34118fc0c701SSteven Rostedt 
34128fc0c701SSteven Rostedt static void *
34135985ea8bSSteven Rostedt (VMware) t_mod_next(struct seq_file *m, loff_t *pos)
34145985ea8bSSteven Rostedt (VMware) {
34155985ea8bSSteven Rostedt (VMware) 	struct ftrace_iterator *iter = m->private;
34165985ea8bSSteven Rostedt (VMware) 	struct trace_array *tr = iter->tr;
34175985ea8bSSteven Rostedt (VMware) 
34185985ea8bSSteven Rostedt (VMware) 	(*pos)++;
34195985ea8bSSteven Rostedt (VMware) 	iter->pos = *pos;
34205985ea8bSSteven Rostedt (VMware) 
34215985ea8bSSteven Rostedt (VMware) 	iter->mod_list = iter->mod_list->next;
34225985ea8bSSteven Rostedt (VMware) 
34235985ea8bSSteven Rostedt (VMware) 	if (iter->mod_list == &tr->mod_trace ||
34245985ea8bSSteven Rostedt (VMware) 	    iter->mod_list == &tr->mod_notrace) {
34255985ea8bSSteven Rostedt (VMware) 		iter->flags &= ~FTRACE_ITER_MOD;
34265985ea8bSSteven Rostedt (VMware) 		return NULL;
34275985ea8bSSteven Rostedt (VMware) 	}
34285985ea8bSSteven Rostedt (VMware) 
34295985ea8bSSteven Rostedt (VMware) 	iter->mod_pos = *pos;
34305985ea8bSSteven Rostedt (VMware) 
34315985ea8bSSteven Rostedt (VMware) 	return iter;
34325985ea8bSSteven Rostedt (VMware) }
34335985ea8bSSteven Rostedt (VMware) 
34345985ea8bSSteven Rostedt (VMware) static void *t_mod_start(struct seq_file *m, loff_t *pos)
34355985ea8bSSteven Rostedt (VMware) {
34365985ea8bSSteven Rostedt (VMware) 	struct ftrace_iterator *iter = m->private;
34375985ea8bSSteven Rostedt (VMware) 	void *p = NULL;
34385985ea8bSSteven Rostedt (VMware) 	loff_t l;
34395985ea8bSSteven Rostedt (VMware) 
34405985ea8bSSteven Rostedt (VMware) 	if (iter->func_pos > *pos)
34415985ea8bSSteven Rostedt (VMware) 		return NULL;
34425985ea8bSSteven Rostedt (VMware) 
34435985ea8bSSteven Rostedt (VMware) 	iter->mod_pos = iter->func_pos;
34445985ea8bSSteven Rostedt (VMware) 
34455985ea8bSSteven Rostedt (VMware) 	/* probes are only available if tr is set */
34465985ea8bSSteven Rostedt (VMware) 	if (!iter->tr)
34475985ea8bSSteven Rostedt (VMware) 		return NULL;
34485985ea8bSSteven Rostedt (VMware) 
34495985ea8bSSteven Rostedt (VMware) 	for (l = 0; l <= (*pos - iter->func_pos); ) {
34505985ea8bSSteven Rostedt (VMware) 		p = t_mod_next(m, &l);
34515985ea8bSSteven Rostedt (VMware) 		if (!p)
34525985ea8bSSteven Rostedt (VMware) 			break;
34535985ea8bSSteven Rostedt (VMware) 	}
34545985ea8bSSteven Rostedt (VMware) 	if (!p) {
34555985ea8bSSteven Rostedt (VMware) 		iter->flags &= ~FTRACE_ITER_MOD;
34565985ea8bSSteven Rostedt (VMware) 		return t_probe_start(m, pos);
34575985ea8bSSteven Rostedt (VMware) 	}
34585985ea8bSSteven Rostedt (VMware) 
34595985ea8bSSteven Rostedt (VMware) 	/* Only set this if we have an item */
34605985ea8bSSteven Rostedt (VMware) 	iter->flags |= FTRACE_ITER_MOD;
34615985ea8bSSteven Rostedt (VMware) 
34625985ea8bSSteven Rostedt (VMware) 	return iter;
34635985ea8bSSteven Rostedt (VMware) }
34645985ea8bSSteven Rostedt (VMware) 
34655985ea8bSSteven Rostedt (VMware) static int
34665985ea8bSSteven Rostedt (VMware) t_mod_show(struct seq_file *m, struct ftrace_iterator *iter)
34675985ea8bSSteven Rostedt (VMware) {
34685985ea8bSSteven Rostedt (VMware) 	struct ftrace_mod_load *ftrace_mod;
34695985ea8bSSteven Rostedt (VMware) 	struct trace_array *tr = iter->tr;
34705985ea8bSSteven Rostedt (VMware) 
34715985ea8bSSteven Rostedt (VMware) 	if (WARN_ON_ONCE(!iter->mod_list) ||
34725985ea8bSSteven Rostedt (VMware) 			 iter->mod_list == &tr->mod_trace ||
34735985ea8bSSteven Rostedt (VMware) 			 iter->mod_list == &tr->mod_notrace)
34745985ea8bSSteven Rostedt (VMware) 		return -EIO;
34755985ea8bSSteven Rostedt (VMware) 
34765985ea8bSSteven Rostedt (VMware) 	ftrace_mod = list_entry(iter->mod_list, struct ftrace_mod_load, list);
34775985ea8bSSteven Rostedt (VMware) 
34785985ea8bSSteven Rostedt (VMware) 	if (ftrace_mod->func)
34795985ea8bSSteven Rostedt (VMware) 		seq_printf(m, "%s", ftrace_mod->func);
34805985ea8bSSteven Rostedt (VMware) 	else
34815985ea8bSSteven Rostedt (VMware) 		seq_putc(m, '*');
34825985ea8bSSteven Rostedt (VMware) 
34835985ea8bSSteven Rostedt (VMware) 	seq_printf(m, ":mod:%s\n", ftrace_mod->module);
34845985ea8bSSteven Rostedt (VMware) 
34855985ea8bSSteven Rostedt (VMware) 	return 0;
34865985ea8bSSteven Rostedt (VMware) }
34875985ea8bSSteven Rostedt (VMware) 
34885985ea8bSSteven Rostedt (VMware) static void *
34895bd84629SSteven Rostedt (VMware) t_func_next(struct seq_file *m, loff_t *pos)
34905072c59fSSteven Rostedt {
34915072c59fSSteven Rostedt 	struct ftrace_iterator *iter = m->private;
34925072c59fSSteven Rostedt 	struct dyn_ftrace *rec = NULL;
34935072c59fSSteven Rostedt 
34945072c59fSSteven Rostedt 	(*pos)++;
34950c75a3edSSteven Rostedt 
34965072c59fSSteven Rostedt  retry:
34975072c59fSSteven Rostedt 	if (iter->idx >= iter->pg->index) {
34985072c59fSSteven Rostedt 		if (iter->pg->next) {
34995072c59fSSteven Rostedt 			iter->pg = iter->pg->next;
35005072c59fSSteven Rostedt 			iter->idx = 0;
35015072c59fSSteven Rostedt 			goto retry;
35025072c59fSSteven Rostedt 		}
35035072c59fSSteven Rostedt 	} else {
35045072c59fSSteven Rostedt 		rec = &iter->pg->records[iter->idx++];
3505c20489daSSteven Rostedt (VMware) 		if (((iter->flags & (FTRACE_ITER_FILTER | FTRACE_ITER_NOTRACE)) &&
3506c20489daSSteven Rostedt (VMware) 		     !ftrace_lookup_ip(iter->hash, rec->ip)) ||
3507647bcd03SSteven Rostedt 
3508647bcd03SSteven Rostedt 		    ((iter->flags & FTRACE_ITER_ENABLED) &&
350923ea9c4dSSteven Rostedt (Red Hat) 		     !(rec->flags & FTRACE_FL_ENABLED))) {
3510647bcd03SSteven Rostedt 
35115072c59fSSteven Rostedt 			rec = NULL;
35125072c59fSSteven Rostedt 			goto retry;
35135072c59fSSteven Rostedt 		}
35145072c59fSSteven Rostedt 	}
35155072c59fSSteven Rostedt 
35164aeb6967SSteven Rostedt 	if (!rec)
35175bd84629SSteven Rostedt (VMware) 		return NULL;
35184aeb6967SSteven Rostedt 
35195bd84629SSteven Rostedt (VMware) 	iter->pos = iter->func_pos = *pos;
35204aeb6967SSteven Rostedt 	iter->func = rec;
35214aeb6967SSteven Rostedt 
35224aeb6967SSteven Rostedt 	return iter;
35235072c59fSSteven Rostedt }
35245072c59fSSteven Rostedt 
35255bd84629SSteven Rostedt (VMware) static void *
35265bd84629SSteven Rostedt (VMware) t_next(struct seq_file *m, void *v, loff_t *pos)
35275bd84629SSteven Rostedt (VMware) {
35285bd84629SSteven Rostedt (VMware) 	struct ftrace_iterator *iter = m->private;
35295985ea8bSSteven Rostedt (VMware) 	loff_t l = *pos; /* t_probe_start() must use original pos */
35305bd84629SSteven Rostedt (VMware) 	void *ret;
35315bd84629SSteven Rostedt (VMware) 
35325bd84629SSteven Rostedt (VMware) 	if (unlikely(ftrace_disabled))
35335bd84629SSteven Rostedt (VMware) 		return NULL;
35345bd84629SSteven Rostedt (VMware) 
3535eee8ded1SSteven Rostedt (VMware) 	if (iter->flags & FTRACE_ITER_PROBE)
3536eee8ded1SSteven Rostedt (VMware) 		return t_probe_next(m, pos);
35375bd84629SSteven Rostedt (VMware) 
35385985ea8bSSteven Rostedt (VMware) 	if (iter->flags & FTRACE_ITER_MOD)
35395985ea8bSSteven Rostedt (VMware) 		return t_mod_next(m, pos);
35405985ea8bSSteven Rostedt (VMware) 
35415bd84629SSteven Rostedt (VMware) 	if (iter->flags & FTRACE_ITER_PRINTALL) {
3542eee8ded1SSteven Rostedt (VMware) 		/* next must increment pos, and t_probe_start does not */
35435bd84629SSteven Rostedt (VMware) 		(*pos)++;
35445985ea8bSSteven Rostedt (VMware) 		return t_mod_start(m, &l);
35455bd84629SSteven Rostedt (VMware) 	}
35465bd84629SSteven Rostedt (VMware) 
35475bd84629SSteven Rostedt (VMware) 	ret = t_func_next(m, pos);
35485bd84629SSteven Rostedt (VMware) 
35495bd84629SSteven Rostedt (VMware) 	if (!ret)
35505985ea8bSSteven Rostedt (VMware) 		return t_mod_start(m, &l);
35515bd84629SSteven Rostedt (VMware) 
35525bd84629SSteven Rostedt (VMware) 	return ret;
35535bd84629SSteven Rostedt (VMware) }
35545bd84629SSteven Rostedt (VMware) 
355598c4fd04SSteven Rostedt static void reset_iter_read(struct ftrace_iterator *iter)
355698c4fd04SSteven Rostedt {
355798c4fd04SSteven Rostedt 	iter->pos = 0;
355898c4fd04SSteven Rostedt 	iter->func_pos = 0;
35595985ea8bSSteven Rostedt (VMware) 	iter->flags &= ~(FTRACE_ITER_PRINTALL | FTRACE_ITER_PROBE | FTRACE_ITER_MOD);
35605072c59fSSteven Rostedt }
35615072c59fSSteven Rostedt 
35625072c59fSSteven Rostedt static void *t_start(struct seq_file *m, loff_t *pos)
35635072c59fSSteven Rostedt {
35645072c59fSSteven Rostedt 	struct ftrace_iterator *iter = m->private;
35655072c59fSSteven Rostedt 	void *p = NULL;
3566694ce0a5SLi Zefan 	loff_t l;
35675072c59fSSteven Rostedt 
35688fc0c701SSteven Rostedt 	mutex_lock(&ftrace_lock);
356945a4a237SSteven Rostedt 
357045a4a237SSteven Rostedt 	if (unlikely(ftrace_disabled))
357145a4a237SSteven Rostedt 		return NULL;
357245a4a237SSteven Rostedt 
35730c75a3edSSteven Rostedt 	/*
357498c4fd04SSteven Rostedt 	 * If an lseek was done, then reset and start from beginning.
357598c4fd04SSteven Rostedt 	 */
357698c4fd04SSteven Rostedt 	if (*pos < iter->pos)
357798c4fd04SSteven Rostedt 		reset_iter_read(iter);
357898c4fd04SSteven Rostedt 
357998c4fd04SSteven Rostedt 	/*
35800c75a3edSSteven Rostedt 	 * For set_ftrace_filter reading, if we have the filter
35810c75a3edSSteven Rostedt 	 * off, we can short cut and just print out that all
35820c75a3edSSteven Rostedt 	 * functions are enabled.
35830c75a3edSSteven Rostedt 	 */
3584c20489daSSteven Rostedt (VMware) 	if ((iter->flags & (FTRACE_ITER_FILTER | FTRACE_ITER_NOTRACE)) &&
3585c20489daSSteven Rostedt (VMware) 	    ftrace_hash_empty(iter->hash)) {
358643ff926aSSteven Rostedt (VMware) 		iter->func_pos = 1; /* Account for the message */
35870c75a3edSSteven Rostedt 		if (*pos > 0)
35885985ea8bSSteven Rostedt (VMware) 			return t_mod_start(m, pos);
35890c75a3edSSteven Rostedt 		iter->flags |= FTRACE_ITER_PRINTALL;
3590df091625SChris Wright 		/* reset in case of seek/pread */
3591eee8ded1SSteven Rostedt (VMware) 		iter->flags &= ~FTRACE_ITER_PROBE;
35920c75a3edSSteven Rostedt 		return iter;
35930c75a3edSSteven Rostedt 	}
35940c75a3edSSteven Rostedt 
35955985ea8bSSteven Rostedt (VMware) 	if (iter->flags & FTRACE_ITER_MOD)
35965985ea8bSSteven Rostedt (VMware) 		return t_mod_start(m, pos);
35978fc0c701SSteven Rostedt 
359898c4fd04SSteven Rostedt 	/*
359998c4fd04SSteven Rostedt 	 * Unfortunately, we need to restart at ftrace_pages_start
360098c4fd04SSteven Rostedt 	 * every time we let go of the ftrace_mutex. This is because
360198c4fd04SSteven Rostedt 	 * those pointers can change without the lock.
360298c4fd04SSteven Rostedt 	 */
3603694ce0a5SLi Zefan 	iter->pg = ftrace_pages_start;
3604694ce0a5SLi Zefan 	iter->idx = 0;
3605694ce0a5SLi Zefan 	for (l = 0; l <= *pos; ) {
36065bd84629SSteven Rostedt (VMware) 		p = t_func_next(m, &l);
3607694ce0a5SLi Zefan 		if (!p)
3608694ce0a5SLi Zefan 			break;
360950cdaf08SLiming Wang 	}
36105821e1b7Swalimis 
361169a3083cSSteven Rostedt 	if (!p)
36125985ea8bSSteven Rostedt (VMware) 		return t_mod_start(m, pos);
36138fc0c701SSteven Rostedt 
36144aeb6967SSteven Rostedt 	return iter;
36155072c59fSSteven Rostedt }
36165072c59fSSteven Rostedt 
36175072c59fSSteven Rostedt static void t_stop(struct seq_file *m, void *p)
36185072c59fSSteven Rostedt {
36198fc0c701SSteven Rostedt 	mutex_unlock(&ftrace_lock);
36205072c59fSSteven Rostedt }
36215072c59fSSteven Rostedt 
362215d5b02cSSteven Rostedt (Red Hat) void * __weak
362315d5b02cSSteven Rostedt (Red Hat) arch_ftrace_trampoline_func(struct ftrace_ops *ops, struct dyn_ftrace *rec)
362415d5b02cSSteven Rostedt (Red Hat) {
362515d5b02cSSteven Rostedt (Red Hat) 	return NULL;
362615d5b02cSSteven Rostedt (Red Hat) }
362715d5b02cSSteven Rostedt (Red Hat) 
362815d5b02cSSteven Rostedt (Red Hat) static void add_trampoline_func(struct seq_file *m, struct ftrace_ops *ops,
362915d5b02cSSteven Rostedt (Red Hat) 				struct dyn_ftrace *rec)
363015d5b02cSSteven Rostedt (Red Hat) {
363115d5b02cSSteven Rostedt (Red Hat) 	void *ptr;
363215d5b02cSSteven Rostedt (Red Hat) 
363315d5b02cSSteven Rostedt (Red Hat) 	ptr = arch_ftrace_trampoline_func(ops, rec);
363415d5b02cSSteven Rostedt (Red Hat) 	if (ptr)
363515d5b02cSSteven Rostedt (Red Hat) 		seq_printf(m, " ->%pS", ptr);
363615d5b02cSSteven Rostedt (Red Hat) }
363715d5b02cSSteven Rostedt (Red Hat) 
3638b39181f7SSteven Rostedt (Google) #ifdef FTRACE_MCOUNT_MAX_OFFSET
3639b39181f7SSteven Rostedt (Google) /*
3640b39181f7SSteven Rostedt (Google)  * Weak functions can still have an mcount/fentry that is saved in
3641b39181f7SSteven Rostedt (Google)  * the __mcount_loc section. These can be detected by having a
3642b39181f7SSteven Rostedt (Google)  * symbol offset of greater than FTRACE_MCOUNT_MAX_OFFSET, as the
3643b39181f7SSteven Rostedt (Google)  * symbol found by kallsyms is not the function that the mcount/fentry
3644b39181f7SSteven Rostedt (Google)  * is part of. The offset is much greater in these cases.
3645b39181f7SSteven Rostedt (Google)  *
3646b39181f7SSteven Rostedt (Google)  * Test the record to make sure that the ip points to a valid kallsyms
3647b39181f7SSteven Rostedt (Google)  * and if not, mark it disabled.
3648b39181f7SSteven Rostedt (Google)  */
3649b39181f7SSteven Rostedt (Google) static int test_for_valid_rec(struct dyn_ftrace *rec)
3650b39181f7SSteven Rostedt (Google) {
3651b39181f7SSteven Rostedt (Google) 	char str[KSYM_SYMBOL_LEN];
3652b39181f7SSteven Rostedt (Google) 	unsigned long offset;
3653b39181f7SSteven Rostedt (Google) 	const char *ret;
3654b39181f7SSteven Rostedt (Google) 
3655b39181f7SSteven Rostedt (Google) 	ret = kallsyms_lookup(rec->ip, NULL, &offset, NULL, str);
3656b39181f7SSteven Rostedt (Google) 
3657b39181f7SSteven Rostedt (Google) 	/* Weak functions can cause invalid addresses */
3658b39181f7SSteven Rostedt (Google) 	if (!ret || offset > FTRACE_MCOUNT_MAX_OFFSET) {
3659b39181f7SSteven Rostedt (Google) 		rec->flags |= FTRACE_FL_DISABLED;
3660b39181f7SSteven Rostedt (Google) 		return 0;
3661b39181f7SSteven Rostedt (Google) 	}
3662b39181f7SSteven Rostedt (Google) 	return 1;
3663b39181f7SSteven Rostedt (Google) }
3664b39181f7SSteven Rostedt (Google) 
3665b39181f7SSteven Rostedt (Google) static struct workqueue_struct *ftrace_check_wq __initdata;
3666b39181f7SSteven Rostedt (Google) static struct work_struct ftrace_check_work __initdata;
3667b39181f7SSteven Rostedt (Google) 
3668b39181f7SSteven Rostedt (Google) /*
3669b39181f7SSteven Rostedt (Google)  * Scan all the mcount/fentry entries to make sure they are valid.
3670b39181f7SSteven Rostedt (Google)  */
3671b39181f7SSteven Rostedt (Google) static __init void ftrace_check_work_func(struct work_struct *work)
3672b39181f7SSteven Rostedt (Google) {
3673b39181f7SSteven Rostedt (Google) 	struct ftrace_page *pg;
3674b39181f7SSteven Rostedt (Google) 	struct dyn_ftrace *rec;
3675b39181f7SSteven Rostedt (Google) 
3676b39181f7SSteven Rostedt (Google) 	mutex_lock(&ftrace_lock);
3677b39181f7SSteven Rostedt (Google) 	do_for_each_ftrace_rec(pg, rec) {
3678b39181f7SSteven Rostedt (Google) 		test_for_valid_rec(rec);
3679b39181f7SSteven Rostedt (Google) 	} while_for_each_ftrace_rec();
3680b39181f7SSteven Rostedt (Google) 	mutex_unlock(&ftrace_lock);
3681b39181f7SSteven Rostedt (Google) }
3682b39181f7SSteven Rostedt (Google) 
3683b39181f7SSteven Rostedt (Google) static int __init ftrace_check_for_weak_functions(void)
3684b39181f7SSteven Rostedt (Google) {
3685b39181f7SSteven Rostedt (Google) 	INIT_WORK(&ftrace_check_work, ftrace_check_work_func);
3686b39181f7SSteven Rostedt (Google) 
3687b39181f7SSteven Rostedt (Google) 	ftrace_check_wq = alloc_workqueue("ftrace_check_wq", WQ_UNBOUND, 0);
3688b39181f7SSteven Rostedt (Google) 
3689b39181f7SSteven Rostedt (Google) 	queue_work(ftrace_check_wq, &ftrace_check_work);
3690b39181f7SSteven Rostedt (Google) 	return 0;
3691b39181f7SSteven Rostedt (Google) }
3692b39181f7SSteven Rostedt (Google) 
3693b39181f7SSteven Rostedt (Google) static int __init ftrace_check_sync(void)
3694b39181f7SSteven Rostedt (Google) {
3695b39181f7SSteven Rostedt (Google) 	/* Make sure the ftrace_check updates are finished */
3696b39181f7SSteven Rostedt (Google) 	if (ftrace_check_wq)
3697b39181f7SSteven Rostedt (Google) 		destroy_workqueue(ftrace_check_wq);
3698b39181f7SSteven Rostedt (Google) 	return 0;
3699b39181f7SSteven Rostedt (Google) }
3700b39181f7SSteven Rostedt (Google) 
3701b39181f7SSteven Rostedt (Google) late_initcall_sync(ftrace_check_sync);
3702b39181f7SSteven Rostedt (Google) subsys_initcall(ftrace_check_for_weak_functions);
3703b39181f7SSteven Rostedt (Google) 
3704b39181f7SSteven Rostedt (Google) static int print_rec(struct seq_file *m, unsigned long ip)
3705b39181f7SSteven Rostedt (Google) {
3706b39181f7SSteven Rostedt (Google) 	unsigned long offset;
3707b39181f7SSteven Rostedt (Google) 	char str[KSYM_SYMBOL_LEN];
3708b39181f7SSteven Rostedt (Google) 	char *modname;
3709b39181f7SSteven Rostedt (Google) 	const char *ret;
3710b39181f7SSteven Rostedt (Google) 
3711b39181f7SSteven Rostedt (Google) 	ret = kallsyms_lookup(ip, NULL, &offset, &modname, str);
3712b39181f7SSteven Rostedt (Google) 	/* Weak functions can cause invalid addresses */
3713b39181f7SSteven Rostedt (Google) 	if (!ret || offset > FTRACE_MCOUNT_MAX_OFFSET) {
3714b39181f7SSteven Rostedt (Google) 		snprintf(str, KSYM_SYMBOL_LEN, "%s_%ld",
3715b39181f7SSteven Rostedt (Google) 			 FTRACE_INVALID_FUNCTION, offset);
3716b39181f7SSteven Rostedt (Google) 		ret = NULL;
3717b39181f7SSteven Rostedt (Google) 	}
3718b39181f7SSteven Rostedt (Google) 
3719b39181f7SSteven Rostedt (Google) 	seq_puts(m, str);
3720b39181f7SSteven Rostedt (Google) 	if (modname)
3721b39181f7SSteven Rostedt (Google) 		seq_printf(m, " [%s]", modname);
3722b39181f7SSteven Rostedt (Google) 	return ret == NULL ? -1 : 0;
3723b39181f7SSteven Rostedt (Google) }
3724b39181f7SSteven Rostedt (Google) #else
3725b39181f7SSteven Rostedt (Google) static inline int test_for_valid_rec(struct dyn_ftrace *rec)
3726b39181f7SSteven Rostedt (Google) {
3727b39181f7SSteven Rostedt (Google) 	return 1;
3728b39181f7SSteven Rostedt (Google) }
3729b39181f7SSteven Rostedt (Google) 
3730b39181f7SSteven Rostedt (Google) static inline int print_rec(struct seq_file *m, unsigned long ip)
3731b39181f7SSteven Rostedt (Google) {
3732b39181f7SSteven Rostedt (Google) 	seq_printf(m, "%ps", (void *)ip);
3733b39181f7SSteven Rostedt (Google) 	return 0;
3734b39181f7SSteven Rostedt (Google) }
3735b39181f7SSteven Rostedt (Google) #endif
3736b39181f7SSteven Rostedt (Google) 
37375072c59fSSteven Rostedt static int t_show(struct seq_file *m, void *v)
37385072c59fSSteven Rostedt {
37390c75a3edSSteven Rostedt 	struct ftrace_iterator *iter = m->private;
37404aeb6967SSteven Rostedt 	struct dyn_ftrace *rec;
37415072c59fSSteven Rostedt 
3742eee8ded1SSteven Rostedt (VMware) 	if (iter->flags & FTRACE_ITER_PROBE)
3743eee8ded1SSteven Rostedt (VMware) 		return t_probe_show(m, iter);
37448fc0c701SSteven Rostedt 
37455985ea8bSSteven Rostedt (VMware) 	if (iter->flags & FTRACE_ITER_MOD)
37465985ea8bSSteven Rostedt (VMware) 		return t_mod_show(m, iter);
37475985ea8bSSteven Rostedt (VMware) 
37480c75a3edSSteven Rostedt 	if (iter->flags & FTRACE_ITER_PRINTALL) {
37498c006cf7SNamhyung Kim 		if (iter->flags & FTRACE_ITER_NOTRACE)
3750fa6f0cc7SRasmus Villemoes 			seq_puts(m, "#### no functions disabled ####\n");
37518c006cf7SNamhyung Kim 		else
3752fa6f0cc7SRasmus Villemoes 			seq_puts(m, "#### all functions enabled ####\n");
37530c75a3edSSteven Rostedt 		return 0;
37540c75a3edSSteven Rostedt 	}
37550c75a3edSSteven Rostedt 
37564aeb6967SSteven Rostedt 	rec = iter->func;
37574aeb6967SSteven Rostedt 
37585072c59fSSteven Rostedt 	if (!rec)
37595072c59fSSteven Rostedt 		return 0;
37605072c59fSSteven Rostedt 
3761b39181f7SSteven Rostedt (Google) 	if (print_rec(m, rec->ip)) {
3762b39181f7SSteven Rostedt (Google) 		/* This should only happen when a rec is disabled */
3763b39181f7SSteven Rostedt (Google) 		WARN_ON_ONCE(!(rec->flags & FTRACE_FL_DISABLED));
3764b39181f7SSteven Rostedt (Google) 		seq_putc(m, '\n');
3765b39181f7SSteven Rostedt (Google) 		return 0;
3766b39181f7SSteven Rostedt (Google) 	}
3767b39181f7SSteven Rostedt (Google) 
37689674b2faSSteven Rostedt (Red Hat) 	if (iter->flags & FTRACE_ITER_ENABLED) {
3769030f4e1cSSteven Rostedt (Red Hat) 		struct ftrace_ops *ops;
377015d5b02cSSteven Rostedt (Red Hat) 
3771763e34e7SSteven Rostedt (VMware) 		seq_printf(m, " (%ld)%s%s%s",
37720376bde1SSteven Rostedt (Red Hat) 			   ftrace_rec_count(rec),
3773f8b8be8aSMasami Hiramatsu 			   rec->flags & FTRACE_FL_REGS ? " R" : "  ",
3774763e34e7SSteven Rostedt (VMware) 			   rec->flags & FTRACE_FL_IPMODIFY ? " I" : "  ",
3775763e34e7SSteven Rostedt (VMware) 			   rec->flags & FTRACE_FL_DIRECT ? " D" : "  ");
37769674b2faSSteven Rostedt (Red Hat) 		if (rec->flags & FTRACE_FL_TRAMP_EN) {
37775fecaa04SSteven Rostedt (Red Hat) 			ops = ftrace_find_tramp_ops_any(rec);
377839daa7b9SSteven Rostedt (Red Hat) 			if (ops) {
377939daa7b9SSteven Rostedt (Red Hat) 				do {
378039daa7b9SSteven Rostedt (Red Hat) 					seq_printf(m, "\ttramp: %pS (%pS)",
378139daa7b9SSteven Rostedt (Red Hat) 						   (void *)ops->trampoline,
378239daa7b9SSteven Rostedt (Red Hat) 						   (void *)ops->func);
3783030f4e1cSSteven Rostedt (Red Hat) 					add_trampoline_func(m, ops, rec);
378439daa7b9SSteven Rostedt (Red Hat) 					ops = ftrace_find_tramp_ops_next(rec, ops);
378539daa7b9SSteven Rostedt (Red Hat) 				} while (ops);
378639daa7b9SSteven Rostedt (Red Hat) 			} else
3787fa6f0cc7SRasmus Villemoes 				seq_puts(m, "\ttramp: ERROR!");
3788030f4e1cSSteven Rostedt (Red Hat) 		} else {
3789030f4e1cSSteven Rostedt (Red Hat) 			add_trampoline_func(m, NULL, rec);
37909674b2faSSteven Rostedt (Red Hat) 		}
3791763e34e7SSteven Rostedt (VMware) 		if (rec->flags & FTRACE_FL_DIRECT) {
3792763e34e7SSteven Rostedt (VMware) 			unsigned long direct;
3793763e34e7SSteven Rostedt (VMware) 
3794ff205766SAlexei Starovoitov 			direct = ftrace_find_rec_direct(rec->ip);
3795763e34e7SSteven Rostedt (VMware) 			if (direct)
3796763e34e7SSteven Rostedt (VMware) 				seq_printf(m, "\n\tdirect-->%pS", (void *)direct);
3797763e34e7SSteven Rostedt (VMware) 		}
37989674b2faSSteven Rostedt (Red Hat) 	}
37999674b2faSSteven Rostedt (Red Hat) 
3800fa6f0cc7SRasmus Villemoes 	seq_putc(m, '\n');
38015072c59fSSteven Rostedt 
38025072c59fSSteven Rostedt 	return 0;
38035072c59fSSteven Rostedt }
38045072c59fSSteven Rostedt 
380588e9d34cSJames Morris static const struct seq_operations show_ftrace_seq_ops = {
38065072c59fSSteven Rostedt 	.start = t_start,
38075072c59fSSteven Rostedt 	.next = t_next,
38085072c59fSSteven Rostedt 	.stop = t_stop,
38095072c59fSSteven Rostedt 	.show = t_show,
38105072c59fSSteven Rostedt };
38115072c59fSSteven Rostedt 
3812e309b41dSIngo Molnar static int
38135072c59fSSteven Rostedt ftrace_avail_open(struct inode *inode, struct file *file)
38145072c59fSSteven Rostedt {
38155072c59fSSteven Rostedt 	struct ftrace_iterator *iter;
381617911ff3SSteven Rostedt (VMware) 	int ret;
381717911ff3SSteven Rostedt (VMware) 
381817911ff3SSteven Rostedt (VMware) 	ret = security_locked_down(LOCKDOWN_TRACEFS);
381917911ff3SSteven Rostedt (VMware) 	if (ret)
382017911ff3SSteven Rostedt (VMware) 		return ret;
38215072c59fSSteven Rostedt 
38224eebcc81SSteven Rostedt 	if (unlikely(ftrace_disabled))
38234eebcc81SSteven Rostedt 		return -ENODEV;
38244eebcc81SSteven Rostedt 
382550e18b94SJiri Olsa 	iter = __seq_open_private(file, &show_ftrace_seq_ops, sizeof(*iter));
3826c1bc5919SSteven Rostedt (VMware) 	if (!iter)
3827c1bc5919SSteven Rostedt (VMware) 		return -ENOMEM;
3828c1bc5919SSteven Rostedt (VMware) 
38295072c59fSSteven Rostedt 	iter->pg = ftrace_pages_start;
3830fc13cb0cSSteven Rostedt 	iter->ops = &global_ops;
38315072c59fSSteven Rostedt 
3832c1bc5919SSteven Rostedt (VMware) 	return 0;
38335072c59fSSteven Rostedt }
38345072c59fSSteven Rostedt 
3835647bcd03SSteven Rostedt static int
3836647bcd03SSteven Rostedt ftrace_enabled_open(struct inode *inode, struct file *file)
3837647bcd03SSteven Rostedt {
3838647bcd03SSteven Rostedt 	struct ftrace_iterator *iter;
3839647bcd03SSteven Rostedt 
384017911ff3SSteven Rostedt (VMware) 	/*
384117911ff3SSteven Rostedt (VMware) 	 * This shows us what functions are currently being
384217911ff3SSteven Rostedt (VMware) 	 * traced and by what. Not sure if we want lockdown
384317911ff3SSteven Rostedt (VMware) 	 * to hide such critical information for an admin.
384417911ff3SSteven Rostedt (VMware) 	 * Although, perhaps it can show information we don't
384517911ff3SSteven Rostedt (VMware) 	 * want people to see, but if something is tracing
384617911ff3SSteven Rostedt (VMware) 	 * something, we probably want to know about it.
384717911ff3SSteven Rostedt (VMware) 	 */
384817911ff3SSteven Rostedt (VMware) 
384950e18b94SJiri Olsa 	iter = __seq_open_private(file, &show_ftrace_seq_ops, sizeof(*iter));
3850c1bc5919SSteven Rostedt (VMware) 	if (!iter)
3851c1bc5919SSteven Rostedt (VMware) 		return -ENOMEM;
3852c1bc5919SSteven Rostedt (VMware) 
3853647bcd03SSteven Rostedt 	iter->pg = ftrace_pages_start;
3854647bcd03SSteven Rostedt 	iter->flags = FTRACE_ITER_ENABLED;
3855fc13cb0cSSteven Rostedt 	iter->ops = &global_ops;
3856647bcd03SSteven Rostedt 
3857c1bc5919SSteven Rostedt (VMware) 	return 0;
3858647bcd03SSteven Rostedt }
3859647bcd03SSteven Rostedt 
3860fc13cb0cSSteven Rostedt /**
3861fc13cb0cSSteven Rostedt  * ftrace_regex_open - initialize function tracer filter files
3862fc13cb0cSSteven Rostedt  * @ops: The ftrace_ops that hold the hash filters
3863fc13cb0cSSteven Rostedt  * @flag: The type of filter to process
3864fc13cb0cSSteven Rostedt  * @inode: The inode, usually passed in to your open routine
3865fc13cb0cSSteven Rostedt  * @file: The file, usually passed in to your open routine
3866fc13cb0cSSteven Rostedt  *
3867fc13cb0cSSteven Rostedt  * ftrace_regex_open() initializes the filter files for the
3868fc13cb0cSSteven Rostedt  * @ops. Depending on @flag it may process the filter hash or
3869fc13cb0cSSteven Rostedt  * the notrace hash of @ops. With this called from the open
3870fc13cb0cSSteven Rostedt  * routine, you can use ftrace_filter_write() for the write
3871fc13cb0cSSteven Rostedt  * routine if @flag has FTRACE_ITER_FILTER set, or
3872fc13cb0cSSteven Rostedt  * ftrace_notrace_write() if @flag has FTRACE_ITER_NOTRACE set.
3873098c879eSSteven Rostedt (Red Hat)  * tracing_lseek() should be used as the lseek routine, and
3874fc13cb0cSSteven Rostedt  * release must call ftrace_regex_release().
3875fc13cb0cSSteven Rostedt  */
3876fc13cb0cSSteven Rostedt int
3877f45948e8SSteven Rostedt ftrace_regex_open(struct ftrace_ops *ops, int flag,
38781cf41dd7SSteven Rostedt 		  struct inode *inode, struct file *file)
38795072c59fSSteven Rostedt {
38805072c59fSSteven Rostedt 	struct ftrace_iterator *iter;
3881f45948e8SSteven Rostedt 	struct ftrace_hash *hash;
3882673feb9dSSteven Rostedt (VMware) 	struct list_head *mod_head;
3883673feb9dSSteven Rostedt (VMware) 	struct trace_array *tr = ops->private;
38849ef16693SSteven Rostedt (VMware) 	int ret = -ENOMEM;
38855072c59fSSteven Rostedt 
3886f04f24fbSMasami Hiramatsu 	ftrace_ops_init(ops);
3887f04f24fbSMasami Hiramatsu 
38884eebcc81SSteven Rostedt 	if (unlikely(ftrace_disabled))
38894eebcc81SSteven Rostedt 		return -ENODEV;
38904eebcc81SSteven Rostedt 
38918530dec6SSteven Rostedt (VMware) 	if (tracing_check_open_get_tr(tr))
38929ef16693SSteven Rostedt (VMware) 		return -ENODEV;
38939ef16693SSteven Rostedt (VMware) 
38945072c59fSSteven Rostedt 	iter = kzalloc(sizeof(*iter), GFP_KERNEL);
38955072c59fSSteven Rostedt 	if (!iter)
38969ef16693SSteven Rostedt (VMware) 		goto out;
38975072c59fSSteven Rostedt 
38989ef16693SSteven Rostedt (VMware) 	if (trace_parser_get_init(&iter->parser, FTRACE_BUFF_MAX))
38999ef16693SSteven Rostedt (VMware) 		goto out;
3900689fd8b6S[email protected] 
39013f2367baSMasami Hiramatsu 	iter->ops = ops;
39023f2367baSMasami Hiramatsu 	iter->flags = flag;
39035985ea8bSSteven Rostedt (VMware) 	iter->tr = tr;
39043f2367baSMasami Hiramatsu 
390533b7f99cSSteven Rostedt (Red Hat) 	mutex_lock(&ops->func_hash->regex_lock);
39063f2367baSMasami Hiramatsu 
3907673feb9dSSteven Rostedt (VMware) 	if (flag & FTRACE_ITER_NOTRACE) {
390833b7f99cSSteven Rostedt (Red Hat) 		hash = ops->func_hash->notrace_hash;
39095985ea8bSSteven Rostedt (VMware) 		mod_head = tr ? &tr->mod_notrace : NULL;
3910673feb9dSSteven Rostedt (VMware) 	} else {
391133b7f99cSSteven Rostedt (Red Hat) 		hash = ops->func_hash->filter_hash;
39125985ea8bSSteven Rostedt (VMware) 		mod_head = tr ? &tr->mod_trace : NULL;
3913673feb9dSSteven Rostedt (VMware) 	}
3914f45948e8SSteven Rostedt 
39155985ea8bSSteven Rostedt (VMware) 	iter->mod_list = mod_head;
39165985ea8bSSteven Rostedt (VMware) 
391733dc9b12SSteven Rostedt 	if (file->f_mode & FMODE_WRITE) {
3918ef2fbe16SNamhyung Kim 		const int size_bits = FTRACE_HASH_DEFAULT_BITS;
3919ef2fbe16SNamhyung Kim 
3920673feb9dSSteven Rostedt (VMware) 		if (file->f_flags & O_TRUNC) {
3921ef2fbe16SNamhyung Kim 			iter->hash = alloc_ftrace_hash(size_bits);
3922673feb9dSSteven Rostedt (VMware) 			clear_ftrace_mod_list(mod_head);
3923673feb9dSSteven Rostedt (VMware) 	        } else {
3924ef2fbe16SNamhyung Kim 			iter->hash = alloc_and_copy_ftrace_hash(size_bits, hash);
3925673feb9dSSteven Rostedt (VMware) 		}
3926ef2fbe16SNamhyung Kim 
392733dc9b12SSteven Rostedt 		if (!iter->hash) {
392833dc9b12SSteven Rostedt 			trace_parser_put(&iter->parser);
39293f2367baSMasami Hiramatsu 			goto out_unlock;
393033dc9b12SSteven Rostedt 		}
3931c20489daSSteven Rostedt (VMware) 	} else
3932c20489daSSteven Rostedt (VMware) 		iter->hash = hash;
39331cf41dd7SSteven Rostedt 
39349ef16693SSteven Rostedt (VMware) 	ret = 0;
39359ef16693SSteven Rostedt (VMware) 
39365072c59fSSteven Rostedt 	if (file->f_mode & FMODE_READ) {
39375072c59fSSteven Rostedt 		iter->pg = ftrace_pages_start;
39385072c59fSSteven Rostedt 
39395072c59fSSteven Rostedt 		ret = seq_open(file, &show_ftrace_seq_ops);
39405072c59fSSteven Rostedt 		if (!ret) {
39415072c59fSSteven Rostedt 			struct seq_file *m = file->private_data;
39425072c59fSSteven Rostedt 			m->private = iter;
394379fe249cSLi Zefan 		} else {
394433dc9b12SSteven Rostedt 			/* Failed */
394533dc9b12SSteven Rostedt 			free_ftrace_hash(iter->hash);
394679fe249cSLi Zefan 			trace_parser_put(&iter->parser);
394779fe249cSLi Zefan 		}
39485072c59fSSteven Rostedt 	} else
39495072c59fSSteven Rostedt 		file->private_data = iter;
39503f2367baSMasami Hiramatsu 
39513f2367baSMasami Hiramatsu  out_unlock:
395233b7f99cSSteven Rostedt (Red Hat) 	mutex_unlock(&ops->func_hash->regex_lock);
39535072c59fSSteven Rostedt 
39549ef16693SSteven Rostedt (VMware)  out:
39559ef16693SSteven Rostedt (VMware) 	if (ret) {
39569ef16693SSteven Rostedt (VMware) 		kfree(iter);
39579ef16693SSteven Rostedt (VMware) 		if (tr)
39589ef16693SSteven Rostedt (VMware) 			trace_array_put(tr);
39599ef16693SSteven Rostedt (VMware) 	}
39609ef16693SSteven Rostedt (VMware) 
39615072c59fSSteven Rostedt 	return ret;
39625072c59fSSteven Rostedt }
39635072c59fSSteven Rostedt 
396441c52c0dSSteven Rostedt static int
396541c52c0dSSteven Rostedt ftrace_filter_open(struct inode *inode, struct file *file)
396641c52c0dSSteven Rostedt {
3967e3b3e2e8SSteven Rostedt (Red Hat) 	struct ftrace_ops *ops = inode->i_private;
3968e3b3e2e8SSteven Rostedt (Red Hat) 
396917911ff3SSteven Rostedt (VMware) 	/* Checks for tracefs lockdown */
3970e3b3e2e8SSteven Rostedt (Red Hat) 	return ftrace_regex_open(ops,
3971eee8ded1SSteven Rostedt (VMware) 			FTRACE_ITER_FILTER | FTRACE_ITER_DO_PROBES,
39721cf41dd7SSteven Rostedt 			inode, file);
397341c52c0dSSteven Rostedt }
397441c52c0dSSteven Rostedt 
397541c52c0dSSteven Rostedt static int
397641c52c0dSSteven Rostedt ftrace_notrace_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, FTRACE_ITER_NOTRACE,
39821cf41dd7SSteven Rostedt 				 inode, file);
398341c52c0dSSteven Rostedt }
398441c52c0dSSteven Rostedt 
39853ba00929SDmitry Safonov /* Type for quick search ftrace basic regexes (globs) from filter_parse_regex */
39863ba00929SDmitry Safonov struct ftrace_glob {
39873ba00929SDmitry Safonov 	char *search;
39883ba00929SDmitry Safonov 	unsigned len;
39893ba00929SDmitry Safonov 	int type;
39903ba00929SDmitry Safonov };
39913ba00929SDmitry Safonov 
39927132e2d6SThiago Jung Bauermann /*
39937132e2d6SThiago Jung Bauermann  * If symbols in an architecture don't correspond exactly to the user-visible
39947132e2d6SThiago Jung Bauermann  * name of what they represent, it is possible to define this function to
39957132e2d6SThiago Jung Bauermann  * perform the necessary adjustments.
39967132e2d6SThiago Jung Bauermann */
39977132e2d6SThiago Jung Bauermann char * __weak arch_ftrace_match_adjust(char *str, const char *search)
39987132e2d6SThiago Jung Bauermann {
39997132e2d6SThiago Jung Bauermann 	return str;
40007132e2d6SThiago Jung Bauermann }
40017132e2d6SThiago Jung Bauermann 
40023ba00929SDmitry Safonov static int ftrace_match(char *str, struct ftrace_glob *g)
40039f4801e3SSteven Rostedt {
40049f4801e3SSteven Rostedt 	int matched = 0;
4005751e9983SLi Zefan 	int slen;
40069f4801e3SSteven Rostedt 
40077132e2d6SThiago Jung Bauermann 	str = arch_ftrace_match_adjust(str, g->search);
40087132e2d6SThiago Jung Bauermann 
40093ba00929SDmitry Safonov 	switch (g->type) {
40109f4801e3SSteven Rostedt 	case MATCH_FULL:
40113ba00929SDmitry Safonov 		if (strcmp(str, g->search) == 0)
40129f4801e3SSteven Rostedt 			matched = 1;
40139f4801e3SSteven Rostedt 		break;
40149f4801e3SSteven Rostedt 	case MATCH_FRONT_ONLY:
40153ba00929SDmitry Safonov 		if (strncmp(str, g->search, g->len) == 0)
40169f4801e3SSteven Rostedt 			matched = 1;
40179f4801e3SSteven Rostedt 		break;
40189f4801e3SSteven Rostedt 	case MATCH_MIDDLE_ONLY:
40193ba00929SDmitry Safonov 		if (strstr(str, g->search))
40209f4801e3SSteven Rostedt 			matched = 1;
40219f4801e3SSteven Rostedt 		break;
40229f4801e3SSteven Rostedt 	case MATCH_END_ONLY:
4023751e9983SLi Zefan 		slen = strlen(str);
40243ba00929SDmitry Safonov 		if (slen >= g->len &&
40253ba00929SDmitry Safonov 		    memcmp(str + slen - g->len, g->search, g->len) == 0)
40269f4801e3SSteven Rostedt 			matched = 1;
40279f4801e3SSteven Rostedt 		break;
402860f1d5e3SMasami Hiramatsu 	case MATCH_GLOB:
402960f1d5e3SMasami Hiramatsu 		if (glob_match(g->search, str))
403060f1d5e3SMasami Hiramatsu 			matched = 1;
403160f1d5e3SMasami Hiramatsu 		break;
40329f4801e3SSteven Rostedt 	}
40339f4801e3SSteven Rostedt 
40349f4801e3SSteven Rostedt 	return matched;
40359f4801e3SSteven Rostedt }
40369f4801e3SSteven Rostedt 
4037b448c4e3SSteven Rostedt static int
4038f0a3b154SDmitry Safonov enter_record(struct ftrace_hash *hash, struct dyn_ftrace *rec, int clear_filter)
403964e7c440SSteven Rostedt {
4040b448c4e3SSteven Rostedt 	struct ftrace_func_entry *entry;
4041b448c4e3SSteven Rostedt 	int ret = 0;
4042b448c4e3SSteven Rostedt 
40431cf41dd7SSteven Rostedt 	entry = ftrace_lookup_ip(hash, rec->ip);
4044f0a3b154SDmitry Safonov 	if (clear_filter) {
4045b448c4e3SSteven Rostedt 		/* Do nothing if it doesn't exist */
4046b448c4e3SSteven Rostedt 		if (!entry)
4047b448c4e3SSteven Rostedt 			return 0;
4048b448c4e3SSteven Rostedt 
404933dc9b12SSteven Rostedt 		free_hash_entry(hash, entry);
4050b448c4e3SSteven Rostedt 	} else {
4051b448c4e3SSteven Rostedt 		/* Do nothing if it exists */
4052b448c4e3SSteven Rostedt 		if (entry)
4053b448c4e3SSteven Rostedt 			return 0;
4054b448c4e3SSteven Rostedt 
4055b448c4e3SSteven Rostedt 		ret = add_hash_entry(hash, rec->ip);
4056b448c4e3SSteven Rostedt 	}
4057b448c4e3SSteven Rostedt 	return ret;
4058996e87beSSteven Rostedt }
4059996e87beSSteven Rostedt 
406064e7c440SSteven Rostedt static int
4061f79b3f33SSteven Rostedt (VMware) add_rec_by_index(struct ftrace_hash *hash, struct ftrace_glob *func_g,
4062f79b3f33SSteven Rostedt (VMware) 		 int clear_filter)
4063f79b3f33SSteven Rostedt (VMware) {
4064f79b3f33SSteven Rostedt (VMware) 	long index = simple_strtoul(func_g->search, NULL, 0);
4065f79b3f33SSteven Rostedt (VMware) 	struct ftrace_page *pg;
4066f79b3f33SSteven Rostedt (VMware) 	struct dyn_ftrace *rec;
4067f79b3f33SSteven Rostedt (VMware) 
4068f79b3f33SSteven Rostedt (VMware) 	/* The index starts at 1 */
4069f79b3f33SSteven Rostedt (VMware) 	if (--index < 0)
4070f79b3f33SSteven Rostedt (VMware) 		return 0;
4071f79b3f33SSteven Rostedt (VMware) 
4072f79b3f33SSteven Rostedt (VMware) 	do_for_each_ftrace_rec(pg, rec) {
4073f79b3f33SSteven Rostedt (VMware) 		if (pg->index <= index) {
4074f79b3f33SSteven Rostedt (VMware) 			index -= pg->index;
4075f79b3f33SSteven Rostedt (VMware) 			/* this is a double loop, break goes to the next page */
4076f79b3f33SSteven Rostedt (VMware) 			break;
4077f79b3f33SSteven Rostedt (VMware) 		}
4078f79b3f33SSteven Rostedt (VMware) 		rec = &pg->records[index];
4079f79b3f33SSteven Rostedt (VMware) 		enter_record(hash, rec, clear_filter);
4080f79b3f33SSteven Rostedt (VMware) 		return 1;
4081f79b3f33SSteven Rostedt (VMware) 	} while_for_each_ftrace_rec();
4082f79b3f33SSteven Rostedt (VMware) 	return 0;
4083f79b3f33SSteven Rostedt (VMware) }
4084f79b3f33SSteven Rostedt (VMware) 
4085b39181f7SSteven Rostedt (Google) #ifdef FTRACE_MCOUNT_MAX_OFFSET
4086b39181f7SSteven Rostedt (Google) static int lookup_ip(unsigned long ip, char **modname, char *str)
4087b39181f7SSteven Rostedt (Google) {
4088b39181f7SSteven Rostedt (Google) 	unsigned long offset;
4089b39181f7SSteven Rostedt (Google) 
4090b39181f7SSteven Rostedt (Google) 	kallsyms_lookup(ip, NULL, &offset, modname, str);
4091b39181f7SSteven Rostedt (Google) 	if (offset > FTRACE_MCOUNT_MAX_OFFSET)
4092b39181f7SSteven Rostedt (Google) 		return -1;
4093b39181f7SSteven Rostedt (Google) 	return 0;
4094b39181f7SSteven Rostedt (Google) }
4095b39181f7SSteven Rostedt (Google) #else
4096b39181f7SSteven Rostedt (Google) static int lookup_ip(unsigned long ip, char **modname, char *str)
4097b39181f7SSteven Rostedt (Google) {
4098b39181f7SSteven Rostedt (Google) 	kallsyms_lookup(ip, NULL, NULL, modname, str);
4099b39181f7SSteven Rostedt (Google) 	return 0;
4100b39181f7SSteven Rostedt (Google) }
4101b39181f7SSteven Rostedt (Google) #endif
4102b39181f7SSteven Rostedt (Google) 
4103f79b3f33SSteven Rostedt (VMware) static int
41040b507e1eSDmitry Safonov ftrace_match_record(struct dyn_ftrace *rec, struct ftrace_glob *func_g,
41050b507e1eSDmitry Safonov 		struct ftrace_glob *mod_g, int exclude_mod)
410664e7c440SSteven Rostedt {
410764e7c440SSteven Rostedt 	char str[KSYM_SYMBOL_LEN];
4108b9df92d2SSteven Rostedt 	char *modname;
410964e7c440SSteven Rostedt 
4110b39181f7SSteven Rostedt (Google) 	if (lookup_ip(rec->ip, &modname, str)) {
4111b39181f7SSteven Rostedt (Google) 		/* This should only happen when a rec is disabled */
4112b39181f7SSteven Rostedt (Google) 		WARN_ON_ONCE(system_state == SYSTEM_RUNNING &&
4113b39181f7SSteven Rostedt (Google) 			     !(rec->flags & FTRACE_FL_DISABLED));
4114b39181f7SSteven Rostedt (Google) 		return 0;
4115b39181f7SSteven Rostedt (Google) 	}
4116b9df92d2SSteven Rostedt 
41170b507e1eSDmitry Safonov 	if (mod_g) {
41180b507e1eSDmitry Safonov 		int mod_matches = (modname) ? ftrace_match(modname, mod_g) : 0;
41190b507e1eSDmitry Safonov 
41200b507e1eSDmitry Safonov 		/* blank module name to match all modules */
41210b507e1eSDmitry Safonov 		if (!mod_g->len) {
41220b507e1eSDmitry Safonov 			/* blank module globbing: modname xor exclude_mod */
412377c0eddeSSteven Rostedt (VMware) 			if (!exclude_mod != !modname)
41240b507e1eSDmitry Safonov 				goto func_match;
41250b507e1eSDmitry Safonov 			return 0;
41260b507e1eSDmitry Safonov 		}
41270b507e1eSDmitry Safonov 
412877c0eddeSSteven Rostedt (VMware) 		/*
412977c0eddeSSteven Rostedt (VMware) 		 * exclude_mod is set to trace everything but the given
413077c0eddeSSteven Rostedt (VMware) 		 * module. If it is set and the module matches, then
413177c0eddeSSteven Rostedt (VMware) 		 * return 0. If it is not set, and the module doesn't match
413277c0eddeSSteven Rostedt (VMware) 		 * also return 0. Otherwise, check the function to see if
413377c0eddeSSteven Rostedt (VMware) 		 * that matches.
413477c0eddeSSteven Rostedt (VMware) 		 */
413577c0eddeSSteven Rostedt (VMware) 		if (!mod_matches == !exclude_mod)
41360b507e1eSDmitry Safonov 			return 0;
41370b507e1eSDmitry Safonov func_match:
4138b9df92d2SSteven Rostedt 		/* blank search means to match all funcs in the mod */
41393ba00929SDmitry Safonov 		if (!func_g->len)
4140b9df92d2SSteven Rostedt 			return 1;
4141b9df92d2SSteven Rostedt 	}
4142b9df92d2SSteven Rostedt 
41433ba00929SDmitry Safonov 	return ftrace_match(str, func_g);
414464e7c440SSteven Rostedt }
414564e7c440SSteven Rostedt 
41461cf41dd7SSteven Rostedt static int
41473ba00929SDmitry Safonov match_records(struct ftrace_hash *hash, char *func, int len, char *mod)
41489f4801e3SSteven Rostedt {
41499f4801e3SSteven Rostedt 	struct ftrace_page *pg;
41509f4801e3SSteven Rostedt 	struct dyn_ftrace *rec;
41513ba00929SDmitry Safonov 	struct ftrace_glob func_g = { .type = MATCH_FULL };
41520b507e1eSDmitry Safonov 	struct ftrace_glob mod_g = { .type = MATCH_FULL };
41530b507e1eSDmitry Safonov 	struct ftrace_glob *mod_match = (mod) ? &mod_g : NULL;
41540b507e1eSDmitry Safonov 	int exclude_mod = 0;
4155311d16daSLi Zefan 	int found = 0;
4156b448c4e3SSteven Rostedt 	int ret;
41572e028c4fSDan Carpenter 	int clear_filter = 0;
41589f4801e3SSteven Rostedt 
41590b507e1eSDmitry Safonov 	if (func) {
41603ba00929SDmitry Safonov 		func_g.type = filter_parse_regex(func, len, &func_g.search,
41613ba00929SDmitry Safonov 						 &clear_filter);
41623ba00929SDmitry Safonov 		func_g.len = strlen(func_g.search);
4163b9df92d2SSteven Rostedt 	}
4164b9df92d2SSteven Rostedt 
41650b507e1eSDmitry Safonov 	if (mod) {
41660b507e1eSDmitry Safonov 		mod_g.type = filter_parse_regex(mod, strlen(mod),
41670b507e1eSDmitry Safonov 				&mod_g.search, &exclude_mod);
41680b507e1eSDmitry Safonov 		mod_g.len = strlen(mod_g.search);
4169b9df92d2SSteven Rostedt 	}
4170b9df92d2SSteven Rostedt 
417152baf119SSteven Rostedt 	mutex_lock(&ftrace_lock);
4172b9df92d2SSteven Rostedt 
4173b9df92d2SSteven Rostedt 	if (unlikely(ftrace_disabled))
4174b9df92d2SSteven Rostedt 		goto out_unlock;
4175b9df92d2SSteven Rostedt 
4176f79b3f33SSteven Rostedt (VMware) 	if (func_g.type == MATCH_INDEX) {
4177f79b3f33SSteven Rostedt (VMware) 		found = add_rec_by_index(hash, &func_g, clear_filter);
4178f79b3f33SSteven Rostedt (VMware) 		goto out_unlock;
4179f79b3f33SSteven Rostedt (VMware) 	}
4180f79b3f33SSteven Rostedt (VMware) 
4181265c831cSSteven Rostedt 	do_for_each_ftrace_rec(pg, rec) {
4182546fece4SSteven Rostedt (Red Hat) 
4183546fece4SSteven Rostedt (Red Hat) 		if (rec->flags & FTRACE_FL_DISABLED)
4184546fece4SSteven Rostedt (Red Hat) 			continue;
4185546fece4SSteven Rostedt (Red Hat) 
41860b507e1eSDmitry Safonov 		if (ftrace_match_record(rec, &func_g, mod_match, exclude_mod)) {
4187f0a3b154SDmitry Safonov 			ret = enter_record(hash, rec, clear_filter);
4188b448c4e3SSteven Rostedt 			if (ret < 0) {
4189b448c4e3SSteven Rostedt 				found = ret;
4190b448c4e3SSteven Rostedt 				goto out_unlock;
4191b448c4e3SSteven Rostedt 			}
4192311d16daSLi Zefan 			found = 1;
41935072c59fSSteven Rostedt 		}
4194265c831cSSteven Rostedt 	} while_for_each_ftrace_rec();
4195b9df92d2SSteven Rostedt  out_unlock:
419652baf119SSteven Rostedt 	mutex_unlock(&ftrace_lock);
4197311d16daSLi Zefan 
4198311d16daSLi Zefan 	return found;
41995072c59fSSteven Rostedt }
42005072c59fSSteven Rostedt 
420164e7c440SSteven Rostedt static int
42021cf41dd7SSteven Rostedt ftrace_match_records(struct ftrace_hash *hash, char *buff, int len)
420364e7c440SSteven Rostedt {
4204f0a3b154SDmitry Safonov 	return match_records(hash, buff, len, NULL);
420564e7c440SSteven Rostedt }
420664e7c440SSteven Rostedt 
4207e16b35ddSSteven Rostedt (VMware) static void ftrace_ops_update_code(struct ftrace_ops *ops,
4208e16b35ddSSteven Rostedt (VMware) 				   struct ftrace_ops_hash *old_hash)
4209e16b35ddSSteven Rostedt (VMware) {
4210e16b35ddSSteven Rostedt (VMware) 	struct ftrace_ops *op;
4211e16b35ddSSteven Rostedt (VMware) 
4212e16b35ddSSteven Rostedt (VMware) 	if (!ftrace_enabled)
4213e16b35ddSSteven Rostedt (VMware) 		return;
4214e16b35ddSSteven Rostedt (VMware) 
4215e16b35ddSSteven Rostedt (VMware) 	if (ops->flags & FTRACE_OPS_FL_ENABLED) {
4216e16b35ddSSteven Rostedt (VMware) 		ftrace_run_modify_code(ops, FTRACE_UPDATE_CALLS, old_hash);
4217e16b35ddSSteven Rostedt (VMware) 		return;
4218e16b35ddSSteven Rostedt (VMware) 	}
4219e16b35ddSSteven Rostedt (VMware) 
4220e16b35ddSSteven Rostedt (VMware) 	/*
4221e16b35ddSSteven Rostedt (VMware) 	 * If this is the shared global_ops filter, then we need to
4222e16b35ddSSteven Rostedt (VMware) 	 * check if there is another ops that shares it, is enabled.
4223e16b35ddSSteven Rostedt (VMware) 	 * If so, we still need to run the modify code.
4224e16b35ddSSteven Rostedt (VMware) 	 */
4225e16b35ddSSteven Rostedt (VMware) 	if (ops->func_hash != &global_ops.local_hash)
4226e16b35ddSSteven Rostedt (VMware) 		return;
4227e16b35ddSSteven Rostedt (VMware) 
4228e16b35ddSSteven Rostedt (VMware) 	do_for_each_ftrace_op(op, ftrace_ops_list) {
4229e16b35ddSSteven Rostedt (VMware) 		if (op->func_hash == &global_ops.local_hash &&
4230e16b35ddSSteven Rostedt (VMware) 		    op->flags & FTRACE_OPS_FL_ENABLED) {
4231e16b35ddSSteven Rostedt (VMware) 			ftrace_run_modify_code(op, FTRACE_UPDATE_CALLS, old_hash);
4232e16b35ddSSteven Rostedt (VMware) 			/* Only need to do this once */
4233e16b35ddSSteven Rostedt (VMware) 			return;
4234e16b35ddSSteven Rostedt (VMware) 		}
4235e16b35ddSSteven Rostedt (VMware) 	} while_for_each_ftrace_op(op);
4236e16b35ddSSteven Rostedt (VMware) }
4237e16b35ddSSteven Rostedt (VMware) 
4238e16b35ddSSteven Rostedt (VMware) static int ftrace_hash_move_and_update_ops(struct ftrace_ops *ops,
4239e16b35ddSSteven Rostedt (VMware) 					   struct ftrace_hash **orig_hash,
4240e16b35ddSSteven Rostedt (VMware) 					   struct ftrace_hash *hash,
4241e16b35ddSSteven Rostedt (VMware) 					   int enable)
4242e16b35ddSSteven Rostedt (VMware) {
4243e16b35ddSSteven Rostedt (VMware) 	struct ftrace_ops_hash old_hash_ops;
4244e16b35ddSSteven Rostedt (VMware) 	struct ftrace_hash *old_hash;
4245e16b35ddSSteven Rostedt (VMware) 	int ret;
4246e16b35ddSSteven Rostedt (VMware) 
4247e16b35ddSSteven Rostedt (VMware) 	old_hash = *orig_hash;
4248e16b35ddSSteven Rostedt (VMware) 	old_hash_ops.filter_hash = ops->func_hash->filter_hash;
4249e16b35ddSSteven Rostedt (VMware) 	old_hash_ops.notrace_hash = ops->func_hash->notrace_hash;
4250e16b35ddSSteven Rostedt (VMware) 	ret = ftrace_hash_move(ops, enable, orig_hash, hash);
4251e16b35ddSSteven Rostedt (VMware) 	if (!ret) {
4252e16b35ddSSteven Rostedt (VMware) 		ftrace_ops_update_code(ops, &old_hash_ops);
4253e16b35ddSSteven Rostedt (VMware) 		free_ftrace_hash_rcu(old_hash);
4254e16b35ddSSteven Rostedt (VMware) 	}
4255e16b35ddSSteven Rostedt (VMware) 	return ret;
4256e16b35ddSSteven Rostedt (VMware) }
425764e7c440SSteven Rostedt 
4258673feb9dSSteven Rostedt (VMware) static bool module_exists(const char *module)
4259673feb9dSSteven Rostedt (VMware) {
4260673feb9dSSteven Rostedt (VMware) 	/* All modules have the symbol __this_module */
42610f5e5a3aSRasmus Villemoes 	static const char this_mod[] = "__this_module";
4262419e9fe5SSalvatore Mesoraca 	char modname[MAX_PARAM_PREFIX_LEN + sizeof(this_mod) + 2];
4263673feb9dSSteven Rostedt (VMware) 	unsigned long val;
4264673feb9dSSteven Rostedt (VMware) 	int n;
4265673feb9dSSteven Rostedt (VMware) 
4266419e9fe5SSalvatore Mesoraca 	n = snprintf(modname, sizeof(modname), "%s:%s", module, this_mod);
4267673feb9dSSteven Rostedt (VMware) 
4268419e9fe5SSalvatore Mesoraca 	if (n > sizeof(modname) - 1)
4269673feb9dSSteven Rostedt (VMware) 		return false;
4270673feb9dSSteven Rostedt (VMware) 
4271673feb9dSSteven Rostedt (VMware) 	val = module_kallsyms_lookup_name(modname);
4272673feb9dSSteven Rostedt (VMware) 	return val != 0;
4273673feb9dSSteven Rostedt (VMware) }
4274673feb9dSSteven Rostedt (VMware) 
4275673feb9dSSteven Rostedt (VMware) static int cache_mod(struct trace_array *tr,
4276673feb9dSSteven Rostedt (VMware) 		     const char *func, char *module, int enable)
4277673feb9dSSteven Rostedt (VMware) {
4278673feb9dSSteven Rostedt (VMware) 	struct ftrace_mod_load *ftrace_mod, *n;
4279673feb9dSSteven Rostedt (VMware) 	struct list_head *head = enable ? &tr->mod_trace : &tr->mod_notrace;
4280673feb9dSSteven Rostedt (VMware) 	int ret;
4281673feb9dSSteven Rostedt (VMware) 
4282673feb9dSSteven Rostedt (VMware) 	mutex_lock(&ftrace_lock);
4283673feb9dSSteven Rostedt (VMware) 
4284673feb9dSSteven Rostedt (VMware) 	/* We do not cache inverse filters */
4285673feb9dSSteven Rostedt (VMware) 	if (func[0] == '!') {
4286673feb9dSSteven Rostedt (VMware) 		func++;
4287673feb9dSSteven Rostedt (VMware) 		ret = -EINVAL;
4288673feb9dSSteven Rostedt (VMware) 
4289673feb9dSSteven Rostedt (VMware) 		/* Look to remove this hash */
4290673feb9dSSteven Rostedt (VMware) 		list_for_each_entry_safe(ftrace_mod, n, head, list) {
4291673feb9dSSteven Rostedt (VMware) 			if (strcmp(ftrace_mod->module, module) != 0)
4292673feb9dSSteven Rostedt (VMware) 				continue;
4293673feb9dSSteven Rostedt (VMware) 
4294673feb9dSSteven Rostedt (VMware) 			/* no func matches all */
429544925dffSDan Carpenter 			if (strcmp(func, "*") == 0 ||
4296673feb9dSSteven Rostedt (VMware) 			    (ftrace_mod->func &&
4297673feb9dSSteven Rostedt (VMware) 			     strcmp(ftrace_mod->func, func) == 0)) {
4298673feb9dSSteven Rostedt (VMware) 				ret = 0;
4299673feb9dSSteven Rostedt (VMware) 				free_ftrace_mod(ftrace_mod);
4300673feb9dSSteven Rostedt (VMware) 				continue;
4301673feb9dSSteven Rostedt (VMware) 			}
4302673feb9dSSteven Rostedt (VMware) 		}
4303673feb9dSSteven Rostedt (VMware) 		goto out;
4304673feb9dSSteven Rostedt (VMware) 	}
4305673feb9dSSteven Rostedt (VMware) 
4306673feb9dSSteven Rostedt (VMware) 	ret = -EINVAL;
4307673feb9dSSteven Rostedt (VMware) 	/* We only care about modules that have not been loaded yet */
4308673feb9dSSteven Rostedt (VMware) 	if (module_exists(module))
4309673feb9dSSteven Rostedt (VMware) 		goto out;
4310673feb9dSSteven Rostedt (VMware) 
4311673feb9dSSteven Rostedt (VMware) 	/* Save this string off, and execute it when the module is loaded */
4312673feb9dSSteven Rostedt (VMware) 	ret = ftrace_add_mod(tr, func, module, enable);
4313673feb9dSSteven Rostedt (VMware)  out:
4314673feb9dSSteven Rostedt (VMware) 	mutex_unlock(&ftrace_lock);
4315673feb9dSSteven Rostedt (VMware) 
4316673feb9dSSteven Rostedt (VMware) 	return ret;
4317673feb9dSSteven Rostedt (VMware) }
4318673feb9dSSteven Rostedt (VMware) 
4319d7fbf8dfSSteven Rostedt (VMware) static int
4320d7fbf8dfSSteven Rostedt (VMware) ftrace_set_regex(struct ftrace_ops *ops, unsigned char *buf, int len,
4321d7fbf8dfSSteven Rostedt (VMware) 		 int reset, int enable);
4322d7fbf8dfSSteven Rostedt (VMware) 
432369449bbdSArnd Bergmann #ifdef CONFIG_MODULES
4324d7fbf8dfSSteven Rostedt (VMware) static void process_mod_list(struct list_head *head, struct ftrace_ops *ops,
4325d7fbf8dfSSteven Rostedt (VMware) 			     char *mod, bool enable)
4326d7fbf8dfSSteven Rostedt (VMware) {
4327d7fbf8dfSSteven Rostedt (VMware) 	struct ftrace_mod_load *ftrace_mod, *n;
4328d7fbf8dfSSteven Rostedt (VMware) 	struct ftrace_hash **orig_hash, *new_hash;
4329d7fbf8dfSSteven Rostedt (VMware) 	LIST_HEAD(process_mods);
4330d7fbf8dfSSteven Rostedt (VMware) 	char *func;
4331d7fbf8dfSSteven Rostedt (VMware) 
4332d7fbf8dfSSteven Rostedt (VMware) 	mutex_lock(&ops->func_hash->regex_lock);
4333d7fbf8dfSSteven Rostedt (VMware) 
4334d7fbf8dfSSteven Rostedt (VMware) 	if (enable)
4335d7fbf8dfSSteven Rostedt (VMware) 		orig_hash = &ops->func_hash->filter_hash;
4336d7fbf8dfSSteven Rostedt (VMware) 	else
4337d7fbf8dfSSteven Rostedt (VMware) 		orig_hash = &ops->func_hash->notrace_hash;
4338d7fbf8dfSSteven Rostedt (VMware) 
4339d7fbf8dfSSteven Rostedt (VMware) 	new_hash = alloc_and_copy_ftrace_hash(FTRACE_HASH_DEFAULT_BITS,
4340d7fbf8dfSSteven Rostedt (VMware) 					      *orig_hash);
4341d7fbf8dfSSteven Rostedt (VMware) 	if (!new_hash)
43423b58a3c7SSteven Rostedt (VMware) 		goto out; /* warn? */
4343d7fbf8dfSSteven Rostedt (VMware) 
4344d7fbf8dfSSteven Rostedt (VMware) 	mutex_lock(&ftrace_lock);
4345d7fbf8dfSSteven Rostedt (VMware) 
4346d7fbf8dfSSteven Rostedt (VMware) 	list_for_each_entry_safe(ftrace_mod, n, head, list) {
4347d7fbf8dfSSteven Rostedt (VMware) 
4348d7fbf8dfSSteven Rostedt (VMware) 		if (strcmp(ftrace_mod->module, mod) != 0)
4349d7fbf8dfSSteven Rostedt (VMware) 			continue;
4350d7fbf8dfSSteven Rostedt (VMware) 
4351d7fbf8dfSSteven Rostedt (VMware) 		if (ftrace_mod->func)
4352d7fbf8dfSSteven Rostedt (VMware) 			func = kstrdup(ftrace_mod->func, GFP_KERNEL);
4353d7fbf8dfSSteven Rostedt (VMware) 		else
4354d7fbf8dfSSteven Rostedt (VMware) 			func = kstrdup("*", GFP_KERNEL);
4355d7fbf8dfSSteven Rostedt (VMware) 
4356d7fbf8dfSSteven Rostedt (VMware) 		if (!func) /* warn? */
4357d7fbf8dfSSteven Rostedt (VMware) 			continue;
4358d7fbf8dfSSteven Rostedt (VMware) 
43593ecda644SBaokun Li 		list_move(&ftrace_mod->list, &process_mods);
4360d7fbf8dfSSteven Rostedt (VMware) 
4361d7fbf8dfSSteven Rostedt (VMware) 		/* Use the newly allocated func, as it may be "*" */
4362d7fbf8dfSSteven Rostedt (VMware) 		kfree(ftrace_mod->func);
4363d7fbf8dfSSteven Rostedt (VMware) 		ftrace_mod->func = func;
4364d7fbf8dfSSteven Rostedt (VMware) 	}
4365d7fbf8dfSSteven Rostedt (VMware) 
4366d7fbf8dfSSteven Rostedt (VMware) 	mutex_unlock(&ftrace_lock);
4367d7fbf8dfSSteven Rostedt (VMware) 
4368d7fbf8dfSSteven Rostedt (VMware) 	list_for_each_entry_safe(ftrace_mod, n, &process_mods, list) {
4369d7fbf8dfSSteven Rostedt (VMware) 
4370d7fbf8dfSSteven Rostedt (VMware) 		func = ftrace_mod->func;
4371d7fbf8dfSSteven Rostedt (VMware) 
4372d7fbf8dfSSteven Rostedt (VMware) 		/* Grabs ftrace_lock, which is why we have this extra step */
4373d7fbf8dfSSteven Rostedt (VMware) 		match_records(new_hash, func, strlen(func), mod);
4374d7fbf8dfSSteven Rostedt (VMware) 		free_ftrace_mod(ftrace_mod);
4375d7fbf8dfSSteven Rostedt (VMware) 	}
4376d7fbf8dfSSteven Rostedt (VMware) 
43778c08f0d5SSteven Rostedt (VMware) 	if (enable && list_empty(head))
43788c08f0d5SSteven Rostedt (VMware) 		new_hash->flags &= ~FTRACE_HASH_FL_MOD;
43798c08f0d5SSteven Rostedt (VMware) 
4380d7fbf8dfSSteven Rostedt (VMware) 	mutex_lock(&ftrace_lock);
4381d7fbf8dfSSteven Rostedt (VMware) 
4382045e269cSAlex Shi 	ftrace_hash_move_and_update_ops(ops, orig_hash,
4383d7fbf8dfSSteven Rostedt (VMware) 					      new_hash, enable);
4384d7fbf8dfSSteven Rostedt (VMware) 	mutex_unlock(&ftrace_lock);
4385d7fbf8dfSSteven Rostedt (VMware) 
43863b58a3c7SSteven Rostedt (VMware)  out:
4387d7fbf8dfSSteven Rostedt (VMware) 	mutex_unlock(&ops->func_hash->regex_lock);
4388d7fbf8dfSSteven Rostedt (VMware) 
4389d7fbf8dfSSteven Rostedt (VMware) 	free_ftrace_hash(new_hash);
4390d7fbf8dfSSteven Rostedt (VMware) }
4391d7fbf8dfSSteven Rostedt (VMware) 
4392d7fbf8dfSSteven Rostedt (VMware) static void process_cached_mods(const char *mod_name)
4393d7fbf8dfSSteven Rostedt (VMware) {
4394d7fbf8dfSSteven Rostedt (VMware) 	struct trace_array *tr;
4395d7fbf8dfSSteven Rostedt (VMware) 	char *mod;
4396d7fbf8dfSSteven Rostedt (VMware) 
4397d7fbf8dfSSteven Rostedt (VMware) 	mod = kstrdup(mod_name, GFP_KERNEL);
4398d7fbf8dfSSteven Rostedt (VMware) 	if (!mod)
4399d7fbf8dfSSteven Rostedt (VMware) 		return;
4400d7fbf8dfSSteven Rostedt (VMware) 
4401d7fbf8dfSSteven Rostedt (VMware) 	mutex_lock(&trace_types_lock);
4402d7fbf8dfSSteven Rostedt (VMware) 	list_for_each_entry(tr, &ftrace_trace_arrays, list) {
4403d7fbf8dfSSteven Rostedt (VMware) 		if (!list_empty(&tr->mod_trace))
4404d7fbf8dfSSteven Rostedt (VMware) 			process_mod_list(&tr->mod_trace, tr->ops, mod, true);
4405d7fbf8dfSSteven Rostedt (VMware) 		if (!list_empty(&tr->mod_notrace))
4406d7fbf8dfSSteven Rostedt (VMware) 			process_mod_list(&tr->mod_notrace, tr->ops, mod, false);
4407d7fbf8dfSSteven Rostedt (VMware) 	}
4408d7fbf8dfSSteven Rostedt (VMware) 	mutex_unlock(&trace_types_lock);
4409d7fbf8dfSSteven Rostedt (VMware) 
4410d7fbf8dfSSteven Rostedt (VMware) 	kfree(mod);
4411d7fbf8dfSSteven Rostedt (VMware) }
441269449bbdSArnd Bergmann #endif
4413d7fbf8dfSSteven Rostedt (VMware) 
4414f6180773SSteven Rostedt /*
4415f6180773SSteven Rostedt  * We register the module command as a template to show others how
4416f6180773SSteven Rostedt  * to register the a command as well.
4417f6180773SSteven Rostedt  */
4418f6180773SSteven Rostedt 
4419f6180773SSteven Rostedt static int
442004ec7bb6SSteven Rostedt (VMware) ftrace_mod_callback(struct trace_array *tr, struct ftrace_hash *hash,
4421673feb9dSSteven Rostedt (VMware) 		    char *func_orig, char *cmd, char *module, int enable)
4422f6180773SSteven Rostedt {
4423673feb9dSSteven Rostedt (VMware) 	char *func;
44245e3949f0SDmitry Safonov 	int ret;
4425f6180773SSteven Rostedt 
4426673feb9dSSteven Rostedt (VMware) 	/* match_records() modifies func, and we need the original */
4427673feb9dSSteven Rostedt (VMware) 	func = kstrdup(func_orig, GFP_KERNEL);
4428673feb9dSSteven Rostedt (VMware) 	if (!func)
4429673feb9dSSteven Rostedt (VMware) 		return -ENOMEM;
4430673feb9dSSteven Rostedt (VMware) 
4431f6180773SSteven Rostedt 	/*
4432f6180773SSteven Rostedt 	 * cmd == 'mod' because we only registered this func
4433f6180773SSteven Rostedt 	 * for the 'mod' ftrace_func_command.
4434f6180773SSteven Rostedt 	 * But if you register one func with multiple commands,
4435f6180773SSteven Rostedt 	 * you can tell which command was used by the cmd
4436f6180773SSteven Rostedt 	 * parameter.
4437f6180773SSteven Rostedt 	 */
4438f0a3b154SDmitry Safonov 	ret = match_records(hash, func, strlen(func), module);
4439673feb9dSSteven Rostedt (VMware) 	kfree(func);
4440673feb9dSSteven Rostedt (VMware) 
4441b448c4e3SSteven Rostedt 	if (!ret)
4442673feb9dSSteven Rostedt (VMware) 		return cache_mod(tr, func_orig, module, enable);
4443b448c4e3SSteven Rostedt 	if (ret < 0)
4444b448c4e3SSteven Rostedt 		return ret;
4445f6180773SSteven Rostedt 	return 0;
4446f6180773SSteven Rostedt }
4447f6180773SSteven Rostedt 
4448f6180773SSteven Rostedt static struct ftrace_func_command ftrace_mod_cmd = {
4449f6180773SSteven Rostedt 	.name			= "mod",
4450f6180773SSteven Rostedt 	.func			= ftrace_mod_callback,
4451f6180773SSteven Rostedt };
4452f6180773SSteven Rostedt 
4453f6180773SSteven Rostedt static int __init ftrace_mod_cmd_init(void)
4454f6180773SSteven Rostedt {
4455f6180773SSteven Rostedt 	return register_ftrace_command(&ftrace_mod_cmd);
4456f6180773SSteven Rostedt }
44576f415672SSteven Rostedt core_initcall(ftrace_mod_cmd_init);
4458f6180773SSteven Rostedt 
44592f5f6ad9SSteven Rostedt static void function_trace_probe_call(unsigned long ip, unsigned long parent_ip,
4460d19ad077SSteven Rostedt (VMware) 				      struct ftrace_ops *op, struct ftrace_regs *fregs)
446159df055fSSteven Rostedt {
4462eee8ded1SSteven Rostedt (VMware) 	struct ftrace_probe_ops *probe_ops;
44637b60f3d8SSteven Rostedt (VMware) 	struct ftrace_func_probe *probe;
446459df055fSSteven Rostedt 
44657b60f3d8SSteven Rostedt (VMware) 	probe = container_of(op, struct ftrace_func_probe, ops);
44667b60f3d8SSteven Rostedt (VMware) 	probe_ops = probe->probe_ops;
446759df055fSSteven Rostedt 
446859df055fSSteven Rostedt 	/*
446959df055fSSteven Rostedt 	 * Disable preemption for these calls to prevent a RCU grace
447059df055fSSteven Rostedt 	 * period. This syncs the hash iteration and freeing of items
447159df055fSSteven Rostedt 	 * on the hash. rcu_read_lock is too dangerous here.
447259df055fSSteven Rostedt 	 */
44735168ae50SSteven Rostedt 	preempt_disable_notrace();
44746e444319SSteven Rostedt (VMware) 	probe_ops->func(ip, parent_ip, probe->tr, probe_ops, probe->data);
44755168ae50SSteven Rostedt 	preempt_enable_notrace();
447659df055fSSteven Rostedt }
447759df055fSSteven Rostedt 
447841794f19SSteven Rostedt (VMware) struct ftrace_func_map {
447941794f19SSteven Rostedt (VMware) 	struct ftrace_func_entry	entry;
448041794f19SSteven Rostedt (VMware) 	void				*data;
448159df055fSSteven Rostedt };
448259df055fSSteven Rostedt 
448341794f19SSteven Rostedt (VMware) struct ftrace_func_mapper {
448441794f19SSteven Rostedt (VMware) 	struct ftrace_hash		hash;
448541794f19SSteven Rostedt (VMware) };
448659df055fSSteven Rostedt 
448741794f19SSteven Rostedt (VMware) /**
448841794f19SSteven Rostedt (VMware)  * allocate_ftrace_func_mapper - allocate a new ftrace_func_mapper
448941794f19SSteven Rostedt (VMware)  *
449041794f19SSteven Rostedt (VMware)  * Returns a ftrace_func_mapper descriptor that can be used to map ips to data.
449141794f19SSteven Rostedt (VMware)  */
449241794f19SSteven Rostedt (VMware) struct ftrace_func_mapper *allocate_ftrace_func_mapper(void)
449359df055fSSteven Rostedt {
4494e1df4cb6SSteven Rostedt (Red Hat) 	struct ftrace_hash *hash;
449559df055fSSteven Rostedt 
449641794f19SSteven Rostedt (VMware) 	/*
449741794f19SSteven Rostedt (VMware) 	 * The mapper is simply a ftrace_hash, but since the entries
449841794f19SSteven Rostedt (VMware) 	 * in the hash are not ftrace_func_entry type, we define it
449941794f19SSteven Rostedt (VMware) 	 * as a separate structure.
450041794f19SSteven Rostedt (VMware) 	 */
450141794f19SSteven Rostedt (VMware) 	hash = alloc_ftrace_hash(FTRACE_HASH_DEFAULT_BITS);
450241794f19SSteven Rostedt (VMware) 	return (struct ftrace_func_mapper *)hash;
4503e1df4cb6SSteven Rostedt (Red Hat) }
4504e1df4cb6SSteven Rostedt (Red Hat) 
450541794f19SSteven Rostedt (VMware) /**
450641794f19SSteven Rostedt (VMware)  * ftrace_func_mapper_find_ip - Find some data mapped to an ip
450741794f19SSteven Rostedt (VMware)  * @mapper: The mapper that has the ip maps
450841794f19SSteven Rostedt (VMware)  * @ip: the instruction pointer to find the data for
450941794f19SSteven Rostedt (VMware)  *
451041794f19SSteven Rostedt (VMware)  * Returns the data mapped to @ip if found otherwise NULL. The return
451141794f19SSteven Rostedt (VMware)  * is actually the address of the mapper data pointer. The address is
451241794f19SSteven Rostedt (VMware)  * returned for use cases where the data is no bigger than a long, and
451341794f19SSteven Rostedt (VMware)  * the user can use the data pointer as its data instead of having to
451441794f19SSteven Rostedt (VMware)  * allocate more memory for the reference.
451541794f19SSteven Rostedt (VMware)  */
451641794f19SSteven Rostedt (VMware) void **ftrace_func_mapper_find_ip(struct ftrace_func_mapper *mapper,
451741794f19SSteven Rostedt (VMware) 				  unsigned long ip)
451841794f19SSteven Rostedt (VMware) {
451941794f19SSteven Rostedt (VMware) 	struct ftrace_func_entry *entry;
452041794f19SSteven Rostedt (VMware) 	struct ftrace_func_map *map;
452141794f19SSteven Rostedt (VMware) 
452241794f19SSteven Rostedt (VMware) 	entry = ftrace_lookup_ip(&mapper->hash, ip);
452341794f19SSteven Rostedt (VMware) 	if (!entry)
452441794f19SSteven Rostedt (VMware) 		return NULL;
452541794f19SSteven Rostedt (VMware) 
452641794f19SSteven Rostedt (VMware) 	map = (struct ftrace_func_map *)entry;
452741794f19SSteven Rostedt (VMware) 	return &map->data;
4528e1df4cb6SSteven Rostedt (Red Hat) }
452945a4a237SSteven Rostedt 
453041794f19SSteven Rostedt (VMware) /**
453141794f19SSteven Rostedt (VMware)  * ftrace_func_mapper_add_ip - Map some data to an ip
453241794f19SSteven Rostedt (VMware)  * @mapper: The mapper that has the ip maps
453341794f19SSteven Rostedt (VMware)  * @ip: The instruction pointer address to map @data to
453441794f19SSteven Rostedt (VMware)  * @data: The data to map to @ip
453541794f19SSteven Rostedt (VMware)  *
4536fdda88d3SQiujun Huang  * Returns 0 on success otherwise an error.
453741794f19SSteven Rostedt (VMware)  */
453841794f19SSteven Rostedt (VMware) int ftrace_func_mapper_add_ip(struct ftrace_func_mapper *mapper,
453941794f19SSteven Rostedt (VMware) 			      unsigned long ip, void *data)
454041794f19SSteven Rostedt (VMware) {
454141794f19SSteven Rostedt (VMware) 	struct ftrace_func_entry *entry;
454241794f19SSteven Rostedt (VMware) 	struct ftrace_func_map *map;
454341794f19SSteven Rostedt (VMware) 
454441794f19SSteven Rostedt (VMware) 	entry = ftrace_lookup_ip(&mapper->hash, ip);
454541794f19SSteven Rostedt (VMware) 	if (entry)
454641794f19SSteven Rostedt (VMware) 		return -EBUSY;
454741794f19SSteven Rostedt (VMware) 
454841794f19SSteven Rostedt (VMware) 	map = kmalloc(sizeof(*map), GFP_KERNEL);
454941794f19SSteven Rostedt (VMware) 	if (!map)
455041794f19SSteven Rostedt (VMware) 		return -ENOMEM;
455141794f19SSteven Rostedt (VMware) 
455241794f19SSteven Rostedt (VMware) 	map->entry.ip = ip;
455341794f19SSteven Rostedt (VMware) 	map->data = data;
455441794f19SSteven Rostedt (VMware) 
455541794f19SSteven Rostedt (VMware) 	__add_hash_entry(&mapper->hash, &map->entry);
455641794f19SSteven Rostedt (VMware) 
455741794f19SSteven Rostedt (VMware) 	return 0;
455841794f19SSteven Rostedt (VMware) }
455941794f19SSteven Rostedt (VMware) 
456041794f19SSteven Rostedt (VMware) /**
456141794f19SSteven Rostedt (VMware)  * ftrace_func_mapper_remove_ip - Remove an ip from the mapping
456241794f19SSteven Rostedt (VMware)  * @mapper: The mapper that has the ip maps
456341794f19SSteven Rostedt (VMware)  * @ip: The instruction pointer address to remove the data from
456441794f19SSteven Rostedt (VMware)  *
456541794f19SSteven Rostedt (VMware)  * Returns the data if it is found, otherwise NULL.
456641794f19SSteven Rostedt (VMware)  * Note, if the data pointer is used as the data itself, (see
456741794f19SSteven Rostedt (VMware)  * ftrace_func_mapper_find_ip(), then the return value may be meaningless,
456841794f19SSteven Rostedt (VMware)  * if the data pointer was set to zero.
456941794f19SSteven Rostedt (VMware)  */
457041794f19SSteven Rostedt (VMware) void *ftrace_func_mapper_remove_ip(struct ftrace_func_mapper *mapper,
457141794f19SSteven Rostedt (VMware) 				   unsigned long ip)
457241794f19SSteven Rostedt (VMware) {
457341794f19SSteven Rostedt (VMware) 	struct ftrace_func_entry *entry;
457441794f19SSteven Rostedt (VMware) 	struct ftrace_func_map *map;
457541794f19SSteven Rostedt (VMware) 	void *data;
457641794f19SSteven Rostedt (VMware) 
457741794f19SSteven Rostedt (VMware) 	entry = ftrace_lookup_ip(&mapper->hash, ip);
457841794f19SSteven Rostedt (VMware) 	if (!entry)
457941794f19SSteven Rostedt (VMware) 		return NULL;
458041794f19SSteven Rostedt (VMware) 
458141794f19SSteven Rostedt (VMware) 	map = (struct ftrace_func_map *)entry;
458241794f19SSteven Rostedt (VMware) 	data = map->data;
458341794f19SSteven Rostedt (VMware) 
458441794f19SSteven Rostedt (VMware) 	remove_hash_entry(&mapper->hash, entry);
458541794f19SSteven Rostedt (VMware) 	kfree(entry);
458641794f19SSteven Rostedt (VMware) 
458741794f19SSteven Rostedt (VMware) 	return data;
458841794f19SSteven Rostedt (VMware) }
458941794f19SSteven Rostedt (VMware) 
459041794f19SSteven Rostedt (VMware) /**
459141794f19SSteven Rostedt (VMware)  * free_ftrace_func_mapper - free a mapping of ips and data
459241794f19SSteven Rostedt (VMware)  * @mapper: The mapper that has the ip maps
459341794f19SSteven Rostedt (VMware)  * @free_func: A function to be called on each data item.
459441794f19SSteven Rostedt (VMware)  *
459541794f19SSteven Rostedt (VMware)  * This is used to free the function mapper. The @free_func is optional
459641794f19SSteven Rostedt (VMware)  * and can be used if the data needs to be freed as well.
459741794f19SSteven Rostedt (VMware)  */
459841794f19SSteven Rostedt (VMware) void free_ftrace_func_mapper(struct ftrace_func_mapper *mapper,
459941794f19SSteven Rostedt (VMware) 			     ftrace_mapper_func free_func)
460041794f19SSteven Rostedt (VMware) {
460141794f19SSteven Rostedt (VMware) 	struct ftrace_func_entry *entry;
460241794f19SSteven Rostedt (VMware) 	struct ftrace_func_map *map;
460341794f19SSteven Rostedt (VMware) 	struct hlist_head *hhd;
460404e03d9aSWei Li 	int size, i;
460504e03d9aSWei Li 
460604e03d9aSWei Li 	if (!mapper)
460704e03d9aSWei Li 		return;
460841794f19SSteven Rostedt (VMware) 
460941794f19SSteven Rostedt (VMware) 	if (free_func && mapper->hash.count) {
461004e03d9aSWei Li 		size = 1 << mapper->hash.size_bits;
461141794f19SSteven Rostedt (VMware) 		for (i = 0; i < size; i++) {
461241794f19SSteven Rostedt (VMware) 			hhd = &mapper->hash.buckets[i];
461341794f19SSteven Rostedt (VMware) 			hlist_for_each_entry(entry, hhd, hlist) {
461441794f19SSteven Rostedt (VMware) 				map = (struct ftrace_func_map *)entry;
461541794f19SSteven Rostedt (VMware) 				free_func(map);
461641794f19SSteven Rostedt (VMware) 			}
461741794f19SSteven Rostedt (VMware) 		}
461841794f19SSteven Rostedt (VMware) 	}
461941794f19SSteven Rostedt (VMware) 	free_ftrace_hash(&mapper->hash);
462041794f19SSteven Rostedt (VMware) }
462141794f19SSteven Rostedt (VMware) 
46227b60f3d8SSteven Rostedt (VMware) static void release_probe(struct ftrace_func_probe *probe)
46237b60f3d8SSteven Rostedt (VMware) {
46247b60f3d8SSteven Rostedt (VMware) 	struct ftrace_probe_ops *probe_ops;
46257b60f3d8SSteven Rostedt (VMware) 
46265ae0bf59SSteven Rostedt (Red Hat) 	mutex_lock(&ftrace_lock);
46275ae0bf59SSteven Rostedt (Red Hat) 
46287b60f3d8SSteven Rostedt (VMware) 	WARN_ON(probe->ref <= 0);
462959df055fSSteven Rostedt 
46307b60f3d8SSteven Rostedt (VMware) 	/* Subtract the ref that was used to protect this instance */
46317b60f3d8SSteven Rostedt (VMware) 	probe->ref--;
4632546fece4SSteven Rostedt (Red Hat) 
46337b60f3d8SSteven Rostedt (VMware) 	if (!probe->ref) {
46347b60f3d8SSteven Rostedt (VMware) 		probe_ops = probe->probe_ops;
46356e444319SSteven Rostedt (VMware) 		/*
46366e444319SSteven Rostedt (VMware) 		 * Sending zero as ip tells probe_ops to free
46376e444319SSteven Rostedt (VMware) 		 * the probe->data itself
46386e444319SSteven Rostedt (VMware) 		 */
46396e444319SSteven Rostedt (VMware) 		if (probe_ops->free)
46406e444319SSteven Rostedt (VMware) 			probe_ops->free(probe_ops, probe->tr, 0, probe->data);
46417b60f3d8SSteven Rostedt (VMware) 		list_del(&probe->list);
46427b60f3d8SSteven Rostedt (VMware) 		kfree(probe);
46437b60f3d8SSteven Rostedt (VMware) 	}
46447b60f3d8SSteven Rostedt (VMware) 	mutex_unlock(&ftrace_lock);
464559df055fSSteven Rostedt }
464659df055fSSteven Rostedt 
46477b60f3d8SSteven Rostedt (VMware) static void acquire_probe_locked(struct ftrace_func_probe *probe)
46487b60f3d8SSteven Rostedt (VMware) {
46497b60f3d8SSteven Rostedt (VMware) 	/*
46507b60f3d8SSteven Rostedt (VMware) 	 * Add one ref to keep it from being freed when releasing the
46517b60f3d8SSteven Rostedt (VMware) 	 * ftrace_lock mutex.
46527b60f3d8SSteven Rostedt (VMware) 	 */
46537b60f3d8SSteven Rostedt (VMware) 	probe->ref++;
46547b60f3d8SSteven Rostedt (VMware) }
465559df055fSSteven Rostedt 
465659df055fSSteven Rostedt int
465704ec7bb6SSteven Rostedt (VMware) register_ftrace_function_probe(char *glob, struct trace_array *tr,
46587b60f3d8SSteven Rostedt (VMware) 			       struct ftrace_probe_ops *probe_ops,
46597b60f3d8SSteven Rostedt (VMware) 			       void *data)
466059df055fSSteven Rostedt {
4661ba27d855SJakob Koschel 	struct ftrace_func_probe *probe = NULL, *iter;
46621ec3a81aSSteven Rostedt (VMware) 	struct ftrace_func_entry *entry;
46631ec3a81aSSteven Rostedt (VMware) 	struct ftrace_hash **orig_hash;
46641ec3a81aSSteven Rostedt (VMware) 	struct ftrace_hash *old_hash;
466559df055fSSteven Rostedt 	struct ftrace_hash *hash;
466659df055fSSteven Rostedt 	int count = 0;
46671ec3a81aSSteven Rostedt (VMware) 	int size;
466859df055fSSteven Rostedt 	int ret;
46691ec3a81aSSteven Rostedt (VMware) 	int i;
467059df055fSSteven Rostedt 
467104ec7bb6SSteven Rostedt (VMware) 	if (WARN_ON(!tr))
467204ec7bb6SSteven Rostedt (VMware) 		return -EINVAL;
467304ec7bb6SSteven Rostedt (VMware) 
46741ec3a81aSSteven Rostedt (VMware) 	/* We do not support '!' for function probes */
46751ec3a81aSSteven Rostedt (VMware) 	if (WARN_ON(glob[0] == '!'))
467659df055fSSteven Rostedt 		return -EINVAL;
467759df055fSSteven Rostedt 
46787b60f3d8SSteven Rostedt (VMware) 
46797b60f3d8SSteven Rostedt (VMware) 	mutex_lock(&ftrace_lock);
46807b60f3d8SSteven Rostedt (VMware) 	/* Check if the probe_ops is already registered */
4681ba27d855SJakob Koschel 	list_for_each_entry(iter, &tr->func_probes, list) {
4682ba27d855SJakob Koschel 		if (iter->probe_ops == probe_ops) {
4683ba27d855SJakob Koschel 			probe = iter;
46847b60f3d8SSteven Rostedt (VMware) 			break;
46857b60f3d8SSteven Rostedt (VMware) 		}
4686ba27d855SJakob Koschel 	}
4687ba27d855SJakob Koschel 	if (!probe) {
46887b60f3d8SSteven Rostedt (VMware) 		probe = kzalloc(sizeof(*probe), GFP_KERNEL);
46897b60f3d8SSteven Rostedt (VMware) 		if (!probe) {
46907b60f3d8SSteven Rostedt (VMware) 			mutex_unlock(&ftrace_lock);
46917b60f3d8SSteven Rostedt (VMware) 			return -ENOMEM;
46927b60f3d8SSteven Rostedt (VMware) 		}
46937b60f3d8SSteven Rostedt (VMware) 		probe->probe_ops = probe_ops;
46947b60f3d8SSteven Rostedt (VMware) 		probe->ops.func = function_trace_probe_call;
46957b60f3d8SSteven Rostedt (VMware) 		probe->tr = tr;
46967b60f3d8SSteven Rostedt (VMware) 		ftrace_ops_init(&probe->ops);
46977b60f3d8SSteven Rostedt (VMware) 		list_add(&probe->list, &tr->func_probes);
46981ec3a81aSSteven Rostedt (VMware) 	}
469959df055fSSteven Rostedt 
47007b60f3d8SSteven Rostedt (VMware) 	acquire_probe_locked(probe);
470159df055fSSteven Rostedt 
47027b60f3d8SSteven Rostedt (VMware) 	mutex_unlock(&ftrace_lock);
47037b60f3d8SSteven Rostedt (VMware) 
4704372e0d01SSteven Rostedt (VMware) 	/*
4705372e0d01SSteven Rostedt (VMware) 	 * Note, there's a small window here that the func_hash->filter_hash
4706fdda88d3SQiujun Huang 	 * may be NULL or empty. Need to be careful when reading the loop.
4707372e0d01SSteven Rostedt (VMware) 	 */
47087b60f3d8SSteven Rostedt (VMware) 	mutex_lock(&probe->ops.func_hash->regex_lock);
47097b60f3d8SSteven Rostedt (VMware) 
47107b60f3d8SSteven Rostedt (VMware) 	orig_hash = &probe->ops.func_hash->filter_hash;
47111ec3a81aSSteven Rostedt (VMware) 	old_hash = *orig_hash;
471259df055fSSteven Rostedt 	hash = alloc_and_copy_ftrace_hash(FTRACE_HASH_DEFAULT_BITS, old_hash);
47131ec3a81aSSteven Rostedt (VMware) 
47145b0022ddSNaveen N. Rao 	if (!hash) {
47155b0022ddSNaveen N. Rao 		ret = -ENOMEM;
47165b0022ddSNaveen N. Rao 		goto out;
47175b0022ddSNaveen N. Rao 	}
47185b0022ddSNaveen N. Rao 
47191ec3a81aSSteven Rostedt (VMware) 	ret = ftrace_match_records(hash, glob, strlen(glob));
47201ec3a81aSSteven Rostedt (VMware) 
47211ec3a81aSSteven Rostedt (VMware) 	/* Nothing found? */
47221ec3a81aSSteven Rostedt (VMware) 	if (!ret)
47231ec3a81aSSteven Rostedt (VMware) 		ret = -EINVAL;
47241ec3a81aSSteven Rostedt (VMware) 
47251ec3a81aSSteven Rostedt (VMware) 	if (ret < 0)
472659df055fSSteven Rostedt 		goto out;
472759df055fSSteven Rostedt 
47281ec3a81aSSteven Rostedt (VMware) 	size = 1 << hash->size_bits;
47291ec3a81aSSteven Rostedt (VMware) 	for (i = 0; i < size; i++) {
47301ec3a81aSSteven Rostedt (VMware) 		hlist_for_each_entry(entry, &hash->buckets[i], hlist) {
47311ec3a81aSSteven Rostedt (VMware) 			if (ftrace_lookup_ip(old_hash, entry->ip))
473259df055fSSteven Rostedt 				continue;
473359df055fSSteven Rostedt 			/*
473459df055fSSteven Rostedt 			 * The caller might want to do something special
473559df055fSSteven Rostedt 			 * for each function we find. We call the callback
473659df055fSSteven Rostedt 			 * to give the caller an opportunity to do so.
473759df055fSSteven Rostedt 			 */
47387b60f3d8SSteven Rostedt (VMware) 			if (probe_ops->init) {
47397b60f3d8SSteven Rostedt (VMware) 				ret = probe_ops->init(probe_ops, tr,
47406e444319SSteven Rostedt (VMware) 						      entry->ip, data,
47416e444319SSteven Rostedt (VMware) 						      &probe->data);
47426e444319SSteven Rostedt (VMware) 				if (ret < 0) {
47436e444319SSteven Rostedt (VMware) 					if (probe_ops->free && count)
47446e444319SSteven Rostedt (VMware) 						probe_ops->free(probe_ops, tr,
47456e444319SSteven Rostedt (VMware) 								0, probe->data);
47466e444319SSteven Rostedt (VMware) 					probe->data = NULL;
4747eee8ded1SSteven Rostedt (VMware) 					goto out;
47481ec3a81aSSteven Rostedt (VMware) 				}
47496e444319SSteven Rostedt (VMware) 			}
47501ec3a81aSSteven Rostedt (VMware) 			count++;
475159df055fSSteven Rostedt 		}
475259df055fSSteven Rostedt 	}
475359df055fSSteven Rostedt 
47541ec3a81aSSteven Rostedt (VMware) 	mutex_lock(&ftrace_lock);
47551ec3a81aSSteven Rostedt (VMware) 
47567b60f3d8SSteven Rostedt (VMware) 	if (!count) {
47577b60f3d8SSteven Rostedt (VMware) 		/* Nothing was added? */
47587b60f3d8SSteven Rostedt (VMware) 		ret = -EINVAL;
4759e1df4cb6SSteven Rostedt (Red Hat) 		goto out_unlock;
4760e1df4cb6SSteven Rostedt (Red Hat) 	}
4761e1df4cb6SSteven Rostedt (Red Hat) 
47627b60f3d8SSteven Rostedt (VMware) 	ret = ftrace_hash_move_and_update_ops(&probe->ops, orig_hash,
47631ec3a81aSSteven Rostedt (VMware) 					      hash, 1);
47641ec3a81aSSteven Rostedt (VMware) 	if (ret < 0)
47658d70725eSSteven Rostedt (VMware) 		goto err_unlock;
476659df055fSSteven Rostedt 
47677b60f3d8SSteven Rostedt (VMware) 	/* One ref for each new function traced */
47687b60f3d8SSteven Rostedt (VMware) 	probe->ref += count;
476959df055fSSteven Rostedt 
47707b60f3d8SSteven Rostedt (VMware) 	if (!(probe->ops.flags & FTRACE_OPS_FL_ENABLED))
47717b60f3d8SSteven Rostedt (VMware) 		ret = ftrace_startup(&probe->ops, 0);
4772e1df4cb6SSteven Rostedt (Red Hat) 
477359df055fSSteven Rostedt  out_unlock:
47745ae0bf59SSteven Rostedt (Red Hat) 	mutex_unlock(&ftrace_lock);
477559df055fSSteven Rostedt 
477659df055fSSteven Rostedt 	if (!ret)
47771ec3a81aSSteven Rostedt (VMware) 		ret = count;
47785ae0bf59SSteven Rostedt (Red Hat)  out:
47797b60f3d8SSteven Rostedt (VMware) 	mutex_unlock(&probe->ops.func_hash->regex_lock);
4780e1df4cb6SSteven Rostedt (Red Hat) 	free_ftrace_hash(hash);
478159df055fSSteven Rostedt 
47827b60f3d8SSteven Rostedt (VMware) 	release_probe(probe);
47837b60f3d8SSteven Rostedt (VMware) 
47841ec3a81aSSteven Rostedt (VMware) 	return ret;
47858d70725eSSteven Rostedt (VMware) 
47868d70725eSSteven Rostedt (VMware)  err_unlock:
47877b60f3d8SSteven Rostedt (VMware) 	if (!probe_ops->free || !count)
47888d70725eSSteven Rostedt (VMware) 		goto out_unlock;
47898d70725eSSteven Rostedt (VMware) 
47908d70725eSSteven Rostedt (VMware) 	/* Failed to do the move, need to call the free functions */
47918d70725eSSteven Rostedt (VMware) 	for (i = 0; i < size; i++) {
47928d70725eSSteven Rostedt (VMware) 		hlist_for_each_entry(entry, &hash->buckets[i], hlist) {
47938d70725eSSteven Rostedt (VMware) 			if (ftrace_lookup_ip(old_hash, entry->ip))
47948d70725eSSteven Rostedt (VMware) 				continue;
47956e444319SSteven Rostedt (VMware) 			probe_ops->free(probe_ops, tr, entry->ip, probe->data);
47968d70725eSSteven Rostedt (VMware) 		}
47978d70725eSSteven Rostedt (VMware) 	}
47988d70725eSSteven Rostedt (VMware) 	goto out_unlock;
479959df055fSSteven Rostedt }
480059df055fSSteven Rostedt 
4801d3d532d7SSteven Rostedt (VMware) int
48027b60f3d8SSteven Rostedt (VMware) unregister_ftrace_function_probe_func(char *glob, struct trace_array *tr,
48037b60f3d8SSteven Rostedt (VMware) 				      struct ftrace_probe_ops *probe_ops)
480459df055fSSteven Rostedt {
4805ba27d855SJakob Koschel 	struct ftrace_func_probe *probe = NULL, *iter;
480682cc4fc2SSteven Rostedt (VMware) 	struct ftrace_ops_hash old_hash_ops;
4807eee8ded1SSteven Rostedt (VMware) 	struct ftrace_func_entry *entry;
48083ba00929SDmitry Safonov 	struct ftrace_glob func_g;
48091ec3a81aSSteven Rostedt (VMware) 	struct ftrace_hash **orig_hash;
48101ec3a81aSSteven Rostedt (VMware) 	struct ftrace_hash *old_hash;
48111ec3a81aSSteven Rostedt (VMware) 	struct ftrace_hash *hash = NULL;
4812b67bfe0dSSasha Levin 	struct hlist_node *tmp;
4813eee8ded1SSteven Rostedt (VMware) 	struct hlist_head hhd;
481459df055fSSteven Rostedt 	char str[KSYM_SYMBOL_LEN];
48157b60f3d8SSteven Rostedt (VMware) 	int count = 0;
48167b60f3d8SSteven Rostedt (VMware) 	int i, ret = -ENODEV;
4817eee8ded1SSteven Rostedt (VMware) 	int size;
481859df055fSSteven Rostedt 
4819cbab567cSNaveen N. Rao 	if (!glob || !strlen(glob) || !strcmp(glob, "*"))
48203ba00929SDmitry Safonov 		func_g.search = NULL;
4821cbab567cSNaveen N. Rao 	else {
482259df055fSSteven Rostedt 		int not;
482359df055fSSteven Rostedt 
48243ba00929SDmitry Safonov 		func_g.type = filter_parse_regex(glob, strlen(glob),
48253ba00929SDmitry Safonov 						 &func_g.search, &not);
48263ba00929SDmitry Safonov 		func_g.len = strlen(func_g.search);
482759df055fSSteven Rostedt 
4828b6887d79SSteven Rostedt 		/* we do not support '!' for function probes */
482959df055fSSteven Rostedt 		if (WARN_ON(not))
4830d3d532d7SSteven Rostedt (VMware) 			return -EINVAL;
483159df055fSSteven Rostedt 	}
483259df055fSSteven Rostedt 
48337b60f3d8SSteven Rostedt (VMware) 	mutex_lock(&ftrace_lock);
48347b60f3d8SSteven Rostedt (VMware) 	/* Check if the probe_ops is already registered */
4835ba27d855SJakob Koschel 	list_for_each_entry(iter, &tr->func_probes, list) {
4836ba27d855SJakob Koschel 		if (iter->probe_ops == probe_ops) {
4837ba27d855SJakob Koschel 			probe = iter;
48387b60f3d8SSteven Rostedt (VMware) 			break;
48397b60f3d8SSteven Rostedt (VMware) 		}
4840ba27d855SJakob Koschel 	}
4841ba27d855SJakob Koschel 	if (!probe)
48427b60f3d8SSteven Rostedt (VMware) 		goto err_unlock_ftrace;
48431ec3a81aSSteven Rostedt (VMware) 
48441ec3a81aSSteven Rostedt (VMware) 	ret = -EINVAL;
48457b60f3d8SSteven Rostedt (VMware) 	if (!(probe->ops.flags & FTRACE_OPS_FL_INITIALIZED))
48467b60f3d8SSteven Rostedt (VMware) 		goto err_unlock_ftrace;
48477b60f3d8SSteven Rostedt (VMware) 
48487b60f3d8SSteven Rostedt (VMware) 	acquire_probe_locked(probe);
48497b60f3d8SSteven Rostedt (VMware) 
48507b60f3d8SSteven Rostedt (VMware) 	mutex_unlock(&ftrace_lock);
48517b60f3d8SSteven Rostedt (VMware) 
48527b60f3d8SSteven Rostedt (VMware) 	mutex_lock(&probe->ops.func_hash->regex_lock);
48537b60f3d8SSteven Rostedt (VMware) 
48547b60f3d8SSteven Rostedt (VMware) 	orig_hash = &probe->ops.func_hash->filter_hash;
48557b60f3d8SSteven Rostedt (VMware) 	old_hash = *orig_hash;
48567b60f3d8SSteven Rostedt (VMware) 
48571ec3a81aSSteven Rostedt (VMware) 	if (ftrace_hash_empty(old_hash))
48581ec3a81aSSteven Rostedt (VMware) 		goto out_unlock;
4859e1df4cb6SSteven Rostedt (Red Hat) 
486082cc4fc2SSteven Rostedt (VMware) 	old_hash_ops.filter_hash = old_hash;
486182cc4fc2SSteven Rostedt (VMware) 	/* Probes only have filters */
486282cc4fc2SSteven Rostedt (VMware) 	old_hash_ops.notrace_hash = NULL;
486382cc4fc2SSteven Rostedt (VMware) 
4864d3d532d7SSteven Rostedt (VMware) 	ret = -ENOMEM;
48651ec3a81aSSteven Rostedt (VMware) 	hash = alloc_and_copy_ftrace_hash(FTRACE_HASH_DEFAULT_BITS, old_hash);
4866e1df4cb6SSteven Rostedt (Red Hat) 	if (!hash)
4867e1df4cb6SSteven Rostedt (Red Hat) 		goto out_unlock;
4868e1df4cb6SSteven Rostedt (Red Hat) 
4869eee8ded1SSteven Rostedt (VMware) 	INIT_HLIST_HEAD(&hhd);
48707818b388SSteven Rostedt (Red Hat) 
4871eee8ded1SSteven Rostedt (VMware) 	size = 1 << hash->size_bits;
4872eee8ded1SSteven Rostedt (VMware) 	for (i = 0; i < size; i++) {
4873eee8ded1SSteven Rostedt (VMware) 		hlist_for_each_entry_safe(entry, tmp, &hash->buckets[i], hlist) {
487459df055fSSteven Rostedt 
48753ba00929SDmitry Safonov 			if (func_g.search) {
487659df055fSSteven Rostedt 				kallsyms_lookup(entry->ip, NULL, NULL,
487759df055fSSteven Rostedt 						NULL, str);
48783ba00929SDmitry Safonov 				if (!ftrace_match(str, &func_g))
487959df055fSSteven Rostedt 					continue;
488059df055fSSteven Rostedt 			}
48817b60f3d8SSteven Rostedt (VMware) 			count++;
4882eee8ded1SSteven Rostedt (VMware) 			remove_hash_entry(hash, entry);
4883eee8ded1SSteven Rostedt (VMware) 			hlist_add_head(&entry->hlist, &hhd);
488459df055fSSteven Rostedt 		}
488559df055fSSteven Rostedt 	}
4886d3d532d7SSteven Rostedt (VMware) 
4887d3d532d7SSteven Rostedt (VMware) 	/* Nothing found? */
48887b60f3d8SSteven Rostedt (VMware) 	if (!count) {
4889d3d532d7SSteven Rostedt (VMware) 		ret = -EINVAL;
4890d3d532d7SSteven Rostedt (VMware) 		goto out_unlock;
4891d3d532d7SSteven Rostedt (VMware) 	}
4892d3d532d7SSteven Rostedt (VMware) 
48933f2367baSMasami Hiramatsu 	mutex_lock(&ftrace_lock);
48941ec3a81aSSteven Rostedt (VMware) 
48957b60f3d8SSteven Rostedt (VMware) 	WARN_ON(probe->ref < count);
4896eee8ded1SSteven Rostedt (VMware) 
48977b60f3d8SSteven Rostedt (VMware) 	probe->ref -= count;
48981ec3a81aSSteven Rostedt (VMware) 
48997b60f3d8SSteven Rostedt (VMware) 	if (ftrace_hash_empty(hash))
49007b60f3d8SSteven Rostedt (VMware) 		ftrace_shutdown(&probe->ops, 0);
49017b60f3d8SSteven Rostedt (VMware) 
49027b60f3d8SSteven Rostedt (VMware) 	ret = ftrace_hash_move_and_update_ops(&probe->ops, orig_hash,
49031ec3a81aSSteven Rostedt (VMware) 					      hash, 1);
490482cc4fc2SSteven Rostedt (VMware) 
490582cc4fc2SSteven Rostedt (VMware) 	/* still need to update the function call sites */
49061ec3a81aSSteven Rostedt (VMware) 	if (ftrace_enabled && !ftrace_hash_empty(hash))
49077b60f3d8SSteven Rostedt (VMware) 		ftrace_run_modify_code(&probe->ops, FTRACE_UPDATE_CALLS,
490882cc4fc2SSteven Rostedt (VMware) 				       &old_hash_ops);
490974401729SPaul E. McKenney 	synchronize_rcu();
49103296fc4eSSteven Rostedt (Red Hat) 
4911eee8ded1SSteven Rostedt (VMware) 	hlist_for_each_entry_safe(entry, tmp, &hhd, hlist) {
4912eee8ded1SSteven Rostedt (VMware) 		hlist_del(&entry->hlist);
49137b60f3d8SSteven Rostedt (VMware) 		if (probe_ops->free)
49146e444319SSteven Rostedt (VMware) 			probe_ops->free(probe_ops, tr, entry->ip, probe->data);
4915eee8ded1SSteven Rostedt (VMware) 		kfree(entry);
49167818b388SSteven Rostedt (Red Hat) 	}
49173f2367baSMasami Hiramatsu 	mutex_unlock(&ftrace_lock);
49187818b388SSteven Rostedt (Red Hat) 
4919e1df4cb6SSteven Rostedt (Red Hat)  out_unlock:
49207b60f3d8SSteven Rostedt (VMware) 	mutex_unlock(&probe->ops.func_hash->regex_lock);
4921e1df4cb6SSteven Rostedt (Red Hat) 	free_ftrace_hash(hash);
492259df055fSSteven Rostedt 
49237b60f3d8SSteven Rostedt (VMware) 	release_probe(probe);
492459df055fSSteven Rostedt 
49257b60f3d8SSteven Rostedt (VMware) 	return ret;
492659df055fSSteven Rostedt 
49277b60f3d8SSteven Rostedt (VMware)  err_unlock_ftrace:
49287b60f3d8SSteven Rostedt (VMware) 	mutex_unlock(&ftrace_lock);
4929d3d532d7SSteven Rostedt (VMware) 	return ret;
493059df055fSSteven Rostedt }
493159df055fSSteven Rostedt 
4932a0e6369eSNaveen N. Rao void clear_ftrace_function_probes(struct trace_array *tr)
4933a0e6369eSNaveen N. Rao {
4934a0e6369eSNaveen N. Rao 	struct ftrace_func_probe *probe, *n;
4935a0e6369eSNaveen N. Rao 
4936a0e6369eSNaveen N. Rao 	list_for_each_entry_safe(probe, n, &tr->func_probes, list)
4937a0e6369eSNaveen N. Rao 		unregister_ftrace_function_probe_func(NULL, tr, probe->probe_ops);
4938a0e6369eSNaveen N. Rao }
4939a0e6369eSNaveen N. Rao 
4940f6180773SSteven Rostedt static LIST_HEAD(ftrace_commands);
4941f6180773SSteven Rostedt static DEFINE_MUTEX(ftrace_cmd_mutex);
4942f6180773SSteven Rostedt 
494338de93abSTom Zanussi /*
494438de93abSTom Zanussi  * Currently we only register ftrace commands from __init, so mark this
494538de93abSTom Zanussi  * __init too.
494638de93abSTom Zanussi  */
494738de93abSTom Zanussi __init int register_ftrace_command(struct ftrace_func_command *cmd)
4948f6180773SSteven Rostedt {
4949f6180773SSteven Rostedt 	struct ftrace_func_command *p;
4950f6180773SSteven Rostedt 	int ret = 0;
4951f6180773SSteven Rostedt 
4952f6180773SSteven Rostedt 	mutex_lock(&ftrace_cmd_mutex);
4953f6180773SSteven Rostedt 	list_for_each_entry(p, &ftrace_commands, list) {
4954f6180773SSteven Rostedt 		if (strcmp(cmd->name, p->name) == 0) {
4955f6180773SSteven Rostedt 			ret = -EBUSY;
4956f6180773SSteven Rostedt 			goto out_unlock;
4957f6180773SSteven Rostedt 		}
4958f6180773SSteven Rostedt 	}
4959f6180773SSteven Rostedt 	list_add(&cmd->list, &ftrace_commands);
4960f6180773SSteven Rostedt  out_unlock:
4961f6180773SSteven Rostedt 	mutex_unlock(&ftrace_cmd_mutex);
4962f6180773SSteven Rostedt 
4963f6180773SSteven Rostedt 	return ret;
4964f6180773SSteven Rostedt }
4965f6180773SSteven Rostedt 
496638de93abSTom Zanussi /*
496738de93abSTom Zanussi  * Currently we only unregister ftrace commands from __init, so mark
496838de93abSTom Zanussi  * this __init too.
496938de93abSTom Zanussi  */
497038de93abSTom Zanussi __init int unregister_ftrace_command(struct ftrace_func_command *cmd)
4971f6180773SSteven Rostedt {
4972f6180773SSteven Rostedt 	struct ftrace_func_command *p, *n;
4973f6180773SSteven Rostedt 	int ret = -ENODEV;
4974f6180773SSteven Rostedt 
4975f6180773SSteven Rostedt 	mutex_lock(&ftrace_cmd_mutex);
4976f6180773SSteven Rostedt 	list_for_each_entry_safe(p, n, &ftrace_commands, list) {
4977f6180773SSteven Rostedt 		if (strcmp(cmd->name, p->name) == 0) {
4978f6180773SSteven Rostedt 			ret = 0;
4979f6180773SSteven Rostedt 			list_del_init(&p->list);
4980f6180773SSteven Rostedt 			goto out_unlock;
4981f6180773SSteven Rostedt 		}
4982f6180773SSteven Rostedt 	}
4983f6180773SSteven Rostedt  out_unlock:
4984f6180773SSteven Rostedt 	mutex_unlock(&ftrace_cmd_mutex);
4985f6180773SSteven Rostedt 
4986f6180773SSteven Rostedt 	return ret;
4987f6180773SSteven Rostedt }
4988f6180773SSteven Rostedt 
498904ec7bb6SSteven Rostedt (VMware) static int ftrace_process_regex(struct ftrace_iterator *iter,
499033dc9b12SSteven Rostedt 				char *buff, int len, int enable)
499164e7c440SSteven Rostedt {
499204ec7bb6SSteven Rostedt (VMware) 	struct ftrace_hash *hash = iter->hash;
4993d2afd57aSSteven Rostedt (VMware) 	struct trace_array *tr = iter->ops->private;
4994f6180773SSteven Rostedt 	char *func, *command, *next = buff;
49956a24a244SSteven Rostedt 	struct ftrace_func_command *p;
49960aff1c0cSGuoWen Li 	int ret = -EINVAL;
499764e7c440SSteven Rostedt 
499864e7c440SSteven Rostedt 	func = strsep(&next, ":");
499964e7c440SSteven Rostedt 
500064e7c440SSteven Rostedt 	if (!next) {
50011cf41dd7SSteven Rostedt 		ret = ftrace_match_records(hash, func, len);
5002b448c4e3SSteven Rostedt 		if (!ret)
5003b448c4e3SSteven Rostedt 			ret = -EINVAL;
5004b448c4e3SSteven Rostedt 		if (ret < 0)
5005311d16daSLi Zefan 			return ret;
5006b448c4e3SSteven Rostedt 		return 0;
500764e7c440SSteven Rostedt 	}
500864e7c440SSteven Rostedt 
5009f6180773SSteven Rostedt 	/* command found */
501064e7c440SSteven Rostedt 
501164e7c440SSteven Rostedt 	command = strsep(&next, ":");
501264e7c440SSteven Rostedt 
5013f6180773SSteven Rostedt 	mutex_lock(&ftrace_cmd_mutex);
5014f6180773SSteven Rostedt 	list_for_each_entry(p, &ftrace_commands, list) {
5015f6180773SSteven Rostedt 		if (strcmp(p->name, command) == 0) {
501604ec7bb6SSteven Rostedt (VMware) 			ret = p->func(tr, hash, func, command, next, enable);
5017f6180773SSteven Rostedt 			goto out_unlock;
501864e7c440SSteven Rostedt 		}
5019f6180773SSteven Rostedt 	}
5020f6180773SSteven Rostedt  out_unlock:
5021f6180773SSteven Rostedt 	mutex_unlock(&ftrace_cmd_mutex);
502264e7c440SSteven Rostedt 
5023f6180773SSteven Rostedt 	return ret;
502464e7c440SSteven Rostedt }
502564e7c440SSteven Rostedt 
5026e309b41dSIngo Molnar static ssize_t
502741c52c0dSSteven Rostedt ftrace_regex_write(struct file *file, const char __user *ubuf,
502841c52c0dSSteven Rostedt 		   size_t cnt, loff_t *ppos, int enable)
50295072c59fSSteven Rostedt {
50305072c59fSSteven Rostedt 	struct ftrace_iterator *iter;
5031689fd8b6S[email protected] 	struct trace_parser *parser;
5032689fd8b6S[email protected] 	ssize_t ret, read;
50335072c59fSSteven Rostedt 
50344ba7978eSLi Zefan 	if (!cnt)
50355072c59fSSteven Rostedt 		return 0;
50365072c59fSSteven Rostedt 
50375072c59fSSteven Rostedt 	if (file->f_mode & FMODE_READ) {
50385072c59fSSteven Rostedt 		struct seq_file *m = file->private_data;
50395072c59fSSteven Rostedt 		iter = m->private;
50405072c59fSSteven Rostedt 	} else
50415072c59fSSteven Rostedt 		iter = file->private_data;
50425072c59fSSteven Rostedt 
5043f04f24fbSMasami Hiramatsu 	if (unlikely(ftrace_disabled))
50443f2367baSMasami Hiramatsu 		return -ENODEV;
50453f2367baSMasami Hiramatsu 
50463f2367baSMasami Hiramatsu 	/* iter->hash is a local copy, so we don't need regex_lock */
5047f04f24fbSMasami Hiramatsu 
5048689fd8b6S[email protected] 	parser = &iter->parser;
5049689fd8b6S[email protected] 	read = trace_get_user(parser, ubuf, cnt, ppos);
50505072c59fSSteven Rostedt 
50514ba7978eSLi Zefan 	if (read >= 0 && trace_parser_loaded(parser) &&
5052689fd8b6S[email protected] 	    !trace_parser_cont(parser)) {
505304ec7bb6SSteven Rostedt (VMware) 		ret = ftrace_process_regex(iter, parser->buffer,
5054689fd8b6S[email protected] 					   parser->idx, enable);
5055313254a9SLi Zefan 		trace_parser_clear(parser);
50567c088b51SSteven Rostedt (Red Hat) 		if (ret < 0)
50573f2367baSMasami Hiramatsu 			goto out;
50585072c59fSSteven Rostedt 	}
50595072c59fSSteven Rostedt 
50605072c59fSSteven Rostedt 	ret = read;
50613f2367baSMasami Hiramatsu  out:
50625072c59fSSteven Rostedt 	return ret;
50635072c59fSSteven Rostedt }
50645072c59fSSteven Rostedt 
5065fc13cb0cSSteven Rostedt ssize_t
506641c52c0dSSteven Rostedt ftrace_filter_write(struct file *file, const char __user *ubuf,
506741c52c0dSSteven Rostedt 		    size_t cnt, loff_t *ppos)
506841c52c0dSSteven Rostedt {
506941c52c0dSSteven Rostedt 	return ftrace_regex_write(file, ubuf, cnt, ppos, 1);
507041c52c0dSSteven Rostedt }
507141c52c0dSSteven Rostedt 
5072fc13cb0cSSteven Rostedt ssize_t
507341c52c0dSSteven Rostedt ftrace_notrace_write(struct file *file, const char __user *ubuf,
507441c52c0dSSteven Rostedt 		     size_t cnt, loff_t *ppos)
507541c52c0dSSteven Rostedt {
507641c52c0dSSteven Rostedt 	return ftrace_regex_write(file, ubuf, cnt, ppos, 0);
507741c52c0dSSteven Rostedt }
507841c52c0dSSteven Rostedt 
507933dc9b12SSteven Rostedt static int
50804f554e95SJiri Olsa __ftrace_match_addr(struct ftrace_hash *hash, unsigned long ip, int remove)
5081647664eaSMasami Hiramatsu {
5082647664eaSMasami Hiramatsu 	struct ftrace_func_entry *entry;
5083647664eaSMasami Hiramatsu 
5084aebfd125SPeter Zijlstra 	ip = ftrace_location(ip);
5085aebfd125SPeter Zijlstra 	if (!ip)
5086647664eaSMasami Hiramatsu 		return -EINVAL;
5087647664eaSMasami Hiramatsu 
5088647664eaSMasami Hiramatsu 	if (remove) {
5089647664eaSMasami Hiramatsu 		entry = ftrace_lookup_ip(hash, ip);
5090647664eaSMasami Hiramatsu 		if (!entry)
5091647664eaSMasami Hiramatsu 			return -ENOENT;
5092647664eaSMasami Hiramatsu 		free_hash_entry(hash, entry);
5093647664eaSMasami Hiramatsu 		return 0;
5094647664eaSMasami Hiramatsu 	}
5095647664eaSMasami Hiramatsu 
5096647664eaSMasami Hiramatsu 	return add_hash_entry(hash, ip);
5097647664eaSMasami Hiramatsu }
5098647664eaSMasami Hiramatsu 
5099647664eaSMasami Hiramatsu static int
51004f554e95SJiri Olsa ftrace_match_addr(struct ftrace_hash *hash, unsigned long *ips,
51014f554e95SJiri Olsa 		  unsigned int cnt, int remove)
51024f554e95SJiri Olsa {
51034f554e95SJiri Olsa 	unsigned int i;
51044f554e95SJiri Olsa 	int err;
51054f554e95SJiri Olsa 
51064f554e95SJiri Olsa 	for (i = 0; i < cnt; i++) {
51074f554e95SJiri Olsa 		err = __ftrace_match_addr(hash, ips[i], remove);
51084f554e95SJiri Olsa 		if (err) {
51094f554e95SJiri Olsa 			/*
51104f554e95SJiri Olsa 			 * This expects the @hash is a temporary hash and if this
51114f554e95SJiri Olsa 			 * fails the caller must free the @hash.
51124f554e95SJiri Olsa 			 */
51134f554e95SJiri Olsa 			return err;
51144f554e95SJiri Olsa 		}
51154f554e95SJiri Olsa 	}
51164f554e95SJiri Olsa 	return 0;
51174f554e95SJiri Olsa }
51184f554e95SJiri Olsa 
51194f554e95SJiri Olsa static int
5120647664eaSMasami Hiramatsu ftrace_set_hash(struct ftrace_ops *ops, unsigned char *buf, int len,
51214f554e95SJiri Olsa 		unsigned long *ips, unsigned int cnt,
51224f554e95SJiri Olsa 		int remove, int reset, int enable)
512341c52c0dSSteven Rostedt {
512433dc9b12SSteven Rostedt 	struct ftrace_hash **orig_hash;
5125f45948e8SSteven Rostedt 	struct ftrace_hash *hash;
512633dc9b12SSteven Rostedt 	int ret;
5127f45948e8SSteven Rostedt 
512841c52c0dSSteven Rostedt 	if (unlikely(ftrace_disabled))
512933dc9b12SSteven Rostedt 		return -ENODEV;
513041c52c0dSSteven Rostedt 
513133b7f99cSSteven Rostedt (Red Hat) 	mutex_lock(&ops->func_hash->regex_lock);
51323f2367baSMasami Hiramatsu 
5133f45948e8SSteven Rostedt 	if (enable)
513433b7f99cSSteven Rostedt (Red Hat) 		orig_hash = &ops->func_hash->filter_hash;
5135f45948e8SSteven Rostedt 	else
513633b7f99cSSteven Rostedt (Red Hat) 		orig_hash = &ops->func_hash->notrace_hash;
513733dc9b12SSteven Rostedt 
5138b972cc58SWang Nan 	if (reset)
5139b972cc58SWang Nan 		hash = alloc_ftrace_hash(FTRACE_HASH_DEFAULT_BITS);
5140b972cc58SWang Nan 	else
514133dc9b12SSteven Rostedt 		hash = alloc_and_copy_ftrace_hash(FTRACE_HASH_DEFAULT_BITS, *orig_hash);
5142b972cc58SWang Nan 
51433f2367baSMasami Hiramatsu 	if (!hash) {
51443f2367baSMasami Hiramatsu 		ret = -ENOMEM;
51453f2367baSMasami Hiramatsu 		goto out_regex_unlock;
51463f2367baSMasami Hiramatsu 	}
5147f45948e8SSteven Rostedt 
5148ac483c44SJiri Olsa 	if (buf && !ftrace_match_records(hash, buf, len)) {
5149ac483c44SJiri Olsa 		ret = -EINVAL;
5150ac483c44SJiri Olsa 		goto out_regex_unlock;
5151ac483c44SJiri Olsa 	}
51524f554e95SJiri Olsa 	if (ips) {
51534f554e95SJiri Olsa 		ret = ftrace_match_addr(hash, ips, cnt, remove);
5154647664eaSMasami Hiramatsu 		if (ret < 0)
5155647664eaSMasami Hiramatsu 			goto out_regex_unlock;
5156647664eaSMasami Hiramatsu 	}
515733dc9b12SSteven Rostedt 
515833dc9b12SSteven Rostedt 	mutex_lock(&ftrace_lock);
5159e16b35ddSSteven Rostedt (VMware) 	ret = ftrace_hash_move_and_update_ops(ops, orig_hash, hash, enable);
516033dc9b12SSteven Rostedt 	mutex_unlock(&ftrace_lock);
516133dc9b12SSteven Rostedt 
5162ac483c44SJiri Olsa  out_regex_unlock:
516333b7f99cSSteven Rostedt (Red Hat) 	mutex_unlock(&ops->func_hash->regex_lock);
516433dc9b12SSteven Rostedt 
516533dc9b12SSteven Rostedt 	free_ftrace_hash(hash);
516633dc9b12SSteven Rostedt 	return ret;
516741c52c0dSSteven Rostedt }
516841c52c0dSSteven Rostedt 
5169647664eaSMasami Hiramatsu static int
51704f554e95SJiri Olsa ftrace_set_addr(struct ftrace_ops *ops, unsigned long *ips, unsigned int cnt,
51714f554e95SJiri Olsa 		int remove, int reset, int enable)
5172647664eaSMasami Hiramatsu {
51734f554e95SJiri Olsa 	return ftrace_set_hash(ops, NULL, 0, ips, cnt, remove, reset, enable);
5174647664eaSMasami Hiramatsu }
5175647664eaSMasami Hiramatsu 
5176763e34e7SSteven Rostedt (VMware) #ifdef CONFIG_DYNAMIC_FTRACE_WITH_DIRECT_CALLS
5177013bf0daSSteven Rostedt (VMware) 
5178013bf0daSSteven Rostedt (VMware) struct ftrace_direct_func {
5179013bf0daSSteven Rostedt (VMware) 	struct list_head	next;
5180013bf0daSSteven Rostedt (VMware) 	unsigned long		addr;
5181013bf0daSSteven Rostedt (VMware) 	int			count;
5182013bf0daSSteven Rostedt (VMware) };
5183013bf0daSSteven Rostedt (VMware) 
5184013bf0daSSteven Rostedt (VMware) static LIST_HEAD(ftrace_direct_funcs);
5185013bf0daSSteven Rostedt (VMware) 
5186013bf0daSSteven Rostedt (VMware) /**
5187013bf0daSSteven Rostedt (VMware)  * ftrace_find_direct_func - test an address if it is a registered direct caller
5188013bf0daSSteven Rostedt (VMware)  * @addr: The address of a registered direct caller
5189013bf0daSSteven Rostedt (VMware)  *
5190013bf0daSSteven Rostedt (VMware)  * This searches to see if a ftrace direct caller has been registered
5191013bf0daSSteven Rostedt (VMware)  * at a specific address, and if so, it returns a descriptor for it.
5192013bf0daSSteven Rostedt (VMware)  *
5193013bf0daSSteven Rostedt (VMware)  * This can be used by architecture code to see if an address is
5194013bf0daSSteven Rostedt (VMware)  * a direct caller (trampoline) attached to a fentry/mcount location.
5195013bf0daSSteven Rostedt (VMware)  * This is useful for the function_graph tracer, as it may need to
5196013bf0daSSteven Rostedt (VMware)  * do adjustments if it traced a location that also has a direct
5197013bf0daSSteven Rostedt (VMware)  * trampoline attached to it.
5198013bf0daSSteven Rostedt (VMware)  */
5199013bf0daSSteven Rostedt (VMware) struct ftrace_direct_func *ftrace_find_direct_func(unsigned long addr)
5200013bf0daSSteven Rostedt (VMware) {
5201013bf0daSSteven Rostedt (VMware) 	struct ftrace_direct_func *entry;
5202013bf0daSSteven Rostedt (VMware) 	bool found = false;
5203013bf0daSSteven Rostedt (VMware) 
5204013bf0daSSteven Rostedt (VMware) 	/* May be called by fgraph trampoline (protected by rcu tasks) */
5205013bf0daSSteven Rostedt (VMware) 	list_for_each_entry_rcu(entry, &ftrace_direct_funcs, next) {
5206013bf0daSSteven Rostedt (VMware) 		if (entry->addr == addr) {
5207013bf0daSSteven Rostedt (VMware) 			found = true;
5208013bf0daSSteven Rostedt (VMware) 			break;
5209013bf0daSSteven Rostedt (VMware) 		}
5210013bf0daSSteven Rostedt (VMware) 	}
5211013bf0daSSteven Rostedt (VMware) 	if (found)
5212013bf0daSSteven Rostedt (VMware) 		return entry;
5213013bf0daSSteven Rostedt (VMware) 
5214013bf0daSSteven Rostedt (VMware) 	return NULL;
5215013bf0daSSteven Rostedt (VMware) }
5216013bf0daSSteven Rostedt (VMware) 
52178a141dd7SAlexei Starovoitov static struct ftrace_direct_func *ftrace_alloc_direct_func(unsigned long addr)
52188a141dd7SAlexei Starovoitov {
52198a141dd7SAlexei Starovoitov 	struct ftrace_direct_func *direct;
52208a141dd7SAlexei Starovoitov 
52218a141dd7SAlexei Starovoitov 	direct = kmalloc(sizeof(*direct), GFP_KERNEL);
52228a141dd7SAlexei Starovoitov 	if (!direct)
52238a141dd7SAlexei Starovoitov 		return NULL;
52248a141dd7SAlexei Starovoitov 	direct->addr = addr;
52258a141dd7SAlexei Starovoitov 	direct->count = 0;
52268a141dd7SAlexei Starovoitov 	list_add_rcu(&direct->next, &ftrace_direct_funcs);
52278a141dd7SAlexei Starovoitov 	ftrace_direct_func_count++;
52288a141dd7SAlexei Starovoitov 	return direct;
52298a141dd7SAlexei Starovoitov }
52308a141dd7SAlexei Starovoitov 
523153cd885bSSong Liu static int register_ftrace_function_nolock(struct ftrace_ops *ops);
523253cd885bSSong Liu 
5233763e34e7SSteven Rostedt (VMware) /**
5234763e34e7SSteven Rostedt (VMware)  * register_ftrace_direct - Call a custom trampoline directly
5235763e34e7SSteven Rostedt (VMware)  * @ip: The address of the nop at the beginning of a function
5236763e34e7SSteven Rostedt (VMware)  * @addr: The address of the trampoline to call at @ip
5237763e34e7SSteven Rostedt (VMware)  *
5238763e34e7SSteven Rostedt (VMware)  * This is used to connect a direct call from the nop location (@ip)
5239763e34e7SSteven Rostedt (VMware)  * at the start of ftrace traced functions. The location that it calls
5240763e34e7SSteven Rostedt (VMware)  * (@addr) must be able to handle a direct call, and save the parameters
5241763e34e7SSteven Rostedt (VMware)  * of the function being traced, and restore them (or inject new ones
5242763e34e7SSteven Rostedt (VMware)  * if needed), before returning.
5243763e34e7SSteven Rostedt (VMware)  *
5244763e34e7SSteven Rostedt (VMware)  * Returns:
5245763e34e7SSteven Rostedt (VMware)  *  0 on success
5246763e34e7SSteven Rostedt (VMware)  *  -EBUSY - Another direct function is already attached (there can be only one)
5247763e34e7SSteven Rostedt (VMware)  *  -ENODEV - @ip does not point to a ftrace nop location (or not supported)
5248763e34e7SSteven Rostedt (VMware)  *  -ENOMEM - There was an allocation failure.
5249763e34e7SSteven Rostedt (VMware)  */
5250763e34e7SSteven Rostedt (VMware) int register_ftrace_direct(unsigned long ip, unsigned long addr)
5251763e34e7SSteven Rostedt (VMware) {
5252013bf0daSSteven Rostedt (VMware) 	struct ftrace_direct_func *direct;
5253763e34e7SSteven Rostedt (VMware) 	struct ftrace_func_entry *entry;
5254763e34e7SSteven Rostedt (VMware) 	struct ftrace_hash *free_hash = NULL;
5255763e34e7SSteven Rostedt (VMware) 	struct dyn_ftrace *rec;
5256aebfd125SPeter Zijlstra 	int ret = -ENODEV;
5257763e34e7SSteven Rostedt (VMware) 
5258763e34e7SSteven Rostedt (VMware) 	mutex_lock(&direct_mutex);
5259763e34e7SSteven Rostedt (VMware) 
5260aebfd125SPeter Zijlstra 	ip = ftrace_location(ip);
5261aebfd125SPeter Zijlstra 	if (!ip)
5262aebfd125SPeter Zijlstra 		goto out_unlock;
5263aebfd125SPeter Zijlstra 
5264763e34e7SSteven Rostedt (VMware) 	/* See if there's a direct function at @ip already */
5265aebfd125SPeter Zijlstra 	ret = -EBUSY;
5266ff205766SAlexei Starovoitov 	if (ftrace_find_rec_direct(ip))
5267763e34e7SSteven Rostedt (VMware) 		goto out_unlock;
5268763e34e7SSteven Rostedt (VMware) 
5269763e34e7SSteven Rostedt (VMware) 	ret = -ENODEV;
5270763e34e7SSteven Rostedt (VMware) 	rec = lookup_rec(ip, ip);
5271763e34e7SSteven Rostedt (VMware) 	if (!rec)
5272763e34e7SSteven Rostedt (VMware) 		goto out_unlock;
5273763e34e7SSteven Rostedt (VMware) 
5274763e34e7SSteven Rostedt (VMware) 	/*
5275763e34e7SSteven Rostedt (VMware) 	 * Check if the rec says it has a direct call but we didn't
5276763e34e7SSteven Rostedt (VMware) 	 * find one earlier?
5277763e34e7SSteven Rostedt (VMware) 	 */
5278763e34e7SSteven Rostedt (VMware) 	if (WARN_ON(rec->flags & FTRACE_FL_DIRECT))
5279763e34e7SSteven Rostedt (VMware) 		goto out_unlock;
5280763e34e7SSteven Rostedt (VMware) 
5281763e34e7SSteven Rostedt (VMware) 	/* Make sure the ip points to the exact record */
5282406acdd3SSteven Rostedt (VMware) 	if (ip != rec->ip) {
5283763e34e7SSteven Rostedt (VMware) 		ip = rec->ip;
5284406acdd3SSteven Rostedt (VMware) 		/* Need to check this ip for a direct. */
5285ff205766SAlexei Starovoitov 		if (ftrace_find_rec_direct(ip))
5286406acdd3SSteven Rostedt (VMware) 			goto out_unlock;
5287406acdd3SSteven Rostedt (VMware) 	}
5288763e34e7SSteven Rostedt (VMware) 
5289763e34e7SSteven Rostedt (VMware) 	ret = -ENOMEM;
5290013bf0daSSteven Rostedt (VMware) 	direct = ftrace_find_direct_func(addr);
5291013bf0daSSteven Rostedt (VMware) 	if (!direct) {
52928a141dd7SAlexei Starovoitov 		direct = ftrace_alloc_direct_func(addr);
52931904a814SJiri Olsa 		if (!direct)
5294013bf0daSSteven Rostedt (VMware) 			goto out_unlock;
5295013bf0daSSteven Rostedt (VMware) 	}
5296013bf0daSSteven Rostedt (VMware) 
52971904a814SJiri Olsa 	entry = ftrace_add_rec_direct(ip, addr, &free_hash);
52981904a814SJiri Olsa 	if (!entry)
52991904a814SJiri Olsa 		goto out_unlock;
5300763e34e7SSteven Rostedt (VMware) 
5301763e34e7SSteven Rostedt (VMware) 	ret = ftrace_set_filter_ip(&direct_ops, ip, 0, 0);
5302763e34e7SSteven Rostedt (VMware) 
5303763e34e7SSteven Rostedt (VMware) 	if (!ret && !(direct_ops.flags & FTRACE_OPS_FL_ENABLED)) {
530453cd885bSSong Liu 		ret = register_ftrace_function_nolock(&direct_ops);
5305763e34e7SSteven Rostedt (VMware) 		if (ret)
5306763e34e7SSteven Rostedt (VMware) 			ftrace_set_filter_ip(&direct_ops, ip, 1, 0);
5307763e34e7SSteven Rostedt (VMware) 	}
5308763e34e7SSteven Rostedt (VMware) 
5309013bf0daSSteven Rostedt (VMware) 	if (ret) {
53107d54c15cSSong Liu 		remove_hash_entry(direct_functions, entry);
5311763e34e7SSteven Rostedt (VMware) 		kfree(entry);
5312013bf0daSSteven Rostedt (VMware) 		if (!direct->count) {
5313013bf0daSSteven Rostedt (VMware) 			list_del_rcu(&direct->next);
5314013bf0daSSteven Rostedt (VMware) 			synchronize_rcu_tasks();
5315013bf0daSSteven Rostedt (VMware) 			kfree(direct);
5316013bf0daSSteven Rostedt (VMware) 			if (free_hash)
5317013bf0daSSteven Rostedt (VMware) 				free_ftrace_hash(free_hash);
5318013bf0daSSteven Rostedt (VMware) 			free_hash = NULL;
5319a3ad1a7eSSteven Rostedt (VMware) 			ftrace_direct_func_count--;
5320013bf0daSSteven Rostedt (VMware) 		}
5321013bf0daSSteven Rostedt (VMware) 	} else {
5322013bf0daSSteven Rostedt (VMware) 		direct->count++;
5323013bf0daSSteven Rostedt (VMware) 	}
5324763e34e7SSteven Rostedt (VMware)  out_unlock:
5325763e34e7SSteven Rostedt (VMware) 	mutex_unlock(&direct_mutex);
5326763e34e7SSteven Rostedt (VMware) 
5327763e34e7SSteven Rostedt (VMware) 	if (free_hash) {
5328763e34e7SSteven Rostedt (VMware) 		synchronize_rcu_tasks();
5329763e34e7SSteven Rostedt (VMware) 		free_ftrace_hash(free_hash);
5330763e34e7SSteven Rostedt (VMware) 	}
5331763e34e7SSteven Rostedt (VMware) 
5332763e34e7SSteven Rostedt (VMware) 	return ret;
5333763e34e7SSteven Rostedt (VMware) }
5334763e34e7SSteven Rostedt (VMware) EXPORT_SYMBOL_GPL(register_ftrace_direct);
5335763e34e7SSteven Rostedt (VMware) 
5336ea806eb3SSteven Rostedt (VMware) static struct ftrace_func_entry *find_direct_entry(unsigned long *ip,
5337ea806eb3SSteven Rostedt (VMware) 						   struct dyn_ftrace **recp)
5338763e34e7SSteven Rostedt (VMware) {
5339763e34e7SSteven Rostedt (VMware) 	struct ftrace_func_entry *entry;
5340763e34e7SSteven Rostedt (VMware) 	struct dyn_ftrace *rec;
5341763e34e7SSteven Rostedt (VMware) 
5342128161f4SSteven Rostedt (VMware) 	rec = lookup_rec(*ip, *ip);
5343128161f4SSteven Rostedt (VMware) 	if (!rec)
5344128161f4SSteven Rostedt (VMware) 		return NULL;
5345763e34e7SSteven Rostedt (VMware) 
5346763e34e7SSteven Rostedt (VMware) 	entry = __ftrace_lookup_ip(direct_functions, rec->ip);
5347763e34e7SSteven Rostedt (VMware) 	if (!entry) {
5348763e34e7SSteven Rostedt (VMware) 		WARN_ON(rec->flags & FTRACE_FL_DIRECT);
5349128161f4SSteven Rostedt (VMware) 		return NULL;
5350763e34e7SSteven Rostedt (VMware) 	}
5351763e34e7SSteven Rostedt (VMware) 
5352763e34e7SSteven Rostedt (VMware) 	WARN_ON(!(rec->flags & FTRACE_FL_DIRECT));
5353128161f4SSteven Rostedt (VMware) 
5354128161f4SSteven Rostedt (VMware) 	/* Passed in ip just needs to be on the call site */
5355128161f4SSteven Rostedt (VMware) 	*ip = rec->ip;
5356128161f4SSteven Rostedt (VMware) 
5357ea806eb3SSteven Rostedt (VMware) 	if (recp)
5358ea806eb3SSteven Rostedt (VMware) 		*recp = rec;
5359ea806eb3SSteven Rostedt (VMware) 
5360128161f4SSteven Rostedt (VMware) 	return entry;
5361763e34e7SSteven Rostedt (VMware) }
5362763e34e7SSteven Rostedt (VMware) 
5363128161f4SSteven Rostedt (VMware) int unregister_ftrace_direct(unsigned long ip, unsigned long addr)
5364128161f4SSteven Rostedt (VMware) {
5365128161f4SSteven Rostedt (VMware) 	struct ftrace_direct_func *direct;
5366128161f4SSteven Rostedt (VMware) 	struct ftrace_func_entry *entry;
53677d5b7cadSJiri Olsa 	struct ftrace_hash *hash;
5368128161f4SSteven Rostedt (VMware) 	int ret = -ENODEV;
5369128161f4SSteven Rostedt (VMware) 
5370128161f4SSteven Rostedt (VMware) 	mutex_lock(&direct_mutex);
5371128161f4SSteven Rostedt (VMware) 
5372aebfd125SPeter Zijlstra 	ip = ftrace_location(ip);
5373aebfd125SPeter Zijlstra 	if (!ip)
5374aebfd125SPeter Zijlstra 		goto out_unlock;
5375aebfd125SPeter Zijlstra 
5376ea806eb3SSteven Rostedt (VMware) 	entry = find_direct_entry(&ip, NULL);
5377128161f4SSteven Rostedt (VMware) 	if (!entry)
5378128161f4SSteven Rostedt (VMware) 		goto out_unlock;
5379128161f4SSteven Rostedt (VMware) 
53807d5b7cadSJiri Olsa 	hash = direct_ops.func_hash->filter_hash;
53817d5b7cadSJiri Olsa 	if (hash->count == 1)
5382763e34e7SSteven Rostedt (VMware) 		unregister_ftrace_function(&direct_ops);
5383763e34e7SSteven Rostedt (VMware) 
5384763e34e7SSteven Rostedt (VMware) 	ret = ftrace_set_filter_ip(&direct_ops, ip, 1, 0);
5385763e34e7SSteven Rostedt (VMware) 
5386763e34e7SSteven Rostedt (VMware) 	WARN_ON(ret);
5387763e34e7SSteven Rostedt (VMware) 
5388763e34e7SSteven Rostedt (VMware) 	remove_hash_entry(direct_functions, entry);
5389763e34e7SSteven Rostedt (VMware) 
5390013bf0daSSteven Rostedt (VMware) 	direct = ftrace_find_direct_func(addr);
5391013bf0daSSteven Rostedt (VMware) 	if (!WARN_ON(!direct)) {
5392013bf0daSSteven Rostedt (VMware) 		/* This is the good path (see the ! before WARN) */
5393013bf0daSSteven Rostedt (VMware) 		direct->count--;
5394013bf0daSSteven Rostedt (VMware) 		WARN_ON(direct->count < 0);
5395013bf0daSSteven Rostedt (VMware) 		if (!direct->count) {
5396013bf0daSSteven Rostedt (VMware) 			list_del_rcu(&direct->next);
5397013bf0daSSteven Rostedt (VMware) 			synchronize_rcu_tasks();
5398013bf0daSSteven Rostedt (VMware) 			kfree(direct);
5399353da879SSteven Rostedt (VMware) 			kfree(entry);
5400a3ad1a7eSSteven Rostedt (VMware) 			ftrace_direct_func_count--;
5401013bf0daSSteven Rostedt (VMware) 		}
5402013bf0daSSteven Rostedt (VMware) 	}
5403763e34e7SSteven Rostedt (VMware)  out_unlock:
5404763e34e7SSteven Rostedt (VMware) 	mutex_unlock(&direct_mutex);
5405763e34e7SSteven Rostedt (VMware) 
5406763e34e7SSteven Rostedt (VMware) 	return ret;
5407763e34e7SSteven Rostedt (VMware) }
5408763e34e7SSteven Rostedt (VMware) EXPORT_SYMBOL_GPL(unregister_ftrace_direct);
54090567d680SSteven Rostedt (VMware) 
54100567d680SSteven Rostedt (VMware) static struct ftrace_ops stub_ops = {
54110567d680SSteven Rostedt (VMware) 	.func		= ftrace_stub,
54120567d680SSteven Rostedt (VMware) };
54130567d680SSteven Rostedt (VMware) 
54140567d680SSteven Rostedt (VMware) /**
5415ea806eb3SSteven Rostedt (VMware)  * ftrace_modify_direct_caller - modify ftrace nop directly
5416ea806eb3SSteven Rostedt (VMware)  * @entry: The ftrace hash entry of the direct helper for @rec
5417ea806eb3SSteven Rostedt (VMware)  * @rec: The record representing the function site to patch
5418ea806eb3SSteven Rostedt (VMware)  * @old_addr: The location that the site at @rec->ip currently calls
5419ea806eb3SSteven Rostedt (VMware)  * @new_addr: The location that the site at @rec->ip should call
5420ea806eb3SSteven Rostedt (VMware)  *
5421ea806eb3SSteven Rostedt (VMware)  * An architecture may overwrite this function to optimize the
5422ea806eb3SSteven Rostedt (VMware)  * changing of the direct callback on an ftrace nop location.
5423ea806eb3SSteven Rostedt (VMware)  * This is called with the ftrace_lock mutex held, and no other
5424ea806eb3SSteven Rostedt (VMware)  * ftrace callbacks are on the associated record (@rec). Thus,
5425ea806eb3SSteven Rostedt (VMware)  * it is safe to modify the ftrace record, where it should be
5426ea806eb3SSteven Rostedt (VMware)  * currently calling @old_addr directly, to call @new_addr.
5427ea806eb3SSteven Rostedt (VMware)  *
54289d2ce78dSSong Liu  * This is called with direct_mutex locked.
54299d2ce78dSSong Liu  *
5430ea806eb3SSteven Rostedt (VMware)  * Safety checks should be made to make sure that the code at
5431ea806eb3SSteven Rostedt (VMware)  * @rec->ip is currently calling @old_addr. And this must
5432ea806eb3SSteven Rostedt (VMware)  * also update entry->direct to @new_addr.
5433ea806eb3SSteven Rostedt (VMware)  */
5434ea806eb3SSteven Rostedt (VMware) int __weak ftrace_modify_direct_caller(struct ftrace_func_entry *entry,
5435ea806eb3SSteven Rostedt (VMware) 				       struct dyn_ftrace *rec,
5436ea806eb3SSteven Rostedt (VMware) 				       unsigned long old_addr,
5437ea806eb3SSteven Rostedt (VMware) 				       unsigned long new_addr)
5438ea806eb3SSteven Rostedt (VMware) {
5439ea806eb3SSteven Rostedt (VMware) 	unsigned long ip = rec->ip;
5440ea806eb3SSteven Rostedt (VMware) 	int ret;
5441ea806eb3SSteven Rostedt (VMware) 
54429d2ce78dSSong Liu 	lockdep_assert_held(&direct_mutex);
54439d2ce78dSSong Liu 
5444ea806eb3SSteven Rostedt (VMware) 	/*
5445ea806eb3SSteven Rostedt (VMware) 	 * The ftrace_lock was used to determine if the record
5446ea806eb3SSteven Rostedt (VMware) 	 * had more than one registered user to it. If it did,
5447ea806eb3SSteven Rostedt (VMware) 	 * we needed to prevent that from changing to do the quick
5448ea806eb3SSteven Rostedt (VMware) 	 * switch. But if it did not (only a direct caller was attached)
5449ea806eb3SSteven Rostedt (VMware) 	 * then this function is called. But this function can deal
5450ea806eb3SSteven Rostedt (VMware) 	 * with attached callers to the rec that we care about, and
5451ea806eb3SSteven Rostedt (VMware) 	 * since this function uses standard ftrace calls that take
5452ea806eb3SSteven Rostedt (VMware) 	 * the ftrace_lock mutex, we need to release it.
5453ea806eb3SSteven Rostedt (VMware) 	 */
5454ea806eb3SSteven Rostedt (VMware) 	mutex_unlock(&ftrace_lock);
5455ea806eb3SSteven Rostedt (VMware) 
5456ea806eb3SSteven Rostedt (VMware) 	/*
5457ea806eb3SSteven Rostedt (VMware) 	 * By setting a stub function at the same address, we force
5458ea806eb3SSteven Rostedt (VMware) 	 * the code to call the iterator and the direct_ops helper.
5459ea806eb3SSteven Rostedt (VMware) 	 * This means that @ip does not call the direct call, and
5460ea806eb3SSteven Rostedt (VMware) 	 * we can simply modify it.
5461ea806eb3SSteven Rostedt (VMware) 	 */
5462ea806eb3SSteven Rostedt (VMware) 	ret = ftrace_set_filter_ip(&stub_ops, ip, 0, 0);
5463ea806eb3SSteven Rostedt (VMware) 	if (ret)
5464ea806eb3SSteven Rostedt (VMware) 		goto out_lock;
5465ea806eb3SSteven Rostedt (VMware) 
54669d2ce78dSSong Liu 	ret = register_ftrace_function_nolock(&stub_ops);
5467ea806eb3SSteven Rostedt (VMware) 	if (ret) {
5468ea806eb3SSteven Rostedt (VMware) 		ftrace_set_filter_ip(&stub_ops, ip, 1, 0);
5469ea806eb3SSteven Rostedt (VMware) 		goto out_lock;
5470ea806eb3SSteven Rostedt (VMware) 	}
5471ea806eb3SSteven Rostedt (VMware) 
5472ea806eb3SSteven Rostedt (VMware) 	entry->direct = new_addr;
5473ea806eb3SSteven Rostedt (VMware) 
5474ea806eb3SSteven Rostedt (VMware) 	/*
5475ea806eb3SSteven Rostedt (VMware) 	 * By removing the stub, we put back the direct call, calling
5476ea806eb3SSteven Rostedt (VMware) 	 * the @new_addr.
5477ea806eb3SSteven Rostedt (VMware) 	 */
5478ea806eb3SSteven Rostedt (VMware) 	unregister_ftrace_function(&stub_ops);
5479ea806eb3SSteven Rostedt (VMware) 	ftrace_set_filter_ip(&stub_ops, ip, 1, 0);
5480ea806eb3SSteven Rostedt (VMware) 
5481ea806eb3SSteven Rostedt (VMware)  out_lock:
5482ea806eb3SSteven Rostedt (VMware) 	mutex_lock(&ftrace_lock);
5483ea806eb3SSteven Rostedt (VMware) 
5484ea806eb3SSteven Rostedt (VMware) 	return ret;
5485ea806eb3SSteven Rostedt (VMware) }
5486ea806eb3SSteven Rostedt (VMware) 
5487ea806eb3SSteven Rostedt (VMware) /**
54880567d680SSteven Rostedt (VMware)  * modify_ftrace_direct - Modify an existing direct call to call something else
54890567d680SSteven Rostedt (VMware)  * @ip: The instruction pointer to modify
54900567d680SSteven Rostedt (VMware)  * @old_addr: The address that the current @ip calls directly
54910567d680SSteven Rostedt (VMware)  * @new_addr: The address that the @ip should call
54920567d680SSteven Rostedt (VMware)  *
54930567d680SSteven Rostedt (VMware)  * This modifies a ftrace direct caller at an instruction pointer without
54940567d680SSteven Rostedt (VMware)  * having to disable it first. The direct call will switch over to the
54950567d680SSteven Rostedt (VMware)  * @new_addr without missing anything.
54960567d680SSteven Rostedt (VMware)  *
54970567d680SSteven Rostedt (VMware)  * Returns: zero on success. Non zero on error, which includes:
54980567d680SSteven Rostedt (VMware)  *  -ENODEV : the @ip given has no direct caller attached
54990567d680SSteven Rostedt (VMware)  *  -EINVAL : the @old_addr does not match the current direct caller
55000567d680SSteven Rostedt (VMware)  */
55010567d680SSteven Rostedt (VMware) int modify_ftrace_direct(unsigned long ip,
55020567d680SSteven Rostedt (VMware) 			 unsigned long old_addr, unsigned long new_addr)
55030567d680SSteven Rostedt (VMware) {
55048a141dd7SAlexei Starovoitov 	struct ftrace_direct_func *direct, *new_direct = NULL;
55050567d680SSteven Rostedt (VMware) 	struct ftrace_func_entry *entry;
5506ea806eb3SSteven Rostedt (VMware) 	struct dyn_ftrace *rec;
55070567d680SSteven Rostedt (VMware) 	int ret = -ENODEV;
55080567d680SSteven Rostedt (VMware) 
55090567d680SSteven Rostedt (VMware) 	mutex_lock(&direct_mutex);
55100567d680SSteven Rostedt (VMware) 
5511ea806eb3SSteven Rostedt (VMware) 	mutex_lock(&ftrace_lock);
5512aebfd125SPeter Zijlstra 
5513aebfd125SPeter Zijlstra 	ip = ftrace_location(ip);
5514aebfd125SPeter Zijlstra 	if (!ip)
5515aebfd125SPeter Zijlstra 		goto out_unlock;
5516aebfd125SPeter Zijlstra 
5517ea806eb3SSteven Rostedt (VMware) 	entry = find_direct_entry(&ip, &rec);
55180567d680SSteven Rostedt (VMware) 	if (!entry)
55190567d680SSteven Rostedt (VMware) 		goto out_unlock;
55200567d680SSteven Rostedt (VMware) 
55210567d680SSteven Rostedt (VMware) 	ret = -EINVAL;
55220567d680SSteven Rostedt (VMware) 	if (entry->direct != old_addr)
55230567d680SSteven Rostedt (VMware) 		goto out_unlock;
55240567d680SSteven Rostedt (VMware) 
55258a141dd7SAlexei Starovoitov 	direct = ftrace_find_direct_func(old_addr);
55268a141dd7SAlexei Starovoitov 	if (WARN_ON(!direct))
55278a141dd7SAlexei Starovoitov 		goto out_unlock;
55288a141dd7SAlexei Starovoitov 	if (direct->count > 1) {
55298a141dd7SAlexei Starovoitov 		ret = -ENOMEM;
55308a141dd7SAlexei Starovoitov 		new_direct = ftrace_alloc_direct_func(new_addr);
55318a141dd7SAlexei Starovoitov 		if (!new_direct)
55328a141dd7SAlexei Starovoitov 			goto out_unlock;
55338a141dd7SAlexei Starovoitov 		direct->count--;
55348a141dd7SAlexei Starovoitov 		new_direct->count++;
55358a141dd7SAlexei Starovoitov 	} else {
55368a141dd7SAlexei Starovoitov 		direct->addr = new_addr;
55378a141dd7SAlexei Starovoitov 	}
55388a141dd7SAlexei Starovoitov 
55390567d680SSteven Rostedt (VMware) 	/*
5540ea806eb3SSteven Rostedt (VMware) 	 * If there's no other ftrace callback on the rec->ip location,
5541ea806eb3SSteven Rostedt (VMware) 	 * then it can be changed directly by the architecture.
5542ea806eb3SSteven Rostedt (VMware) 	 * If there is another caller, then we just need to change the
5543ea806eb3SSteven Rostedt (VMware) 	 * direct caller helper to point to @new_addr.
55440567d680SSteven Rostedt (VMware) 	 */
5545ea806eb3SSteven Rostedt (VMware) 	if (ftrace_rec_count(rec) == 1) {
5546ea806eb3SSteven Rostedt (VMware) 		ret = ftrace_modify_direct_caller(entry, rec, old_addr, new_addr);
5547ea806eb3SSteven Rostedt (VMware) 	} else {
5548ea806eb3SSteven Rostedt (VMware) 		entry->direct = new_addr;
5549ea806eb3SSteven Rostedt (VMware) 		ret = 0;
55500567d680SSteven Rostedt (VMware) 	}
55510567d680SSteven Rostedt (VMware) 
55528a141dd7SAlexei Starovoitov 	if (unlikely(ret && new_direct)) {
55538a141dd7SAlexei Starovoitov 		direct->count++;
55548a141dd7SAlexei Starovoitov 		list_del_rcu(&new_direct->next);
55558a141dd7SAlexei Starovoitov 		synchronize_rcu_tasks();
55568a141dd7SAlexei Starovoitov 		kfree(new_direct);
55578a141dd7SAlexei Starovoitov 		ftrace_direct_func_count--;
55588a141dd7SAlexei Starovoitov 	}
55598a141dd7SAlexei Starovoitov 
55600567d680SSteven Rostedt (VMware)  out_unlock:
5561ea806eb3SSteven Rostedt (VMware) 	mutex_unlock(&ftrace_lock);
55620567d680SSteven Rostedt (VMware) 	mutex_unlock(&direct_mutex);
55630567d680SSteven Rostedt (VMware) 	return ret;
55640567d680SSteven Rostedt (VMware) }
55650567d680SSteven Rostedt (VMware) EXPORT_SYMBOL_GPL(modify_ftrace_direct);
5566f64dd462SJiri Olsa 
556753cd885bSSong Liu #define MULTI_FLAGS (FTRACE_OPS_FL_DIRECT | FTRACE_OPS_FL_SAVE_REGS)
5568f64dd462SJiri Olsa 
5569f64dd462SJiri Olsa static int check_direct_multi(struct ftrace_ops *ops)
5570f64dd462SJiri Olsa {
5571f64dd462SJiri Olsa 	if (!(ops->flags & FTRACE_OPS_FL_INITIALIZED))
5572f64dd462SJiri Olsa 		return -EINVAL;
5573f64dd462SJiri Olsa 	if ((ops->flags & MULTI_FLAGS) != MULTI_FLAGS)
5574f64dd462SJiri Olsa 		return -EINVAL;
5575f64dd462SJiri Olsa 	return 0;
5576f64dd462SJiri Olsa }
5577f64dd462SJiri Olsa 
5578f64dd462SJiri Olsa static void remove_direct_functions_hash(struct ftrace_hash *hash, unsigned long addr)
5579f64dd462SJiri Olsa {
5580f64dd462SJiri Olsa 	struct ftrace_func_entry *entry, *del;
5581f64dd462SJiri Olsa 	int size, i;
5582f64dd462SJiri Olsa 
5583f64dd462SJiri Olsa 	size = 1 << hash->size_bits;
5584f64dd462SJiri Olsa 	for (i = 0; i < size; i++) {
5585f64dd462SJiri Olsa 		hlist_for_each_entry(entry, &hash->buckets[i], hlist) {
5586f64dd462SJiri Olsa 			del = __ftrace_lookup_ip(direct_functions, entry->ip);
5587f64dd462SJiri Olsa 			if (del && del->direct == addr) {
5588f64dd462SJiri Olsa 				remove_hash_entry(direct_functions, del);
5589f64dd462SJiri Olsa 				kfree(del);
5590f64dd462SJiri Olsa 			}
5591f64dd462SJiri Olsa 		}
5592f64dd462SJiri Olsa 	}
5593f64dd462SJiri Olsa }
5594f64dd462SJiri Olsa 
5595f64dd462SJiri Olsa /**
5596f64dd462SJiri Olsa  * register_ftrace_direct_multi - Call a custom trampoline directly
5597f64dd462SJiri Olsa  * for multiple functions registered in @ops
5598f64dd462SJiri Olsa  * @ops: The address of the struct ftrace_ops object
5599f64dd462SJiri Olsa  * @addr: The address of the trampoline to call at @ops functions
5600f64dd462SJiri Olsa  *
5601f64dd462SJiri Olsa  * This is used to connect a direct calls to @addr from the nop locations
5602f64dd462SJiri Olsa  * of the functions registered in @ops (with by ftrace_set_filter_ip
5603f64dd462SJiri Olsa  * function).
5604f64dd462SJiri Olsa  *
5605f64dd462SJiri Olsa  * The location that it calls (@addr) must be able to handle a direct call,
5606f64dd462SJiri Olsa  * and save the parameters of the function being traced, and restore them
5607f64dd462SJiri Olsa  * (or inject new ones if needed), before returning.
5608f64dd462SJiri Olsa  *
5609f64dd462SJiri Olsa  * Returns:
5610f64dd462SJiri Olsa  *  0 on success
5611f64dd462SJiri Olsa  *  -EINVAL  - The @ops object was already registered with this call or
5612f64dd462SJiri Olsa  *             when there are no functions in @ops object.
5613f64dd462SJiri Olsa  *  -EBUSY   - Another direct function is already attached (there can be only one)
5614f64dd462SJiri Olsa  *  -ENODEV  - @ip does not point to a ftrace nop location (or not supported)
5615f64dd462SJiri Olsa  *  -ENOMEM  - There was an allocation failure.
5616f64dd462SJiri Olsa  */
5617f64dd462SJiri Olsa int register_ftrace_direct_multi(struct ftrace_ops *ops, unsigned long addr)
5618f64dd462SJiri Olsa {
5619f64dd462SJiri Olsa 	struct ftrace_hash *hash, *free_hash = NULL;
5620f64dd462SJiri Olsa 	struct ftrace_func_entry *entry, *new;
5621f64dd462SJiri Olsa 	int err = -EBUSY, size, i;
5622f64dd462SJiri Olsa 
5623f64dd462SJiri Olsa 	if (ops->func || ops->trampoline)
5624f64dd462SJiri Olsa 		return -EINVAL;
5625f64dd462SJiri Olsa 	if (!(ops->flags & FTRACE_OPS_FL_INITIALIZED))
5626f64dd462SJiri Olsa 		return -EINVAL;
5627f64dd462SJiri Olsa 	if (ops->flags & FTRACE_OPS_FL_ENABLED)
5628f64dd462SJiri Olsa 		return -EINVAL;
5629f64dd462SJiri Olsa 
5630f64dd462SJiri Olsa 	hash = ops->func_hash->filter_hash;
5631f64dd462SJiri Olsa 	if (ftrace_hash_empty(hash))
5632f64dd462SJiri Olsa 		return -EINVAL;
5633f64dd462SJiri Olsa 
5634f64dd462SJiri Olsa 	mutex_lock(&direct_mutex);
5635f64dd462SJiri Olsa 
5636f64dd462SJiri Olsa 	/* Make sure requested entries are not already registered.. */
5637f64dd462SJiri Olsa 	size = 1 << hash->size_bits;
5638f64dd462SJiri Olsa 	for (i = 0; i < size; i++) {
5639f64dd462SJiri Olsa 		hlist_for_each_entry(entry, &hash->buckets[i], hlist) {
5640f64dd462SJiri Olsa 			if (ftrace_find_rec_direct(entry->ip))
5641f64dd462SJiri Olsa 				goto out_unlock;
5642f64dd462SJiri Olsa 		}
5643f64dd462SJiri Olsa 	}
5644f64dd462SJiri Olsa 
5645f64dd462SJiri Olsa 	/* ... and insert them to direct_functions hash. */
5646f64dd462SJiri Olsa 	err = -ENOMEM;
5647f64dd462SJiri Olsa 	for (i = 0; i < size; i++) {
5648f64dd462SJiri Olsa 		hlist_for_each_entry(entry, &hash->buckets[i], hlist) {
5649f64dd462SJiri Olsa 			new = ftrace_add_rec_direct(entry->ip, addr, &free_hash);
5650f64dd462SJiri Olsa 			if (!new)
5651f64dd462SJiri Olsa 				goto out_remove;
5652f64dd462SJiri Olsa 			entry->direct = addr;
5653f64dd462SJiri Olsa 		}
5654f64dd462SJiri Olsa 	}
5655f64dd462SJiri Olsa 
5656f64dd462SJiri Olsa 	ops->func = call_direct_funcs;
5657f64dd462SJiri Olsa 	ops->flags = MULTI_FLAGS;
5658f64dd462SJiri Olsa 	ops->trampoline = FTRACE_REGS_ADDR;
5659f64dd462SJiri Olsa 
566053cd885bSSong Liu 	err = register_ftrace_function_nolock(ops);
5661f64dd462SJiri Olsa 
5662f64dd462SJiri Olsa  out_remove:
5663f64dd462SJiri Olsa 	if (err)
5664f64dd462SJiri Olsa 		remove_direct_functions_hash(hash, addr);
5665f64dd462SJiri Olsa 
5666f64dd462SJiri Olsa  out_unlock:
5667f64dd462SJiri Olsa 	mutex_unlock(&direct_mutex);
5668f64dd462SJiri Olsa 
5669f64dd462SJiri Olsa 	if (free_hash) {
5670f64dd462SJiri Olsa 		synchronize_rcu_tasks();
5671f64dd462SJiri Olsa 		free_ftrace_hash(free_hash);
5672f64dd462SJiri Olsa 	}
5673f64dd462SJiri Olsa 	return err;
5674f64dd462SJiri Olsa }
5675f64dd462SJiri Olsa EXPORT_SYMBOL_GPL(register_ftrace_direct_multi);
5676f64dd462SJiri Olsa 
5677f64dd462SJiri Olsa /**
5678f64dd462SJiri Olsa  * unregister_ftrace_direct_multi - Remove calls to custom trampoline
5679f64dd462SJiri Olsa  * previously registered by register_ftrace_direct_multi for @ops object.
5680f64dd462SJiri Olsa  * @ops: The address of the struct ftrace_ops object
5681f64dd462SJiri Olsa  *
5682f64dd462SJiri Olsa  * This is used to remove a direct calls to @addr from the nop locations
5683f64dd462SJiri Olsa  * of the functions registered in @ops (with by ftrace_set_filter_ip
5684f64dd462SJiri Olsa  * function).
5685f64dd462SJiri Olsa  *
5686f64dd462SJiri Olsa  * Returns:
5687f64dd462SJiri Olsa  *  0 on success
5688f64dd462SJiri Olsa  *  -EINVAL - The @ops object was not properly registered.
5689f64dd462SJiri Olsa  */
5690f64dd462SJiri Olsa int unregister_ftrace_direct_multi(struct ftrace_ops *ops, unsigned long addr)
5691f64dd462SJiri Olsa {
5692f64dd462SJiri Olsa 	struct ftrace_hash *hash = ops->func_hash->filter_hash;
5693f64dd462SJiri Olsa 	int err;
5694f64dd462SJiri Olsa 
5695f64dd462SJiri Olsa 	if (check_direct_multi(ops))
5696f64dd462SJiri Olsa 		return -EINVAL;
5697f64dd462SJiri Olsa 	if (!(ops->flags & FTRACE_OPS_FL_ENABLED))
5698f64dd462SJiri Olsa 		return -EINVAL;
5699f64dd462SJiri Olsa 
5700f64dd462SJiri Olsa 	mutex_lock(&direct_mutex);
5701f64dd462SJiri Olsa 	err = unregister_ftrace_function(ops);
5702f64dd462SJiri Olsa 	remove_direct_functions_hash(hash, addr);
5703f64dd462SJiri Olsa 	mutex_unlock(&direct_mutex);
5704fea3ffa4SJiri Olsa 
5705fea3ffa4SJiri Olsa 	/* cleanup for possible another register call */
5706fea3ffa4SJiri Olsa 	ops->func = NULL;
5707fea3ffa4SJiri Olsa 	ops->trampoline = 0;
5708f64dd462SJiri Olsa 	return err;
5709f64dd462SJiri Olsa }
5710f64dd462SJiri Olsa EXPORT_SYMBOL_GPL(unregister_ftrace_direct_multi);
5711ccf5a89eSJiri Olsa 
5712f96f644aSSong Liu static int
5713f96f644aSSong Liu __modify_ftrace_direct_multi(struct ftrace_ops *ops, unsigned long addr)
5714ccf5a89eSJiri Olsa {
5715ed292718SSteven Rostedt (VMware) 	struct ftrace_hash *hash;
5716ccf5a89eSJiri Olsa 	struct ftrace_func_entry *entry, *iter;
5717ed292718SSteven Rostedt (VMware) 	static struct ftrace_ops tmp_ops = {
5718ed292718SSteven Rostedt (VMware) 		.func		= ftrace_stub,
5719ed292718SSteven Rostedt (VMware) 		.flags		= FTRACE_OPS_FL_STUB,
5720ed292718SSteven Rostedt (VMware) 	};
5721ccf5a89eSJiri Olsa 	int i, size;
5722ccf5a89eSJiri Olsa 	int err;
5723ccf5a89eSJiri Olsa 
5724f96f644aSSong Liu 	lockdep_assert_held_once(&direct_mutex);
5725ed292718SSteven Rostedt (VMware) 
5726ed292718SSteven Rostedt (VMware) 	/* Enable the tmp_ops to have the same functions as the direct ops */
5727ed292718SSteven Rostedt (VMware) 	ftrace_ops_init(&tmp_ops);
5728ed292718SSteven Rostedt (VMware) 	tmp_ops.func_hash = ops->func_hash;
5729ed292718SSteven Rostedt (VMware) 
573053cd885bSSong Liu 	err = register_ftrace_function_nolock(&tmp_ops);
5731ed292718SSteven Rostedt (VMware) 	if (err)
5732f96f644aSSong Liu 		return err;
5733ccf5a89eSJiri Olsa 
5734ccf5a89eSJiri Olsa 	/*
5735ed292718SSteven Rostedt (VMware) 	 * Now the ftrace_ops_list_func() is called to do the direct callers.
5736ed292718SSteven Rostedt (VMware) 	 * We can safely change the direct functions attached to each entry.
5737ccf5a89eSJiri Olsa 	 */
5738ed292718SSteven Rostedt (VMware) 	mutex_lock(&ftrace_lock);
5739ccf5a89eSJiri Olsa 
5740ed292718SSteven Rostedt (VMware) 	hash = ops->func_hash->filter_hash;
5741ccf5a89eSJiri Olsa 	size = 1 << hash->size_bits;
5742ccf5a89eSJiri Olsa 	for (i = 0; i < size; i++) {
5743ccf5a89eSJiri Olsa 		hlist_for_each_entry(iter, &hash->buckets[i], hlist) {
5744ccf5a89eSJiri Olsa 			entry = __ftrace_lookup_ip(direct_functions, iter->ip);
5745ccf5a89eSJiri Olsa 			if (!entry)
5746ccf5a89eSJiri Olsa 				continue;
5747ccf5a89eSJiri Olsa 			entry->direct = addr;
5748ccf5a89eSJiri Olsa 		}
5749ccf5a89eSJiri Olsa 	}
5750ccf5a89eSJiri Olsa 
57512e6e9058SJiri Olsa 	mutex_unlock(&ftrace_lock);
57522e6e9058SJiri Olsa 
5753ed292718SSteven Rostedt (VMware) 	/* Removing the tmp_ops will add the updated direct callers to the functions */
5754ed292718SSteven Rostedt (VMware) 	unregister_ftrace_function(&tmp_ops);
5755ccf5a89eSJiri Olsa 
5756f96f644aSSong Liu 	return err;
5757f96f644aSSong Liu }
5758f96f644aSSong Liu 
5759f96f644aSSong Liu /**
5760f96f644aSSong Liu  * modify_ftrace_direct_multi_nolock - Modify an existing direct 'multi' call
5761f96f644aSSong Liu  * to call something else
5762f96f644aSSong Liu  * @ops: The address of the struct ftrace_ops object
5763f96f644aSSong Liu  * @addr: The address of the new trampoline to call at @ops functions
5764f96f644aSSong Liu  *
5765f96f644aSSong Liu  * This is used to unregister currently registered direct caller and
5766f96f644aSSong Liu  * register new one @addr on functions registered in @ops object.
5767f96f644aSSong Liu  *
5768f96f644aSSong Liu  * Note there's window between ftrace_shutdown and ftrace_startup calls
5769f96f644aSSong Liu  * where there will be no callbacks called.
5770f96f644aSSong Liu  *
5771f96f644aSSong Liu  * Caller should already have direct_mutex locked, so we don't lock
5772f96f644aSSong Liu  * direct_mutex here.
5773f96f644aSSong Liu  *
5774f96f644aSSong Liu  * Returns: zero on success. Non zero on error, which includes:
5775f96f644aSSong Liu  *  -EINVAL - The @ops object was not properly registered.
5776f96f644aSSong Liu  */
5777f96f644aSSong Liu int modify_ftrace_direct_multi_nolock(struct ftrace_ops *ops, unsigned long addr)
5778f96f644aSSong Liu {
5779f96f644aSSong Liu 	if (check_direct_multi(ops))
5780f96f644aSSong Liu 		return -EINVAL;
5781f96f644aSSong Liu 	if (!(ops->flags & FTRACE_OPS_FL_ENABLED))
5782f96f644aSSong Liu 		return -EINVAL;
5783f96f644aSSong Liu 
5784f96f644aSSong Liu 	return __modify_ftrace_direct_multi(ops, addr);
5785f96f644aSSong Liu }
5786f96f644aSSong Liu EXPORT_SYMBOL_GPL(modify_ftrace_direct_multi_nolock);
5787f96f644aSSong Liu 
5788f96f644aSSong Liu /**
5789f96f644aSSong Liu  * modify_ftrace_direct_multi - Modify an existing direct 'multi' call
5790f96f644aSSong Liu  * to call something else
5791f96f644aSSong Liu  * @ops: The address of the struct ftrace_ops object
5792f96f644aSSong Liu  * @addr: The address of the new trampoline to call at @ops functions
5793f96f644aSSong Liu  *
5794f96f644aSSong Liu  * This is used to unregister currently registered direct caller and
5795f96f644aSSong Liu  * register new one @addr on functions registered in @ops object.
5796f96f644aSSong Liu  *
5797f96f644aSSong Liu  * Note there's window between ftrace_shutdown and ftrace_startup calls
5798f96f644aSSong Liu  * where there will be no callbacks called.
5799f96f644aSSong Liu  *
5800f96f644aSSong Liu  * Returns: zero on success. Non zero on error, which includes:
5801f96f644aSSong Liu  *  -EINVAL - The @ops object was not properly registered.
5802f96f644aSSong Liu  */
5803f96f644aSSong Liu int modify_ftrace_direct_multi(struct ftrace_ops *ops, unsigned long addr)
5804f96f644aSSong Liu {
5805f96f644aSSong Liu 	int err;
5806f96f644aSSong Liu 
5807f96f644aSSong Liu 	if (check_direct_multi(ops))
5808f96f644aSSong Liu 		return -EINVAL;
5809f96f644aSSong Liu 	if (!(ops->flags & FTRACE_OPS_FL_ENABLED))
5810f96f644aSSong Liu 		return -EINVAL;
5811f96f644aSSong Liu 
5812f96f644aSSong Liu 	mutex_lock(&direct_mutex);
5813f96f644aSSong Liu 	err = __modify_ftrace_direct_multi(ops, addr);
5814ccf5a89eSJiri Olsa 	mutex_unlock(&direct_mutex);
5815ccf5a89eSJiri Olsa 	return err;
5816ccf5a89eSJiri Olsa }
5817ccf5a89eSJiri Olsa EXPORT_SYMBOL_GPL(modify_ftrace_direct_multi);
5818763e34e7SSteven Rostedt (VMware) #endif /* CONFIG_DYNAMIC_FTRACE_WITH_DIRECT_CALLS */
5819763e34e7SSteven Rostedt (VMware) 
5820647664eaSMasami Hiramatsu /**
5821647664eaSMasami Hiramatsu  * ftrace_set_filter_ip - set a function to filter on in ftrace by address
5822647664eaSMasami Hiramatsu  * @ops - the ops to set the filter with
5823647664eaSMasami Hiramatsu  * @ip - the address to add to or remove from the filter.
5824647664eaSMasami Hiramatsu  * @remove - non zero to remove the ip from the filter
5825647664eaSMasami Hiramatsu  * @reset - non zero to reset all filters before applying this filter.
5826647664eaSMasami Hiramatsu  *
5827647664eaSMasami Hiramatsu  * Filters denote which functions should be enabled when tracing is enabled
5828f2cc020dSIngo Molnar  * If @ip is NULL, it fails to update filter.
5829647664eaSMasami Hiramatsu  */
5830647664eaSMasami Hiramatsu int ftrace_set_filter_ip(struct ftrace_ops *ops, unsigned long ip,
5831647664eaSMasami Hiramatsu 			 int remove, int reset)
5832647664eaSMasami Hiramatsu {
5833f04f24fbSMasami Hiramatsu 	ftrace_ops_init(ops);
58344f554e95SJiri Olsa 	return ftrace_set_addr(ops, &ip, 1, remove, reset, 1);
5835647664eaSMasami Hiramatsu }
5836647664eaSMasami Hiramatsu EXPORT_SYMBOL_GPL(ftrace_set_filter_ip);
5837647664eaSMasami Hiramatsu 
5838d032ae89SJoel Fernandes /**
58394f554e95SJiri Olsa  * ftrace_set_filter_ips - set functions to filter on in ftrace by addresses
58404f554e95SJiri Olsa  * @ops - the ops to set the filter with
58414f554e95SJiri Olsa  * @ips - the array of addresses to add to or remove from the filter.
58424f554e95SJiri Olsa  * @cnt - the number of addresses in @ips
58434f554e95SJiri Olsa  * @remove - non zero to remove ips from the filter
58444f554e95SJiri Olsa  * @reset - non zero to reset all filters before applying this filter.
58454f554e95SJiri Olsa  *
58464f554e95SJiri Olsa  * Filters denote which functions should be enabled when tracing is enabled
58474f554e95SJiri Olsa  * If @ips array or any ip specified within is NULL , it fails to update filter.
58484f554e95SJiri Olsa  */
58494f554e95SJiri Olsa int ftrace_set_filter_ips(struct ftrace_ops *ops, unsigned long *ips,
58504f554e95SJiri Olsa 			  unsigned int cnt, int remove, int reset)
58514f554e95SJiri Olsa {
58524f554e95SJiri Olsa 	ftrace_ops_init(ops);
58534f554e95SJiri Olsa 	return ftrace_set_addr(ops, ips, cnt, remove, reset, 1);
58544f554e95SJiri Olsa }
58554f554e95SJiri Olsa EXPORT_SYMBOL_GPL(ftrace_set_filter_ips);
58564f554e95SJiri Olsa 
58574f554e95SJiri Olsa /**
5858d032ae89SJoel Fernandes  * ftrace_ops_set_global_filter - setup ops to use global filters
5859d032ae89SJoel Fernandes  * @ops - the ops which will use the global filters
5860d032ae89SJoel Fernandes  *
5861d032ae89SJoel Fernandes  * ftrace users who need global function trace filtering should call this.
5862d032ae89SJoel Fernandes  * It can set the global filter only if ops were not initialized before.
5863d032ae89SJoel Fernandes  */
5864d032ae89SJoel Fernandes void ftrace_ops_set_global_filter(struct ftrace_ops *ops)
5865d032ae89SJoel Fernandes {
5866d032ae89SJoel Fernandes 	if (ops->flags & FTRACE_OPS_FL_INITIALIZED)
5867d032ae89SJoel Fernandes 		return;
5868d032ae89SJoel Fernandes 
5869d032ae89SJoel Fernandes 	ftrace_ops_init(ops);
5870d032ae89SJoel Fernandes 	ops->func_hash = &global_ops.local_hash;
5871d032ae89SJoel Fernandes }
5872d032ae89SJoel Fernandes EXPORT_SYMBOL_GPL(ftrace_ops_set_global_filter);
5873d032ae89SJoel Fernandes 
5874647664eaSMasami Hiramatsu static int
5875647664eaSMasami Hiramatsu ftrace_set_regex(struct ftrace_ops *ops, unsigned char *buf, int len,
5876647664eaSMasami Hiramatsu 		 int reset, int enable)
5877647664eaSMasami Hiramatsu {
58784f554e95SJiri Olsa 	return ftrace_set_hash(ops, buf, len, NULL, 0, 0, reset, enable);
5879647664eaSMasami Hiramatsu }
5880647664eaSMasami Hiramatsu 
588177a2b37dSSteven Rostedt /**
588277a2b37dSSteven Rostedt  * ftrace_set_filter - set a function to filter on in ftrace
5883936e074bSSteven Rostedt  * @ops - the ops to set the filter with
588477a2b37dSSteven Rostedt  * @buf - the string that holds the function filter text.
588577a2b37dSSteven Rostedt  * @len - the length of the string.
588677a2b37dSSteven Rostedt  * @reset - non zero to reset all filters before applying this filter.
588777a2b37dSSteven Rostedt  *
588877a2b37dSSteven Rostedt  * Filters denote which functions should be enabled when tracing is enabled.
588977a2b37dSSteven Rostedt  * If @buf is NULL and reset is set, all functions will be enabled for tracing.
589077a2b37dSSteven Rostedt  */
5891ac483c44SJiri Olsa int ftrace_set_filter(struct ftrace_ops *ops, unsigned char *buf,
5892936e074bSSteven Rostedt 		       int len, int reset)
589377a2b37dSSteven Rostedt {
5894f04f24fbSMasami Hiramatsu 	ftrace_ops_init(ops);
5895ac483c44SJiri Olsa 	return ftrace_set_regex(ops, buf, len, reset, 1);
589641c52c0dSSteven Rostedt }
5897936e074bSSteven Rostedt EXPORT_SYMBOL_GPL(ftrace_set_filter);
58984eebcc81SSteven Rostedt 
589941c52c0dSSteven Rostedt /**
590041c52c0dSSteven Rostedt  * ftrace_set_notrace - set a function to not trace in ftrace
5901936e074bSSteven Rostedt  * @ops - the ops to set the notrace filter with
590241c52c0dSSteven Rostedt  * @buf - the string that holds the function notrace text.
590341c52c0dSSteven Rostedt  * @len - the length of the string.
590441c52c0dSSteven Rostedt  * @reset - non zero to reset all filters before applying this filter.
590541c52c0dSSteven Rostedt  *
590641c52c0dSSteven Rostedt  * Notrace Filters denote which functions should not be enabled when tracing
590741c52c0dSSteven Rostedt  * is enabled. If @buf is NULL and reset is set, all functions will be enabled
590841c52c0dSSteven Rostedt  * for tracing.
590941c52c0dSSteven Rostedt  */
5910ac483c44SJiri Olsa int ftrace_set_notrace(struct ftrace_ops *ops, unsigned char *buf,
5911936e074bSSteven Rostedt 			int len, int reset)
5912936e074bSSteven Rostedt {
5913f04f24fbSMasami Hiramatsu 	ftrace_ops_init(ops);
5914ac483c44SJiri Olsa 	return ftrace_set_regex(ops, buf, len, reset, 0);
5915936e074bSSteven Rostedt }
5916936e074bSSteven Rostedt EXPORT_SYMBOL_GPL(ftrace_set_notrace);
5917936e074bSSteven Rostedt /**
59188d1b065dSJiaxing Wang  * ftrace_set_global_filter - set a function to filter on with global tracers
5919936e074bSSteven Rostedt  * @buf - the string that holds the function filter text.
5920936e074bSSteven Rostedt  * @len - the length of the string.
5921936e074bSSteven Rostedt  * @reset - non zero to reset all filters before applying this filter.
5922936e074bSSteven Rostedt  *
5923936e074bSSteven Rostedt  * Filters denote which functions should be enabled when tracing is enabled.
5924936e074bSSteven Rostedt  * If @buf is NULL and reset is set, all functions will be enabled for tracing.
5925936e074bSSteven Rostedt  */
5926936e074bSSteven Rostedt void ftrace_set_global_filter(unsigned char *buf, int len, int reset)
5927936e074bSSteven Rostedt {
5928936e074bSSteven Rostedt 	ftrace_set_regex(&global_ops, buf, len, reset, 1);
5929936e074bSSteven Rostedt }
5930936e074bSSteven Rostedt EXPORT_SYMBOL_GPL(ftrace_set_global_filter);
5931936e074bSSteven Rostedt 
5932936e074bSSteven Rostedt /**
59338d1b065dSJiaxing Wang  * ftrace_set_global_notrace - set a function to not trace with global tracers
5934936e074bSSteven Rostedt  * @buf - the string that holds the function notrace text.
5935936e074bSSteven Rostedt  * @len - the length of the string.
5936936e074bSSteven Rostedt  * @reset - non zero to reset all filters before applying this filter.
5937936e074bSSteven Rostedt  *
5938936e074bSSteven Rostedt  * Notrace Filters denote which functions should not be enabled when tracing
5939936e074bSSteven Rostedt  * is enabled. If @buf is NULL and reset is set, all functions will be enabled
5940936e074bSSteven Rostedt  * for tracing.
5941936e074bSSteven Rostedt  */
5942936e074bSSteven Rostedt void ftrace_set_global_notrace(unsigned char *buf, int len, int reset)
594341c52c0dSSteven Rostedt {
5944f45948e8SSteven Rostedt 	ftrace_set_regex(&global_ops, buf, len, reset, 0);
594577a2b37dSSteven Rostedt }
5946936e074bSSteven Rostedt EXPORT_SYMBOL_GPL(ftrace_set_global_notrace);
594777a2b37dSSteven Rostedt 
59482af15d6aSSteven Rostedt /*
59492af15d6aSSteven Rostedt  * command line interface to allow users to set filters on boot up.
59502af15d6aSSteven Rostedt  */
59512af15d6aSSteven Rostedt #define FTRACE_FILTER_SIZE		COMMAND_LINE_SIZE
59522af15d6aSSteven Rostedt static char ftrace_notrace_buf[FTRACE_FILTER_SIZE] __initdata;
59532af15d6aSSteven Rostedt static char ftrace_filter_buf[FTRACE_FILTER_SIZE] __initdata;
59542af15d6aSSteven Rostedt 
5955f1ed7c74SSteven Rostedt (Red Hat) /* Used by function selftest to not test if filter is set */
5956f1ed7c74SSteven Rostedt (Red Hat) bool ftrace_filter_param __initdata;
5957f1ed7c74SSteven Rostedt (Red Hat) 
59582af15d6aSSteven Rostedt static int __init set_ftrace_notrace(char *str)
59592af15d6aSSteven Rostedt {
5960f1ed7c74SSteven Rostedt (Red Hat) 	ftrace_filter_param = true;
596175761cc1SChen Gang 	strlcpy(ftrace_notrace_buf, str, FTRACE_FILTER_SIZE);
59622af15d6aSSteven Rostedt 	return 1;
59632af15d6aSSteven Rostedt }
59642af15d6aSSteven Rostedt __setup("ftrace_notrace=", set_ftrace_notrace);
59652af15d6aSSteven Rostedt 
59662af15d6aSSteven Rostedt static int __init set_ftrace_filter(char *str)
59672af15d6aSSteven Rostedt {
5968f1ed7c74SSteven Rostedt (Red Hat) 	ftrace_filter_param = true;
596975761cc1SChen Gang 	strlcpy(ftrace_filter_buf, str, FTRACE_FILTER_SIZE);
59702af15d6aSSteven Rostedt 	return 1;
59712af15d6aSSteven Rostedt }
59722af15d6aSSteven Rostedt __setup("ftrace_filter=", set_ftrace_filter);
59732af15d6aSSteven Rostedt 
5974369bc18fSStefan Assmann #ifdef CONFIG_FUNCTION_GRAPH_TRACER
5975f6060f46SLai Jiangshan static char ftrace_graph_buf[FTRACE_FILTER_SIZE] __initdata;
59760d7d9a16SNamhyung Kim static char ftrace_graph_notrace_buf[FTRACE_FILTER_SIZE] __initdata;
5977b9b0c831SNamhyung Kim static int ftrace_graph_set_hash(struct ftrace_hash *hash, char *buffer);
5978801c29fdSSteven Rostedt 
5979369bc18fSStefan Assmann static int __init set_graph_function(char *str)
5980369bc18fSStefan Assmann {
598106f43d66SFrederic Weisbecker 	strlcpy(ftrace_graph_buf, str, FTRACE_FILTER_SIZE);
5982369bc18fSStefan Assmann 	return 1;
5983369bc18fSStefan Assmann }
5984369bc18fSStefan Assmann __setup("ftrace_graph_filter=", set_graph_function);
5985369bc18fSStefan Assmann 
59860d7d9a16SNamhyung Kim static int __init set_graph_notrace_function(char *str)
59870d7d9a16SNamhyung Kim {
59880d7d9a16SNamhyung Kim 	strlcpy(ftrace_graph_notrace_buf, str, FTRACE_FILTER_SIZE);
59890d7d9a16SNamhyung Kim 	return 1;
59900d7d9a16SNamhyung Kim }
59910d7d9a16SNamhyung Kim __setup("ftrace_graph_notrace=", set_graph_notrace_function);
59920d7d9a16SNamhyung Kim 
599365a50c65STodd Brandt static int __init set_graph_max_depth_function(char *str)
599465a50c65STodd Brandt {
599565a50c65STodd Brandt 	if (!str)
599665a50c65STodd Brandt 		return 0;
599765a50c65STodd Brandt 	fgraph_max_depth = simple_strtoul(str, NULL, 0);
599865a50c65STodd Brandt 	return 1;
599965a50c65STodd Brandt }
600065a50c65STodd Brandt __setup("ftrace_graph_max_depth=", set_graph_max_depth_function);
600165a50c65STodd Brandt 
60020d7d9a16SNamhyung Kim static void __init set_ftrace_early_graph(char *buf, int enable)
6003369bc18fSStefan Assmann {
6004369bc18fSStefan Assmann 	int ret;
6005369bc18fSStefan Assmann 	char *func;
6006b9b0c831SNamhyung Kim 	struct ftrace_hash *hash;
60070d7d9a16SNamhyung Kim 
600892ad18ecSSteven Rostedt (VMware) 	hash = alloc_ftrace_hash(FTRACE_HASH_DEFAULT_BITS);
600924589e3aSSteven Rostedt (VMware) 	if (MEM_FAIL(!hash, "Failed to allocate hash\n"))
601092ad18ecSSteven Rostedt (VMware) 		return;
6011369bc18fSStefan Assmann 
6012369bc18fSStefan Assmann 	while (buf) {
6013369bc18fSStefan Assmann 		func = strsep(&buf, ",");
6014369bc18fSStefan Assmann 		/* we allow only one expression at a time */
6015b9b0c831SNamhyung Kim 		ret = ftrace_graph_set_hash(hash, func);
6016369bc18fSStefan Assmann 		if (ret)
6017369bc18fSStefan Assmann 			printk(KERN_DEBUG "ftrace: function %s not "
6018369bc18fSStefan Assmann 					  "traceable\n", func);
6019369bc18fSStefan Assmann 	}
602092ad18ecSSteven Rostedt (VMware) 
602192ad18ecSSteven Rostedt (VMware) 	if (enable)
602292ad18ecSSteven Rostedt (VMware) 		ftrace_graph_hash = hash;
602392ad18ecSSteven Rostedt (VMware) 	else
602492ad18ecSSteven Rostedt (VMware) 		ftrace_graph_notrace_hash = hash;
6025369bc18fSStefan Assmann }
6026369bc18fSStefan Assmann #endif /* CONFIG_FUNCTION_GRAPH_TRACER */
6027369bc18fSStefan Assmann 
60282a85a37fSSteven Rostedt void __init
60292a85a37fSSteven Rostedt ftrace_set_early_filter(struct ftrace_ops *ops, char *buf, int enable)
60302af15d6aSSteven Rostedt {
60312af15d6aSSteven Rostedt 	char *func;
60322af15d6aSSteven Rostedt 
6033f04f24fbSMasami Hiramatsu 	ftrace_ops_init(ops);
6034f04f24fbSMasami Hiramatsu 
60352af15d6aSSteven Rostedt 	while (buf) {
60362af15d6aSSteven Rostedt 		func = strsep(&buf, ",");
6037f45948e8SSteven Rostedt 		ftrace_set_regex(ops, func, strlen(func), 0, enable);
60382af15d6aSSteven Rostedt 	}
60392af15d6aSSteven Rostedt }
60402af15d6aSSteven Rostedt 
60412af15d6aSSteven Rostedt static void __init set_ftrace_early_filters(void)
60422af15d6aSSteven Rostedt {
60432af15d6aSSteven Rostedt 	if (ftrace_filter_buf[0])
60442a85a37fSSteven Rostedt 		ftrace_set_early_filter(&global_ops, ftrace_filter_buf, 1);
60452af15d6aSSteven Rostedt 	if (ftrace_notrace_buf[0])
60462a85a37fSSteven Rostedt 		ftrace_set_early_filter(&global_ops, ftrace_notrace_buf, 0);
6047369bc18fSStefan Assmann #ifdef CONFIG_FUNCTION_GRAPH_TRACER
6048369bc18fSStefan Assmann 	if (ftrace_graph_buf[0])
60490d7d9a16SNamhyung Kim 		set_ftrace_early_graph(ftrace_graph_buf, 1);
60500d7d9a16SNamhyung Kim 	if (ftrace_graph_notrace_buf[0])
60510d7d9a16SNamhyung Kim 		set_ftrace_early_graph(ftrace_graph_notrace_buf, 0);
6052369bc18fSStefan Assmann #endif /* CONFIG_FUNCTION_GRAPH_TRACER */
60532af15d6aSSteven Rostedt }
60542af15d6aSSteven Rostedt 
6055fc13cb0cSSteven Rostedt int ftrace_regex_release(struct inode *inode, struct file *file)
60565072c59fSSteven Rostedt {
60575072c59fSSteven Rostedt 	struct seq_file *m = (struct seq_file *)file->private_data;
60585072c59fSSteven Rostedt 	struct ftrace_iterator *iter;
605933dc9b12SSteven Rostedt 	struct ftrace_hash **orig_hash;
6060689fd8b6S[email protected] 	struct trace_parser *parser;
6061ed926f9bSSteven Rostedt 	int filter_hash;
60625072c59fSSteven Rostedt 
60635072c59fSSteven Rostedt 	if (file->f_mode & FMODE_READ) {
60645072c59fSSteven Rostedt 		iter = m->private;
60655072c59fSSteven Rostedt 		seq_release(inode, file);
60665072c59fSSteven Rostedt 	} else
60675072c59fSSteven Rostedt 		iter = file->private_data;
60685072c59fSSteven Rostedt 
6069689fd8b6S[email protected] 	parser = &iter->parser;
6070689fd8b6S[email protected] 	if (trace_parser_loaded(parser)) {
60718c9af478SSteven Rostedt (VMware) 		int enable = !(iter->flags & FTRACE_ITER_NOTRACE);
60728c9af478SSteven Rostedt (VMware) 
60738c9af478SSteven Rostedt (VMware) 		ftrace_process_regex(iter, parser->buffer,
60748c9af478SSteven Rostedt (VMware) 				     parser->idx, enable);
60755072c59fSSteven Rostedt 	}
60765072c59fSSteven Rostedt 
6077058e297dSSteven Rostedt 	trace_parser_put(parser);
6078058e297dSSteven Rostedt 
607933b7f99cSSteven Rostedt (Red Hat) 	mutex_lock(&iter->ops->func_hash->regex_lock);
60803f2367baSMasami Hiramatsu 
6081058e297dSSteven Rostedt 	if (file->f_mode & FMODE_WRITE) {
6082ed926f9bSSteven Rostedt 		filter_hash = !!(iter->flags & FTRACE_ITER_FILTER);
6083ed926f9bSSteven Rostedt 
60848c08f0d5SSteven Rostedt (VMware) 		if (filter_hash) {
608533b7f99cSSteven Rostedt (Red Hat) 			orig_hash = &iter->ops->func_hash->filter_hash;
60860ce0638eSZheng Yejian 			if (iter->tr) {
60870ce0638eSZheng Yejian 				if (list_empty(&iter->tr->mod_trace))
60880ce0638eSZheng Yejian 					iter->hash->flags &= ~FTRACE_HASH_FL_MOD;
60890ce0638eSZheng Yejian 				else
60908c08f0d5SSteven Rostedt (VMware) 					iter->hash->flags |= FTRACE_HASH_FL_MOD;
60910ce0638eSZheng Yejian 			}
60928c08f0d5SSteven Rostedt (VMware) 		} else
609333b7f99cSSteven Rostedt (Red Hat) 			orig_hash = &iter->ops->func_hash->notrace_hash;
609433dc9b12SSteven Rostedt 
6095e6ea44e9SSteven Rostedt 		mutex_lock(&ftrace_lock);
6096045e269cSAlex Shi 		ftrace_hash_move_and_update_ops(iter->ops, orig_hash,
6097e16b35ddSSteven Rostedt (VMware) 						      iter->hash, filter_hash);
6098e6ea44e9SSteven Rostedt 		mutex_unlock(&ftrace_lock);
6099c20489daSSteven Rostedt (VMware) 	} else {
6100c20489daSSteven Rostedt (VMware) 		/* For read only, the hash is the ops hash */
6101c20489daSSteven Rostedt (VMware) 		iter->hash = NULL;
6102058e297dSSteven Rostedt 	}
61033f2367baSMasami Hiramatsu 
610433b7f99cSSteven Rostedt (Red Hat) 	mutex_unlock(&iter->ops->func_hash->regex_lock);
610533dc9b12SSteven Rostedt 	free_ftrace_hash(iter->hash);
61069ef16693SSteven Rostedt (VMware) 	if (iter->tr)
61079ef16693SSteven Rostedt (VMware) 		trace_array_put(iter->tr);
610833dc9b12SSteven Rostedt 	kfree(iter);
6109689fd8b6S[email protected] 
61105072c59fSSteven Rostedt 	return 0;
61115072c59fSSteven Rostedt }
61125072c59fSSteven Rostedt 
61135e2336a0SSteven Rostedt static const struct file_operations ftrace_avail_fops = {
61145072c59fSSteven Rostedt 	.open = ftrace_avail_open,
61155072c59fSSteven Rostedt 	.read = seq_read,
61165072c59fSSteven Rostedt 	.llseek = seq_lseek,
61173be04b47SLi Zefan 	.release = seq_release_private,
61185072c59fSSteven Rostedt };
61195072c59fSSteven Rostedt 
6120647bcd03SSteven Rostedt static const struct file_operations ftrace_enabled_fops = {
6121647bcd03SSteven Rostedt 	.open = ftrace_enabled_open,
6122647bcd03SSteven Rostedt 	.read = seq_read,
6123647bcd03SSteven Rostedt 	.llseek = seq_lseek,
6124647bcd03SSteven Rostedt 	.release = seq_release_private,
6125647bcd03SSteven Rostedt };
6126647bcd03SSteven Rostedt 
61275e2336a0SSteven Rostedt static const struct file_operations ftrace_filter_fops = {
61285072c59fSSteven Rostedt 	.open = ftrace_filter_open,
6129850a80cfSLai Jiangshan 	.read = seq_read,
61305072c59fSSteven Rostedt 	.write = ftrace_filter_write,
6131098c879eSSteven Rostedt (Red Hat) 	.llseek = tracing_lseek,
61321cf41dd7SSteven Rostedt 	.release = ftrace_regex_release,
61335072c59fSSteven Rostedt };
61345072c59fSSteven Rostedt 
61355e2336a0SSteven Rostedt static const struct file_operations ftrace_notrace_fops = {
613641c52c0dSSteven Rostedt 	.open = ftrace_notrace_open,
6137850a80cfSLai Jiangshan 	.read = seq_read,
613841c52c0dSSteven Rostedt 	.write = ftrace_notrace_write,
6139098c879eSSteven Rostedt (Red Hat) 	.llseek = tracing_lseek,
61401cf41dd7SSteven Rostedt 	.release = ftrace_regex_release,
614141c52c0dSSteven Rostedt };
614241c52c0dSSteven Rostedt 
6143ea4e2bc4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
6144ea4e2bc4SSteven Rostedt 
6145ea4e2bc4SSteven Rostedt static DEFINE_MUTEX(graph_lock);
6146ea4e2bc4SSteven Rostedt 
614724a9729fSAmol Grover struct ftrace_hash __rcu *ftrace_graph_hash = EMPTY_HASH;
6148fd0e6852SAmol Grover struct ftrace_hash __rcu *ftrace_graph_notrace_hash = EMPTY_HASH;
6149b9b0c831SNamhyung Kim 
6150b9b0c831SNamhyung Kim enum graph_filter_type {
6151b9b0c831SNamhyung Kim 	GRAPH_FILTER_NOTRACE	= 0,
6152b9b0c831SNamhyung Kim 	GRAPH_FILTER_FUNCTION,
6153b9b0c831SNamhyung Kim };
6154ea4e2bc4SSteven Rostedt 
6155555fc781SSteven Rostedt (VMware) #define FTRACE_GRAPH_EMPTY	((void *)1)
6156555fc781SSteven Rostedt (VMware) 
6157faf982a6SNamhyung Kim struct ftrace_graph_data {
6158b9b0c831SNamhyung Kim 	struct ftrace_hash		*hash;
6159b9b0c831SNamhyung Kim 	struct ftrace_func_entry	*entry;
6160b9b0c831SNamhyung Kim 	int				idx;   /* for hash table iteration */
6161b9b0c831SNamhyung Kim 	enum graph_filter_type		type;
6162b9b0c831SNamhyung Kim 	struct ftrace_hash		*new_hash;
6163faf982a6SNamhyung Kim 	const struct seq_operations	*seq_ops;
6164e704eff3SSteven Rostedt (VMware) 	struct trace_parser		parser;
6165faf982a6SNamhyung Kim };
6166faf982a6SNamhyung Kim 
6167ea4e2bc4SSteven Rostedt static void *
616885951842SLi Zefan __g_next(struct seq_file *m, loff_t *pos)
6169ea4e2bc4SSteven Rostedt {
6170faf982a6SNamhyung Kim 	struct ftrace_graph_data *fgd = m->private;
6171b9b0c831SNamhyung Kim 	struct ftrace_func_entry *entry = fgd->entry;
6172b9b0c831SNamhyung Kim 	struct hlist_head *head;
6173b9b0c831SNamhyung Kim 	int i, idx = fgd->idx;
6174faf982a6SNamhyung Kim 
6175b9b0c831SNamhyung Kim 	if (*pos >= fgd->hash->count)
6176ea4e2bc4SSteven Rostedt 		return NULL;
6177b9b0c831SNamhyung Kim 
6178b9b0c831SNamhyung Kim 	if (entry) {
6179b9b0c831SNamhyung Kim 		hlist_for_each_entry_continue(entry, hlist) {
6180b9b0c831SNamhyung Kim 			fgd->entry = entry;
6181b9b0c831SNamhyung Kim 			return entry;
6182b9b0c831SNamhyung Kim 		}
6183b9b0c831SNamhyung Kim 
6184b9b0c831SNamhyung Kim 		idx++;
6185b9b0c831SNamhyung Kim 	}
6186b9b0c831SNamhyung Kim 
6187b9b0c831SNamhyung Kim 	for (i = idx; i < 1 << fgd->hash->size_bits; i++) {
6188b9b0c831SNamhyung Kim 		head = &fgd->hash->buckets[i];
6189b9b0c831SNamhyung Kim 		hlist_for_each_entry(entry, head, hlist) {
6190b9b0c831SNamhyung Kim 			fgd->entry = entry;
6191b9b0c831SNamhyung Kim 			fgd->idx = i;
6192b9b0c831SNamhyung Kim 			return entry;
6193b9b0c831SNamhyung Kim 		}
6194b9b0c831SNamhyung Kim 	}
6195b9b0c831SNamhyung Kim 	return NULL;
619685951842SLi Zefan }
6197ea4e2bc4SSteven Rostedt 
619885951842SLi Zefan static void *
619985951842SLi Zefan g_next(struct seq_file *m, void *v, loff_t *pos)
620085951842SLi Zefan {
620185951842SLi Zefan 	(*pos)++;
620285951842SLi Zefan 	return __g_next(m, pos);
6203ea4e2bc4SSteven Rostedt }
6204ea4e2bc4SSteven Rostedt 
6205ea4e2bc4SSteven Rostedt static void *g_start(struct seq_file *m, loff_t *pos)
6206ea4e2bc4SSteven Rostedt {
6207faf982a6SNamhyung Kim 	struct ftrace_graph_data *fgd = m->private;
6208faf982a6SNamhyung Kim 
6209ea4e2bc4SSteven Rostedt 	mutex_lock(&graph_lock);
6210ea4e2bc4SSteven Rostedt 
6211649b988bSSteven Rostedt (VMware) 	if (fgd->type == GRAPH_FILTER_FUNCTION)
6212649b988bSSteven Rostedt (VMware) 		fgd->hash = rcu_dereference_protected(ftrace_graph_hash,
6213649b988bSSteven Rostedt (VMware) 					lockdep_is_held(&graph_lock));
6214649b988bSSteven Rostedt (VMware) 	else
6215649b988bSSteven Rostedt (VMware) 		fgd->hash = rcu_dereference_protected(ftrace_graph_notrace_hash,
6216649b988bSSteven Rostedt (VMware) 					lockdep_is_held(&graph_lock));
6217649b988bSSteven Rostedt (VMware) 
6218f9349a8fSFrederic Weisbecker 	/* Nothing, tell g_show to print all functions are enabled */
6219b9b0c831SNamhyung Kim 	if (ftrace_hash_empty(fgd->hash) && !*pos)
6220555fc781SSteven Rostedt (VMware) 		return FTRACE_GRAPH_EMPTY;
6221f9349a8fSFrederic Weisbecker 
6222b9b0c831SNamhyung Kim 	fgd->idx = 0;
6223b9b0c831SNamhyung Kim 	fgd->entry = NULL;
622485951842SLi Zefan 	return __g_next(m, pos);
6225ea4e2bc4SSteven Rostedt }
6226ea4e2bc4SSteven Rostedt 
6227ea4e2bc4SSteven Rostedt static void g_stop(struct seq_file *m, void *p)
6228ea4e2bc4SSteven Rostedt {
6229ea4e2bc4SSteven Rostedt 	mutex_unlock(&graph_lock);
6230ea4e2bc4SSteven Rostedt }
6231ea4e2bc4SSteven Rostedt 
6232ea4e2bc4SSteven Rostedt static int g_show(struct seq_file *m, void *v)
6233ea4e2bc4SSteven Rostedt {
6234b9b0c831SNamhyung Kim 	struct ftrace_func_entry *entry = v;
6235ea4e2bc4SSteven Rostedt 
6236b9b0c831SNamhyung Kim 	if (!entry)
6237ea4e2bc4SSteven Rostedt 		return 0;
6238ea4e2bc4SSteven Rostedt 
6239555fc781SSteven Rostedt (VMware) 	if (entry == FTRACE_GRAPH_EMPTY) {
6240280d1429SNamhyung Kim 		struct ftrace_graph_data *fgd = m->private;
6241280d1429SNamhyung Kim 
6242b9b0c831SNamhyung Kim 		if (fgd->type == GRAPH_FILTER_FUNCTION)
6243fa6f0cc7SRasmus Villemoes 			seq_puts(m, "#### all functions enabled ####\n");
6244280d1429SNamhyung Kim 		else
6245fa6f0cc7SRasmus Villemoes 			seq_puts(m, "#### no functions disabled ####\n");
6246f9349a8fSFrederic Weisbecker 		return 0;
6247f9349a8fSFrederic Weisbecker 	}
6248f9349a8fSFrederic Weisbecker 
6249b9b0c831SNamhyung Kim 	seq_printf(m, "%ps\n", (void *)entry->ip);
6250ea4e2bc4SSteven Rostedt 
6251ea4e2bc4SSteven Rostedt 	return 0;
6252ea4e2bc4SSteven Rostedt }
6253ea4e2bc4SSteven Rostedt 
625488e9d34cSJames Morris static const struct seq_operations ftrace_graph_seq_ops = {
6255ea4e2bc4SSteven Rostedt 	.start = g_start,
6256ea4e2bc4SSteven Rostedt 	.next = g_next,
6257ea4e2bc4SSteven Rostedt 	.stop = g_stop,
6258ea4e2bc4SSteven Rostedt 	.show = g_show,
6259ea4e2bc4SSteven Rostedt };
6260ea4e2bc4SSteven Rostedt 
6261ea4e2bc4SSteven Rostedt static int
6262faf982a6SNamhyung Kim __ftrace_graph_open(struct inode *inode, struct file *file,
6263faf982a6SNamhyung Kim 		    struct ftrace_graph_data *fgd)
6264ea4e2bc4SSteven Rostedt {
626517911ff3SSteven Rostedt (VMware) 	int ret;
6266b9b0c831SNamhyung Kim 	struct ftrace_hash *new_hash = NULL;
6267ea4e2bc4SSteven Rostedt 
626817911ff3SSteven Rostedt (VMware) 	ret = security_locked_down(LOCKDOWN_TRACEFS);
626917911ff3SSteven Rostedt (VMware) 	if (ret)
627017911ff3SSteven Rostedt (VMware) 		return ret;
627117911ff3SSteven Rostedt (VMware) 
6272b9b0c831SNamhyung Kim 	if (file->f_mode & FMODE_WRITE) {
6273b9b0c831SNamhyung Kim 		const int size_bits = FTRACE_HASH_DEFAULT_BITS;
6274b9b0c831SNamhyung Kim 
6275e704eff3SSteven Rostedt (VMware) 		if (trace_parser_get_init(&fgd->parser, FTRACE_BUFF_MAX))
6276e704eff3SSteven Rostedt (VMware) 			return -ENOMEM;
6277e704eff3SSteven Rostedt (VMware) 
6278b9b0c831SNamhyung Kim 		if (file->f_flags & O_TRUNC)
6279b9b0c831SNamhyung Kim 			new_hash = alloc_ftrace_hash(size_bits);
6280b9b0c831SNamhyung Kim 		else
6281b9b0c831SNamhyung Kim 			new_hash = alloc_and_copy_ftrace_hash(size_bits,
6282b9b0c831SNamhyung Kim 							      fgd->hash);
6283b9b0c831SNamhyung Kim 		if (!new_hash) {
6284b9b0c831SNamhyung Kim 			ret = -ENOMEM;
6285b9b0c831SNamhyung Kim 			goto out;
6286ea4e2bc4SSteven Rostedt 		}
6287b9b0c831SNamhyung Kim 	}
6288ea4e2bc4SSteven Rostedt 
6289faf982a6SNamhyung Kim 	if (file->f_mode & FMODE_READ) {
6290b9b0c831SNamhyung Kim 		ret = seq_open(file, &ftrace_graph_seq_ops);
6291faf982a6SNamhyung Kim 		if (!ret) {
6292faf982a6SNamhyung Kim 			struct seq_file *m = file->private_data;
6293faf982a6SNamhyung Kim 			m->private = fgd;
6294b9b0c831SNamhyung Kim 		} else {
6295b9b0c831SNamhyung Kim 			/* Failed */
6296b9b0c831SNamhyung Kim 			free_ftrace_hash(new_hash);
6297b9b0c831SNamhyung Kim 			new_hash = NULL;
6298faf982a6SNamhyung Kim 		}
6299faf982a6SNamhyung Kim 	} else
6300faf982a6SNamhyung Kim 		file->private_data = fgd;
6301a4ec5e0cSLi Zefan 
6302b9b0c831SNamhyung Kim out:
6303e704eff3SSteven Rostedt (VMware) 	if (ret < 0 && file->f_mode & FMODE_WRITE)
6304e704eff3SSteven Rostedt (VMware) 		trace_parser_put(&fgd->parser);
6305e704eff3SSteven Rostedt (VMware) 
6306b9b0c831SNamhyung Kim 	fgd->new_hash = new_hash;
6307649b988bSSteven Rostedt (VMware) 
6308649b988bSSteven Rostedt (VMware) 	/*
6309649b988bSSteven Rostedt (VMware) 	 * All uses of fgd->hash must be taken with the graph_lock
6310649b988bSSteven Rostedt (VMware) 	 * held. The graph_lock is going to be released, so force
6311649b988bSSteven Rostedt (VMware) 	 * fgd->hash to be reinitialized when it is taken again.
6312649b988bSSteven Rostedt (VMware) 	 */
6313649b988bSSteven Rostedt (VMware) 	fgd->hash = NULL;
6314649b988bSSteven Rostedt (VMware) 
6315ea4e2bc4SSteven Rostedt 	return ret;
6316ea4e2bc4SSteven Rostedt }
6317ea4e2bc4SSteven Rostedt 
6318ea4e2bc4SSteven Rostedt static int
6319faf982a6SNamhyung Kim ftrace_graph_open(struct inode *inode, struct file *file)
6320faf982a6SNamhyung Kim {
6321faf982a6SNamhyung Kim 	struct ftrace_graph_data *fgd;
6322b9b0c831SNamhyung Kim 	int ret;
6323faf982a6SNamhyung Kim 
6324faf982a6SNamhyung Kim 	if (unlikely(ftrace_disabled))
6325faf982a6SNamhyung Kim 		return -ENODEV;
6326faf982a6SNamhyung Kim 
6327faf982a6SNamhyung Kim 	fgd = kmalloc(sizeof(*fgd), GFP_KERNEL);
6328faf982a6SNamhyung Kim 	if (fgd == NULL)
6329faf982a6SNamhyung Kim 		return -ENOMEM;
6330faf982a6SNamhyung Kim 
6331b9b0c831SNamhyung Kim 	mutex_lock(&graph_lock);
6332b9b0c831SNamhyung Kim 
6333649b988bSSteven Rostedt (VMware) 	fgd->hash = rcu_dereference_protected(ftrace_graph_hash,
6334649b988bSSteven Rostedt (VMware) 					lockdep_is_held(&graph_lock));
6335b9b0c831SNamhyung Kim 	fgd->type = GRAPH_FILTER_FUNCTION;
6336faf982a6SNamhyung Kim 	fgd->seq_ops = &ftrace_graph_seq_ops;
6337faf982a6SNamhyung Kim 
6338b9b0c831SNamhyung Kim 	ret = __ftrace_graph_open(inode, file, fgd);
6339b9b0c831SNamhyung Kim 	if (ret < 0)
6340b9b0c831SNamhyung Kim 		kfree(fgd);
6341b9b0c831SNamhyung Kim 
6342b9b0c831SNamhyung Kim 	mutex_unlock(&graph_lock);
6343b9b0c831SNamhyung Kim 	return ret;
6344faf982a6SNamhyung Kim }
6345faf982a6SNamhyung Kim 
6346faf982a6SNamhyung Kim static int
634729ad23b0SNamhyung Kim ftrace_graph_notrace_open(struct inode *inode, struct file *file)
634829ad23b0SNamhyung Kim {
634929ad23b0SNamhyung Kim 	struct ftrace_graph_data *fgd;
6350b9b0c831SNamhyung Kim 	int ret;
635129ad23b0SNamhyung Kim 
635229ad23b0SNamhyung Kim 	if (unlikely(ftrace_disabled))
635329ad23b0SNamhyung Kim 		return -ENODEV;
635429ad23b0SNamhyung Kim 
635529ad23b0SNamhyung Kim 	fgd = kmalloc(sizeof(*fgd), GFP_KERNEL);
635629ad23b0SNamhyung Kim 	if (fgd == NULL)
635729ad23b0SNamhyung Kim 		return -ENOMEM;
635829ad23b0SNamhyung Kim 
6359b9b0c831SNamhyung Kim 	mutex_lock(&graph_lock);
6360b9b0c831SNamhyung Kim 
6361649b988bSSteven Rostedt (VMware) 	fgd->hash = rcu_dereference_protected(ftrace_graph_notrace_hash,
6362649b988bSSteven Rostedt (VMware) 					lockdep_is_held(&graph_lock));
6363b9b0c831SNamhyung Kim 	fgd->type = GRAPH_FILTER_NOTRACE;
636429ad23b0SNamhyung Kim 	fgd->seq_ops = &ftrace_graph_seq_ops;
636529ad23b0SNamhyung Kim 
6366b9b0c831SNamhyung Kim 	ret = __ftrace_graph_open(inode, file, fgd);
6367b9b0c831SNamhyung Kim 	if (ret < 0)
6368b9b0c831SNamhyung Kim 		kfree(fgd);
6369b9b0c831SNamhyung Kim 
6370b9b0c831SNamhyung Kim 	mutex_unlock(&graph_lock);
6371b9b0c831SNamhyung Kim 	return ret;
637229ad23b0SNamhyung Kim }
637329ad23b0SNamhyung Kim 
637429ad23b0SNamhyung Kim static int
637587827111SLi Zefan ftrace_graph_release(struct inode *inode, struct file *file)
637687827111SLi Zefan {
6377b9b0c831SNamhyung Kim 	struct ftrace_graph_data *fgd;
6378e704eff3SSteven Rostedt (VMware) 	struct ftrace_hash *old_hash, *new_hash;
6379e704eff3SSteven Rostedt (VMware) 	struct trace_parser *parser;
6380e704eff3SSteven Rostedt (VMware) 	int ret = 0;
6381b9b0c831SNamhyung Kim 
6382faf982a6SNamhyung Kim 	if (file->f_mode & FMODE_READ) {
6383faf982a6SNamhyung Kim 		struct seq_file *m = file->private_data;
6384faf982a6SNamhyung Kim 
6385b9b0c831SNamhyung Kim 		fgd = m->private;
638687827111SLi Zefan 		seq_release(inode, file);
6387faf982a6SNamhyung Kim 	} else {
6388b9b0c831SNamhyung Kim 		fgd = file->private_data;
6389faf982a6SNamhyung Kim 	}
6390faf982a6SNamhyung Kim 
6391e704eff3SSteven Rostedt (VMware) 
6392e704eff3SSteven Rostedt (VMware) 	if (file->f_mode & FMODE_WRITE) {
6393e704eff3SSteven Rostedt (VMware) 
6394e704eff3SSteven Rostedt (VMware) 		parser = &fgd->parser;
6395e704eff3SSteven Rostedt (VMware) 
6396e704eff3SSteven Rostedt (VMware) 		if (trace_parser_loaded((parser))) {
6397e704eff3SSteven Rostedt (VMware) 			ret = ftrace_graph_set_hash(fgd->new_hash,
6398e704eff3SSteven Rostedt (VMware) 						    parser->buffer);
6399e704eff3SSteven Rostedt (VMware) 		}
6400e704eff3SSteven Rostedt (VMware) 
6401e704eff3SSteven Rostedt (VMware) 		trace_parser_put(parser);
6402e704eff3SSteven Rostedt (VMware) 
6403e704eff3SSteven Rostedt (VMware) 		new_hash = __ftrace_hash_move(fgd->new_hash);
6404e704eff3SSteven Rostedt (VMware) 		if (!new_hash) {
6405e704eff3SSteven Rostedt (VMware) 			ret = -ENOMEM;
6406e704eff3SSteven Rostedt (VMware) 			goto out;
6407e704eff3SSteven Rostedt (VMware) 		}
6408e704eff3SSteven Rostedt (VMware) 
6409e704eff3SSteven Rostedt (VMware) 		mutex_lock(&graph_lock);
6410e704eff3SSteven Rostedt (VMware) 
6411e704eff3SSteven Rostedt (VMware) 		if (fgd->type == GRAPH_FILTER_FUNCTION) {
6412e704eff3SSteven Rostedt (VMware) 			old_hash = rcu_dereference_protected(ftrace_graph_hash,
6413e704eff3SSteven Rostedt (VMware) 					lockdep_is_held(&graph_lock));
6414e704eff3SSteven Rostedt (VMware) 			rcu_assign_pointer(ftrace_graph_hash, new_hash);
6415e704eff3SSteven Rostedt (VMware) 		} else {
6416e704eff3SSteven Rostedt (VMware) 			old_hash = rcu_dereference_protected(ftrace_graph_notrace_hash,
6417e704eff3SSteven Rostedt (VMware) 					lockdep_is_held(&graph_lock));
6418e704eff3SSteven Rostedt (VMware) 			rcu_assign_pointer(ftrace_graph_notrace_hash, new_hash);
6419e704eff3SSteven Rostedt (VMware) 		}
6420e704eff3SSteven Rostedt (VMware) 
6421e704eff3SSteven Rostedt (VMware) 		mutex_unlock(&graph_lock);
6422e704eff3SSteven Rostedt (VMware) 
642354a16ff6SSteven Rostedt (VMware) 		/*
642454a16ff6SSteven Rostedt (VMware) 		 * We need to do a hard force of sched synchronization.
642554a16ff6SSteven Rostedt (VMware) 		 * This is because we use preempt_disable() to do RCU, but
642654a16ff6SSteven Rostedt (VMware) 		 * the function tracers can be called where RCU is not watching
642754a16ff6SSteven Rostedt (VMware) 		 * (like before user_exit()). We can not rely on the RCU
642854a16ff6SSteven Rostedt (VMware) 		 * infrastructure to do the synchronization, thus we must do it
642954a16ff6SSteven Rostedt (VMware) 		 * ourselves.
643054a16ff6SSteven Rostedt (VMware) 		 */
643168e83498SNicolas Saenz Julienne 		if (old_hash != EMPTY_HASH)
6432e5a971d7SPaul E. McKenney 			synchronize_rcu_tasks_rude();
6433e704eff3SSteven Rostedt (VMware) 
6434e704eff3SSteven Rostedt (VMware) 		free_ftrace_hash(old_hash);
6435e704eff3SSteven Rostedt (VMware) 	}
6436e704eff3SSteven Rostedt (VMware) 
6437e704eff3SSteven Rostedt (VMware)  out:
6438f9797c2fSLuis Henriques 	free_ftrace_hash(fgd->new_hash);
6439b9b0c831SNamhyung Kim 	kfree(fgd);
6440b9b0c831SNamhyung Kim 
6441e704eff3SSteven Rostedt (VMware) 	return ret;
644287827111SLi Zefan }
644387827111SLi Zefan 
644487827111SLi Zefan static int
6445b9b0c831SNamhyung Kim ftrace_graph_set_hash(struct ftrace_hash *hash, char *buffer)
6446ea4e2bc4SSteven Rostedt {
64473ba00929SDmitry Safonov 	struct ftrace_glob func_g;
6448ea4e2bc4SSteven Rostedt 	struct dyn_ftrace *rec;
6449ea4e2bc4SSteven Rostedt 	struct ftrace_page *pg;
6450b9b0c831SNamhyung Kim 	struct ftrace_func_entry *entry;
6451c7c6b1feSLi Zefan 	int fail = 1;
64523ba00929SDmitry Safonov 	int not;
6453ea4e2bc4SSteven Rostedt 
6454f9349a8fSFrederic Weisbecker 	/* decode regex */
64553ba00929SDmitry Safonov 	func_g.type = filter_parse_regex(buffer, strlen(buffer),
64563ba00929SDmitry Safonov 					 &func_g.search, &not);
6457f9349a8fSFrederic Weisbecker 
64583ba00929SDmitry Safonov 	func_g.len = strlen(func_g.search);
6459f9349a8fSFrederic Weisbecker 
646052baf119SSteven Rostedt 	mutex_lock(&ftrace_lock);
646145a4a237SSteven Rostedt 
646245a4a237SSteven Rostedt 	if (unlikely(ftrace_disabled)) {
646345a4a237SSteven Rostedt 		mutex_unlock(&ftrace_lock);
646445a4a237SSteven Rostedt 		return -ENODEV;
646545a4a237SSteven Rostedt 	}
646645a4a237SSteven Rostedt 
6467265c831cSSteven Rostedt 	do_for_each_ftrace_rec(pg, rec) {
6468ea4e2bc4SSteven Rostedt 
6469546fece4SSteven Rostedt (Red Hat) 		if (rec->flags & FTRACE_FL_DISABLED)
6470546fece4SSteven Rostedt (Red Hat) 			continue;
6471546fece4SSteven Rostedt (Red Hat) 
64720b507e1eSDmitry Safonov 		if (ftrace_match_record(rec, &func_g, NULL, 0)) {
6473b9b0c831SNamhyung Kim 			entry = ftrace_lookup_ip(hash, rec->ip);
6474c7c6b1feSLi Zefan 
6475c7c6b1feSLi Zefan 			if (!not) {
6476c7c6b1feSLi Zefan 				fail = 0;
6477b9b0c831SNamhyung Kim 
6478b9b0c831SNamhyung Kim 				if (entry)
6479b9b0c831SNamhyung Kim 					continue;
6480b9b0c831SNamhyung Kim 				if (add_hash_entry(hash, rec->ip) < 0)
6481c7c6b1feSLi Zefan 					goto out;
6482c7c6b1feSLi Zefan 			} else {
6483b9b0c831SNamhyung Kim 				if (entry) {
6484b9b0c831SNamhyung Kim 					free_hash_entry(hash, entry);
6485c7c6b1feSLi Zefan 					fail = 0;
6486c7c6b1feSLi Zefan 				}
6487c7c6b1feSLi Zefan 			}
6488f9349a8fSFrederic Weisbecker 		}
6489265c831cSSteven Rostedt 	} while_for_each_ftrace_rec();
6490c7c6b1feSLi Zefan out:
649152baf119SSteven Rostedt 	mutex_unlock(&ftrace_lock);
6492ea4e2bc4SSteven Rostedt 
6493c7c6b1feSLi Zefan 	if (fail)
6494c7c6b1feSLi Zefan 		return -EINVAL;
6495c7c6b1feSLi Zefan 
6496c7c6b1feSLi Zefan 	return 0;
6497ea4e2bc4SSteven Rostedt }
6498ea4e2bc4SSteven Rostedt 
6499ea4e2bc4SSteven Rostedt static ssize_t
6500ea4e2bc4SSteven Rostedt ftrace_graph_write(struct file *file, const char __user *ubuf,
6501ea4e2bc4SSteven Rostedt 		   size_t cnt, loff_t *ppos)
6502ea4e2bc4SSteven Rostedt {
65036a10108bSNamhyung Kim 	ssize_t read, ret = 0;
6504faf982a6SNamhyung Kim 	struct ftrace_graph_data *fgd = file->private_data;
6505e704eff3SSteven Rostedt (VMware) 	struct trace_parser *parser;
6506ea4e2bc4SSteven Rostedt 
6507c7c6b1feSLi Zefan 	if (!cnt)
6508ea4e2bc4SSteven Rostedt 		return 0;
6509ea4e2bc4SSteven Rostedt 
6510ae98d27aSSteven Rostedt (VMware) 	/* Read mode uses seq functions */
6511ae98d27aSSteven Rostedt (VMware) 	if (file->f_mode & FMODE_READ) {
6512ae98d27aSSteven Rostedt (VMware) 		struct seq_file *m = file->private_data;
6513ae98d27aSSteven Rostedt (VMware) 		fgd = m->private;
6514ae98d27aSSteven Rostedt (VMware) 	}
6515ae98d27aSSteven Rostedt (VMware) 
6516e704eff3SSteven Rostedt (VMware) 	parser = &fgd->parser;
6517689fd8b6S[email protected] 
6518e704eff3SSteven Rostedt (VMware) 	read = trace_get_user(parser, ubuf, cnt, ppos);
6519ea4e2bc4SSteven Rostedt 
6520e704eff3SSteven Rostedt (VMware) 	if (read >= 0 && trace_parser_loaded(parser) &&
6521e704eff3SSteven Rostedt (VMware) 	    !trace_parser_cont(parser)) {
65226a10108bSNamhyung Kim 
6523b9b0c831SNamhyung Kim 		ret = ftrace_graph_set_hash(fgd->new_hash,
6524e704eff3SSteven Rostedt (VMware) 					    parser->buffer);
6525e704eff3SSteven Rostedt (VMware) 		trace_parser_clear(parser);
6526689fd8b6S[email protected] 	}
6527ea4e2bc4SSteven Rostedt 
65286a10108bSNamhyung Kim 	if (!ret)
6529ea4e2bc4SSteven Rostedt 		ret = read;
65301eb90f13SLi Zefan 
6531ea4e2bc4SSteven Rostedt 	return ret;
6532ea4e2bc4SSteven Rostedt }
6533ea4e2bc4SSteven Rostedt 
6534ea4e2bc4SSteven Rostedt static const struct file_operations ftrace_graph_fops = {
6535ea4e2bc4SSteven Rostedt 	.open		= ftrace_graph_open,
6536850a80cfSLai Jiangshan 	.read		= seq_read,
6537ea4e2bc4SSteven Rostedt 	.write		= ftrace_graph_write,
6538098c879eSSteven Rostedt (Red Hat) 	.llseek		= tracing_lseek,
653987827111SLi Zefan 	.release	= ftrace_graph_release,
6540ea4e2bc4SSteven Rostedt };
654129ad23b0SNamhyung Kim 
654229ad23b0SNamhyung Kim static const struct file_operations ftrace_graph_notrace_fops = {
654329ad23b0SNamhyung Kim 	.open		= ftrace_graph_notrace_open,
654429ad23b0SNamhyung Kim 	.read		= seq_read,
654529ad23b0SNamhyung Kim 	.write		= ftrace_graph_write,
6546098c879eSSteven Rostedt (Red Hat) 	.llseek		= tracing_lseek,
654729ad23b0SNamhyung Kim 	.release	= ftrace_graph_release,
654829ad23b0SNamhyung Kim };
6549ea4e2bc4SSteven Rostedt #endif /* CONFIG_FUNCTION_GRAPH_TRACER */
6550ea4e2bc4SSteven Rostedt 
6551591dffdaSSteven Rostedt (Red Hat) void ftrace_create_filter_files(struct ftrace_ops *ops,
6552591dffdaSSteven Rostedt (Red Hat) 				struct dentry *parent)
6553591dffdaSSteven Rostedt (Red Hat) {
6554591dffdaSSteven Rostedt (Red Hat) 
655521ccc9cdSSteven Rostedt (VMware) 	trace_create_file("set_ftrace_filter", TRACE_MODE_WRITE, parent,
6556591dffdaSSteven Rostedt (Red Hat) 			  ops, &ftrace_filter_fops);
6557591dffdaSSteven Rostedt (Red Hat) 
655821ccc9cdSSteven Rostedt (VMware) 	trace_create_file("set_ftrace_notrace", TRACE_MODE_WRITE, parent,
6559591dffdaSSteven Rostedt (Red Hat) 			  ops, &ftrace_notrace_fops);
6560591dffdaSSteven Rostedt (Red Hat) }
6561591dffdaSSteven Rostedt (Red Hat) 
6562591dffdaSSteven Rostedt (Red Hat) /*
6563591dffdaSSteven Rostedt (Red Hat)  * The name "destroy_filter_files" is really a misnomer. Although
65649efb85c5SHariprasad Kelam  * in the future, it may actually delete the files, but this is
6565591dffdaSSteven Rostedt (Red Hat)  * really intended to make sure the ops passed in are disabled
6566591dffdaSSteven Rostedt (Red Hat)  * and that when this function returns, the caller is free to
6567591dffdaSSteven Rostedt (Red Hat)  * free the ops.
6568591dffdaSSteven Rostedt (Red Hat)  *
6569591dffdaSSteven Rostedt (Red Hat)  * The "destroy" name is only to match the "create" name that this
6570591dffdaSSteven Rostedt (Red Hat)  * should be paired with.
6571591dffdaSSteven Rostedt (Red Hat)  */
6572591dffdaSSteven Rostedt (Red Hat) void ftrace_destroy_filter_files(struct ftrace_ops *ops)
6573591dffdaSSteven Rostedt (Red Hat) {
6574591dffdaSSteven Rostedt (Red Hat) 	mutex_lock(&ftrace_lock);
6575591dffdaSSteven Rostedt (Red Hat) 	if (ops->flags & FTRACE_OPS_FL_ENABLED)
6576591dffdaSSteven Rostedt (Red Hat) 		ftrace_shutdown(ops, 0);
6577591dffdaSSteven Rostedt (Red Hat) 	ops->flags |= FTRACE_OPS_FL_DELETED;
65782840f84fSSteven Rostedt (VMware) 	ftrace_free_filter(ops);
6579591dffdaSSteven Rostedt (Red Hat) 	mutex_unlock(&ftrace_lock);
6580591dffdaSSteven Rostedt (Red Hat) }
6581591dffdaSSteven Rostedt (Red Hat) 
65828434dc93SSteven Rostedt (Red Hat) static __init int ftrace_init_dyn_tracefs(struct dentry *d_tracer)
65835072c59fSSteven Rostedt {
65845072c59fSSteven Rostedt 
658521ccc9cdSSteven Rostedt (VMware) 	trace_create_file("available_filter_functions", TRACE_MODE_READ,
65865072c59fSSteven Rostedt 			d_tracer, NULL, &ftrace_avail_fops);
65875072c59fSSteven Rostedt 
658821ccc9cdSSteven Rostedt (VMware) 	trace_create_file("enabled_functions", TRACE_MODE_READ,
6589647bcd03SSteven Rostedt 			d_tracer, NULL, &ftrace_enabled_fops);
6590647bcd03SSteven Rostedt 
6591591dffdaSSteven Rostedt (Red Hat) 	ftrace_create_filter_files(&global_ops, d_tracer);
6592ad90c0e3SSteven Rostedt 
6593ea4e2bc4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
659421ccc9cdSSteven Rostedt (VMware) 	trace_create_file("set_graph_function", TRACE_MODE_WRITE, d_tracer,
6595ea4e2bc4SSteven Rostedt 				    NULL,
6596ea4e2bc4SSteven Rostedt 				    &ftrace_graph_fops);
659721ccc9cdSSteven Rostedt (VMware) 	trace_create_file("set_graph_notrace", TRACE_MODE_WRITE, d_tracer,
659829ad23b0SNamhyung Kim 				    NULL,
659929ad23b0SNamhyung Kim 				    &ftrace_graph_notrace_fops);
6600ea4e2bc4SSteven Rostedt #endif /* CONFIG_FUNCTION_GRAPH_TRACER */
6601ea4e2bc4SSteven Rostedt 
66025072c59fSSteven Rostedt 	return 0;
66035072c59fSSteven Rostedt }
66045072c59fSSteven Rostedt 
66059fd49328SSteven Rostedt static int ftrace_cmp_ips(const void *a, const void *b)
660668950619SSteven Rostedt {
66079fd49328SSteven Rostedt 	const unsigned long *ipa = a;
66089fd49328SSteven Rostedt 	const unsigned long *ipb = b;
660968950619SSteven Rostedt 
66109fd49328SSteven Rostedt 	if (*ipa > *ipb)
66119fd49328SSteven Rostedt 		return 1;
66129fd49328SSteven Rostedt 	if (*ipa < *ipb)
66139fd49328SSteven Rostedt 		return -1;
66149fd49328SSteven Rostedt 	return 0;
66159fd49328SSteven Rostedt }
66169fd49328SSteven Rostedt 
66178147dc78SSteven Rostedt (VMware) #ifdef CONFIG_FTRACE_SORT_STARTUP_TEST
66188147dc78SSteven Rostedt (VMware) static void test_is_sorted(unsigned long *start, unsigned long count)
66198147dc78SSteven Rostedt (VMware) {
66208147dc78SSteven Rostedt (VMware) 	int i;
66218147dc78SSteven Rostedt (VMware) 
66228147dc78SSteven Rostedt (VMware) 	for (i = 1; i < count; i++) {
66238147dc78SSteven Rostedt (VMware) 		if (WARN(start[i - 1] > start[i],
66248147dc78SSteven Rostedt (VMware) 			 "[%d] %pS at %lx is not sorted with %pS at %lx\n", i,
66258147dc78SSteven Rostedt (VMware) 			 (void *)start[i - 1], start[i - 1],
66268147dc78SSteven Rostedt (VMware) 			 (void *)start[i], start[i]))
66278147dc78SSteven Rostedt (VMware) 			break;
66288147dc78SSteven Rostedt (VMware) 	}
66298147dc78SSteven Rostedt (VMware) 	if (i == count)
66308147dc78SSteven Rostedt (VMware) 		pr_info("ftrace section at %px sorted properly\n", start);
66318147dc78SSteven Rostedt (VMware) }
66328147dc78SSteven Rostedt (VMware) #else
66338147dc78SSteven Rostedt (VMware) static void test_is_sorted(unsigned long *start, unsigned long count)
66348147dc78SSteven Rostedt (VMware) {
66358147dc78SSteven Rostedt (VMware) }
66368147dc78SSteven Rostedt (VMware) #endif
66378147dc78SSteven Rostedt (VMware) 
66385cb084bbSJiri Olsa static int ftrace_process_locs(struct module *mod,
663931e88909SSteven Rostedt 			       unsigned long *start,
664068bf21aaSSteven Rostedt 			       unsigned long *end)
664168bf21aaSSteven Rostedt {
6642706c81f8SSteven Rostedt 	struct ftrace_page *start_pg;
6643a7900875SSteven Rostedt 	struct ftrace_page *pg;
6644706c81f8SSteven Rostedt 	struct dyn_ftrace *rec;
6645a7900875SSteven Rostedt 	unsigned long count;
664668bf21aaSSteven Rostedt 	unsigned long *p;
664768bf21aaSSteven Rostedt 	unsigned long addr;
66484376cac6SSteven Rostedt 	unsigned long flags = 0; /* Shut up gcc */
6649a7900875SSteven Rostedt 	int ret = -ENOMEM;
6650a7900875SSteven Rostedt 
6651a7900875SSteven Rostedt 	count = end - start;
6652a7900875SSteven Rostedt 
6653a7900875SSteven Rostedt 	if (!count)
6654a7900875SSteven Rostedt 		return 0;
6655a7900875SSteven Rostedt 
665672b3942aSYinan Liu 	/*
665772b3942aSYinan Liu 	 * Sorting mcount in vmlinux at build time depend on
66586b9b6413SSteven Rostedt (Google) 	 * CONFIG_BUILDTIME_MCOUNT_SORT, while mcount loc in
665972b3942aSYinan Liu 	 * modules can not be sorted at build time.
666072b3942aSYinan Liu 	 */
66616b9b6413SSteven Rostedt (Google) 	if (!IS_ENABLED(CONFIG_BUILDTIME_MCOUNT_SORT) || mod) {
66629fd49328SSteven Rostedt 		sort(start, count, sizeof(*start),
66636db02903SRasmus Villemoes 		     ftrace_cmp_ips, NULL);
66648147dc78SSteven Rostedt (VMware) 	} else {
66658147dc78SSteven Rostedt (VMware) 		test_is_sorted(start, count);
666672b3942aSYinan Liu 	}
66679fd49328SSteven Rostedt 
6668706c81f8SSteven Rostedt 	start_pg = ftrace_allocate_pages(count);
6669706c81f8SSteven Rostedt 	if (!start_pg)
6670a7900875SSteven Rostedt 		return -ENOMEM;
667168bf21aaSSteven Rostedt 
6672e6ea44e9SSteven Rostedt 	mutex_lock(&ftrace_lock);
6673a7900875SSteven Rostedt 
667432082309SSteven Rostedt 	/*
667532082309SSteven Rostedt 	 * Core and each module needs their own pages, as
667632082309SSteven Rostedt 	 * modules will free them when they are removed.
667732082309SSteven Rostedt 	 * Force a new page to be allocated for modules.
667832082309SSteven Rostedt 	 */
6679a7900875SSteven Rostedt 	if (!mod) {
6680a7900875SSteven Rostedt 		WARN_ON(ftrace_pages || ftrace_pages_start);
6681a7900875SSteven Rostedt 		/* First initialization */
6682706c81f8SSteven Rostedt 		ftrace_pages = ftrace_pages_start = start_pg;
6683a7900875SSteven Rostedt 	} else {
668432082309SSteven Rostedt 		if (!ftrace_pages)
6685a7900875SSteven Rostedt 			goto out;
668632082309SSteven Rostedt 
6687a7900875SSteven Rostedt 		if (WARN_ON(ftrace_pages->next)) {
6688a7900875SSteven Rostedt 			/* Hmm, we have free pages? */
6689a7900875SSteven Rostedt 			while (ftrace_pages->next)
669032082309SSteven Rostedt 				ftrace_pages = ftrace_pages->next;
669132082309SSteven Rostedt 		}
6692a7900875SSteven Rostedt 
6693706c81f8SSteven Rostedt 		ftrace_pages->next = start_pg;
669432082309SSteven Rostedt 	}
669532082309SSteven Rostedt 
669668bf21aaSSteven Rostedt 	p = start;
6697706c81f8SSteven Rostedt 	pg = start_pg;
669868bf21aaSSteven Rostedt 	while (p < end) {
6699db42523bSLinus Torvalds 		unsigned long end_offset;
670068bf21aaSSteven Rostedt 		addr = ftrace_call_adjust(*p++);
670120e5227eSSteven Rostedt 		/*
670220e5227eSSteven Rostedt 		 * Some architecture linkers will pad between
670320e5227eSSteven Rostedt 		 * the different mcount_loc sections of different
670420e5227eSSteven Rostedt 		 * object files to satisfy alignments.
670520e5227eSSteven Rostedt 		 * Skip any NULL pointers.
670620e5227eSSteven Rostedt 		 */
670720e5227eSSteven Rostedt 		if (!addr)
670820e5227eSSteven Rostedt 			continue;
6709706c81f8SSteven Rostedt 
6710db42523bSLinus Torvalds 		end_offset = (pg->index+1) * sizeof(pg->records[0]);
6711db42523bSLinus Torvalds 		if (end_offset > PAGE_SIZE << pg->order) {
6712706c81f8SSteven Rostedt 			/* We should have allocated enough */
6713706c81f8SSteven Rostedt 			if (WARN_ON(!pg->next))
6714a7900875SSteven Rostedt 				break;
6715706c81f8SSteven Rostedt 			pg = pg->next;
671668bf21aaSSteven Rostedt 		}
671768bf21aaSSteven Rostedt 
6718706c81f8SSteven Rostedt 		rec = &pg->records[pg->index++];
6719706c81f8SSteven Rostedt 		rec->ip = addr;
6720706c81f8SSteven Rostedt 	}
6721706c81f8SSteven Rostedt 
6722706c81f8SSteven Rostedt 	/* We should have used all pages */
6723706c81f8SSteven Rostedt 	WARN_ON(pg->next);
6724706c81f8SSteven Rostedt 
6725706c81f8SSteven Rostedt 	/* Assign the last page to ftrace_pages */
6726706c81f8SSteven Rostedt 	ftrace_pages = pg;
6727706c81f8SSteven Rostedt 
6728a4f18ed1SSteven Rostedt 	/*
67294376cac6SSteven Rostedt 	 * We only need to disable interrupts on start up
67304376cac6SSteven Rostedt 	 * because we are modifying code that an interrupt
67314376cac6SSteven Rostedt 	 * may execute, and the modification is not atomic.
67324376cac6SSteven Rostedt 	 * But for modules, nothing runs the code we modify
67334376cac6SSteven Rostedt 	 * until we are finished with it, and there's no
67344376cac6SSteven Rostedt 	 * reason to cause large interrupt latencies while we do it.
6735a4f18ed1SSteven Rostedt 	 */
67364376cac6SSteven Rostedt 	if (!mod)
6737a4f18ed1SSteven Rostedt 		local_irq_save(flags);
67381dc43cf0SJiri Slaby 	ftrace_update_code(mod, start_pg);
67394376cac6SSteven Rostedt 	if (!mod)
6740a4f18ed1SSteven Rostedt 		local_irq_restore(flags);
6741a7900875SSteven Rostedt 	ret = 0;
6742a7900875SSteven Rostedt  out:
6743e6ea44e9SSteven Rostedt 	mutex_unlock(&ftrace_lock);
674468bf21aaSSteven Rostedt 
6745a7900875SSteven Rostedt 	return ret;
674668bf21aaSSteven Rostedt }
674768bf21aaSSteven Rostedt 
6748aba4b5c2SSteven Rostedt (VMware) struct ftrace_mod_func {
6749aba4b5c2SSteven Rostedt (VMware) 	struct list_head	list;
6750aba4b5c2SSteven Rostedt (VMware) 	char			*name;
6751aba4b5c2SSteven Rostedt (VMware) 	unsigned long		ip;
6752aba4b5c2SSteven Rostedt (VMware) 	unsigned int		size;
6753aba4b5c2SSteven Rostedt (VMware) };
6754aba4b5c2SSteven Rostedt (VMware) 
6755aba4b5c2SSteven Rostedt (VMware) struct ftrace_mod_map {
67566aa69784SSteven Rostedt (VMware) 	struct rcu_head		rcu;
6757aba4b5c2SSteven Rostedt (VMware) 	struct list_head	list;
6758aba4b5c2SSteven Rostedt (VMware) 	struct module		*mod;
6759aba4b5c2SSteven Rostedt (VMware) 	unsigned long		start_addr;
6760aba4b5c2SSteven Rostedt (VMware) 	unsigned long		end_addr;
6761aba4b5c2SSteven Rostedt (VMware) 	struct list_head	funcs;
67626171a031SSteven Rostedt (VMware) 	unsigned int		num_funcs;
6763aba4b5c2SSteven Rostedt (VMware) };
6764aba4b5c2SSteven Rostedt (VMware) 
6765fc0ea795SAdrian Hunter static int ftrace_get_trampoline_kallsym(unsigned int symnum,
6766fc0ea795SAdrian Hunter 					 unsigned long *value, char *type,
6767fc0ea795SAdrian Hunter 					 char *name, char *module_name,
6768fc0ea795SAdrian Hunter 					 int *exported)
6769fc0ea795SAdrian Hunter {
6770fc0ea795SAdrian Hunter 	struct ftrace_ops *op;
6771fc0ea795SAdrian Hunter 
6772fc0ea795SAdrian Hunter 	list_for_each_entry_rcu(op, &ftrace_ops_trampoline_list, list) {
6773fc0ea795SAdrian Hunter 		if (!op->trampoline || symnum--)
6774fc0ea795SAdrian Hunter 			continue;
6775fc0ea795SAdrian Hunter 		*value = op->trampoline;
6776fc0ea795SAdrian Hunter 		*type = 't';
6777fc0ea795SAdrian Hunter 		strlcpy(name, FTRACE_TRAMPOLINE_SYM, KSYM_NAME_LEN);
6778fc0ea795SAdrian Hunter 		strlcpy(module_name, FTRACE_TRAMPOLINE_MOD, MODULE_NAME_LEN);
6779fc0ea795SAdrian Hunter 		*exported = 0;
6780fc0ea795SAdrian Hunter 		return 0;
6781fc0ea795SAdrian Hunter 	}
6782fc0ea795SAdrian Hunter 
6783fc0ea795SAdrian Hunter 	return -ERANGE;
6784fc0ea795SAdrian Hunter }
6785fc0ea795SAdrian Hunter 
6786123d6455SWang Jingjin #if defined(CONFIG_DYNAMIC_FTRACE_WITH_DIRECT_CALLS) || defined(CONFIG_MODULES)
6787123d6455SWang Jingjin /*
6788123d6455SWang Jingjin  * Check if the current ops references the given ip.
6789123d6455SWang Jingjin  *
6790123d6455SWang Jingjin  * If the ops traces all functions, then it was already accounted for.
6791123d6455SWang Jingjin  * If the ops does not trace the current record function, skip it.
6792123d6455SWang Jingjin  * If the ops ignores the function via notrace filter, skip it.
6793123d6455SWang Jingjin  */
6794123d6455SWang Jingjin static bool
6795123d6455SWang Jingjin ops_references_ip(struct ftrace_ops *ops, unsigned long ip)
6796123d6455SWang Jingjin {
6797123d6455SWang Jingjin 	/* If ops isn't enabled, ignore it */
6798123d6455SWang Jingjin 	if (!(ops->flags & FTRACE_OPS_FL_ENABLED))
6799123d6455SWang Jingjin 		return false;
6800123d6455SWang Jingjin 
6801123d6455SWang Jingjin 	/* If ops traces all then it includes this function */
6802123d6455SWang Jingjin 	if (ops_traces_mod(ops))
6803123d6455SWang Jingjin 		return true;
6804123d6455SWang Jingjin 
6805123d6455SWang Jingjin 	/* The function must be in the filter */
6806123d6455SWang Jingjin 	if (!ftrace_hash_empty(ops->func_hash->filter_hash) &&
6807123d6455SWang Jingjin 	    !__ftrace_lookup_ip(ops->func_hash->filter_hash, ip))
6808123d6455SWang Jingjin 		return false;
6809123d6455SWang Jingjin 
6810123d6455SWang Jingjin 	/* If in notrace hash, we ignore it too */
6811123d6455SWang Jingjin 	if (ftrace_lookup_ip(ops->func_hash->notrace_hash, ip))
6812123d6455SWang Jingjin 		return false;
6813123d6455SWang Jingjin 
6814123d6455SWang Jingjin 	return true;
6815123d6455SWang Jingjin }
6816123d6455SWang Jingjin #endif
6817123d6455SWang Jingjin 
681893eb677dSSteven Rostedt #ifdef CONFIG_MODULES
681932082309SSteven Rostedt 
682032082309SSteven Rostedt #define next_to_ftrace_page(p) container_of(p, struct ftrace_page, next)
682132082309SSteven Rostedt 
68226aa69784SSteven Rostedt (VMware) static LIST_HEAD(ftrace_mod_maps);
68236aa69784SSteven Rostedt (VMware) 
6824b7ffffbbSSteven Rostedt (Red Hat) static int referenced_filters(struct dyn_ftrace *rec)
6825b7ffffbbSSteven Rostedt (Red Hat) {
6826b7ffffbbSSteven Rostedt (Red Hat) 	struct ftrace_ops *ops;
6827b7ffffbbSSteven Rostedt (Red Hat) 	int cnt = 0;
6828b7ffffbbSSteven Rostedt (Red Hat) 
6829b7ffffbbSSteven Rostedt (Red Hat) 	for (ops = ftrace_ops_list; ops != &ftrace_list_end; ops = ops->next) {
6830123d6455SWang Jingjin 		if (ops_references_ip(ops, rec->ip)) {
6831c5f51572SChengming Zhou 			if (WARN_ON_ONCE(ops->flags & FTRACE_OPS_FL_DIRECT))
6832c5f51572SChengming Zhou 				continue;
6833c5f51572SChengming Zhou 			if (WARN_ON_ONCE(ops->flags & FTRACE_OPS_FL_IPMODIFY))
6834c5f51572SChengming Zhou 				continue;
6835b7ffffbbSSteven Rostedt (Red Hat) 			cnt++;
68368a224ffbSChengming Zhou 			if (ops->flags & FTRACE_OPS_FL_SAVE_REGS)
68378a224ffbSChengming Zhou 				rec->flags |= FTRACE_FL_REGS;
6838c5f51572SChengming Zhou 			if (cnt == 1 && ops->trampoline)
6839c5f51572SChengming Zhou 				rec->flags |= FTRACE_FL_TRAMP;
6840c5f51572SChengming Zhou 			else
6841c5f51572SChengming Zhou 				rec->flags &= ~FTRACE_FL_TRAMP;
68428a224ffbSChengming Zhou 		}
6843b7ffffbbSSteven Rostedt (Red Hat) 	}
6844b7ffffbbSSteven Rostedt (Red Hat) 
6845b7ffffbbSSteven Rostedt (Red Hat) 	return cnt;
6846b7ffffbbSSteven Rostedt (Red Hat) }
6847b7ffffbbSSteven Rostedt (Red Hat) 
68482a5bfe47SSteven Rostedt (VMware) static void
68492a5bfe47SSteven Rostedt (VMware) clear_mod_from_hash(struct ftrace_page *pg, struct ftrace_hash *hash)
68502a5bfe47SSteven Rostedt (VMware) {
68512a5bfe47SSteven Rostedt (VMware) 	struct ftrace_func_entry *entry;
68522a5bfe47SSteven Rostedt (VMware) 	struct dyn_ftrace *rec;
68532a5bfe47SSteven Rostedt (VMware) 	int i;
68542a5bfe47SSteven Rostedt (VMware) 
68552a5bfe47SSteven Rostedt (VMware) 	if (ftrace_hash_empty(hash))
68562a5bfe47SSteven Rostedt (VMware) 		return;
68572a5bfe47SSteven Rostedt (VMware) 
68582a5bfe47SSteven Rostedt (VMware) 	for (i = 0; i < pg->index; i++) {
68592a5bfe47SSteven Rostedt (VMware) 		rec = &pg->records[i];
68602a5bfe47SSteven Rostedt (VMware) 		entry = __ftrace_lookup_ip(hash, rec->ip);
68612a5bfe47SSteven Rostedt (VMware) 		/*
68622a5bfe47SSteven Rostedt (VMware) 		 * Do not allow this rec to match again.
68632a5bfe47SSteven Rostedt (VMware) 		 * Yeah, it may waste some memory, but will be removed
68642a5bfe47SSteven Rostedt (VMware) 		 * if/when the hash is modified again.
68652a5bfe47SSteven Rostedt (VMware) 		 */
68662a5bfe47SSteven Rostedt (VMware) 		if (entry)
68672a5bfe47SSteven Rostedt (VMware) 			entry->ip = 0;
68682a5bfe47SSteven Rostedt (VMware) 	}
68692a5bfe47SSteven Rostedt (VMware) }
68702a5bfe47SSteven Rostedt (VMware) 
6871f2cc020dSIngo Molnar /* Clear any records from hashes */
68722a5bfe47SSteven Rostedt (VMware) static void clear_mod_from_hashes(struct ftrace_page *pg)
68732a5bfe47SSteven Rostedt (VMware) {
68742a5bfe47SSteven Rostedt (VMware) 	struct trace_array *tr;
68752a5bfe47SSteven Rostedt (VMware) 
68762a5bfe47SSteven Rostedt (VMware) 	mutex_lock(&trace_types_lock);
68772a5bfe47SSteven Rostedt (VMware) 	list_for_each_entry(tr, &ftrace_trace_arrays, list) {
68782a5bfe47SSteven Rostedt (VMware) 		if (!tr->ops || !tr->ops->func_hash)
68792a5bfe47SSteven Rostedt (VMware) 			continue;
68802a5bfe47SSteven Rostedt (VMware) 		mutex_lock(&tr->ops->func_hash->regex_lock);
68812a5bfe47SSteven Rostedt (VMware) 		clear_mod_from_hash(pg, tr->ops->func_hash->filter_hash);
68822a5bfe47SSteven Rostedt (VMware) 		clear_mod_from_hash(pg, tr->ops->func_hash->notrace_hash);
68832a5bfe47SSteven Rostedt (VMware) 		mutex_unlock(&tr->ops->func_hash->regex_lock);
68842a5bfe47SSteven Rostedt (VMware) 	}
68852a5bfe47SSteven Rostedt (VMware) 	mutex_unlock(&trace_types_lock);
68862a5bfe47SSteven Rostedt (VMware) }
68872a5bfe47SSteven Rostedt (VMware) 
68886aa69784SSteven Rostedt (VMware) static void ftrace_free_mod_map(struct rcu_head *rcu)
68896aa69784SSteven Rostedt (VMware) {
68906aa69784SSteven Rostedt (VMware) 	struct ftrace_mod_map *mod_map = container_of(rcu, struct ftrace_mod_map, rcu);
68916aa69784SSteven Rostedt (VMware) 	struct ftrace_mod_func *mod_func;
68926aa69784SSteven Rostedt (VMware) 	struct ftrace_mod_func *n;
68936aa69784SSteven Rostedt (VMware) 
68946aa69784SSteven Rostedt (VMware) 	/* All the contents of mod_map are now not visible to readers */
68956aa69784SSteven Rostedt (VMware) 	list_for_each_entry_safe(mod_func, n, &mod_map->funcs, list) {
68966aa69784SSteven Rostedt (VMware) 		kfree(mod_func->name);
68976aa69784SSteven Rostedt (VMware) 		list_del(&mod_func->list);
68986aa69784SSteven Rostedt (VMware) 		kfree(mod_func);
68996aa69784SSteven Rostedt (VMware) 	}
69006aa69784SSteven Rostedt (VMware) 
69016aa69784SSteven Rostedt (VMware) 	kfree(mod_map);
69026aa69784SSteven Rostedt (VMware) }
69036aa69784SSteven Rostedt (VMware) 
6904e7247a15S[email protected] void ftrace_release_mod(struct module *mod)
690593eb677dSSteven Rostedt {
69066aa69784SSteven Rostedt (VMware) 	struct ftrace_mod_map *mod_map;
69076aa69784SSteven Rostedt (VMware) 	struct ftrace_mod_map *n;
690893eb677dSSteven Rostedt 	struct dyn_ftrace *rec;
690932082309SSteven Rostedt 	struct ftrace_page **last_pg;
69102a5bfe47SSteven Rostedt (VMware) 	struct ftrace_page *tmp_page = NULL;
691193eb677dSSteven Rostedt 	struct ftrace_page *pg;
691293eb677dSSteven Rostedt 
691393eb677dSSteven Rostedt 	mutex_lock(&ftrace_lock);
691445a4a237SSteven Rostedt 
691545a4a237SSteven Rostedt 	if (ftrace_disabled)
691645a4a237SSteven Rostedt 		goto out_unlock;
691745a4a237SSteven Rostedt 
69186aa69784SSteven Rostedt (VMware) 	list_for_each_entry_safe(mod_map, n, &ftrace_mod_maps, list) {
69196aa69784SSteven Rostedt (VMware) 		if (mod_map->mod == mod) {
69206aa69784SSteven Rostedt (VMware) 			list_del_rcu(&mod_map->list);
692174401729SPaul E. McKenney 			call_rcu(&mod_map->rcu, ftrace_free_mod_map);
69226aa69784SSteven Rostedt (VMware) 			break;
69236aa69784SSteven Rostedt (VMware) 		}
69246aa69784SSteven Rostedt (VMware) 	}
69256aa69784SSteven Rostedt (VMware) 
692632082309SSteven Rostedt 	/*
692732082309SSteven Rostedt 	 * Each module has its own ftrace_pages, remove
692832082309SSteven Rostedt 	 * them from the list.
692932082309SSteven Rostedt 	 */
693032082309SSteven Rostedt 	last_pg = &ftrace_pages_start;
693132082309SSteven Rostedt 	for (pg = ftrace_pages_start; pg; pg = *last_pg) {
693232082309SSteven Rostedt 		rec = &pg->records[0];
69333e234289SSteven Rostedt (VMware) 		if (within_module_core(rec->ip, mod) ||
69343e234289SSteven Rostedt (VMware) 		    within_module_init(rec->ip, mod)) {
693593eb677dSSteven Rostedt 			/*
693632082309SSteven Rostedt 			 * As core pages are first, the first
693732082309SSteven Rostedt 			 * page should never be a module page.
693893eb677dSSteven Rostedt 			 */
693932082309SSteven Rostedt 			if (WARN_ON(pg == ftrace_pages_start))
694032082309SSteven Rostedt 				goto out_unlock;
694132082309SSteven Rostedt 
694232082309SSteven Rostedt 			/* Check if we are deleting the last page */
694332082309SSteven Rostedt 			if (pg == ftrace_pages)
694432082309SSteven Rostedt 				ftrace_pages = next_to_ftrace_page(last_pg);
694532082309SSteven Rostedt 
694683dd1493SSteven Rostedt (VMware) 			ftrace_update_tot_cnt -= pg->index;
694732082309SSteven Rostedt 			*last_pg = pg->next;
69482a5bfe47SSteven Rostedt (VMware) 
69492a5bfe47SSteven Rostedt (VMware) 			pg->next = tmp_page;
69502a5bfe47SSteven Rostedt (VMware) 			tmp_page = pg;
695132082309SSteven Rostedt 		} else
695232082309SSteven Rostedt 			last_pg = &pg->next;
695393eb677dSSteven Rostedt 	}
695445a4a237SSteven Rostedt  out_unlock:
695593eb677dSSteven Rostedt 	mutex_unlock(&ftrace_lock);
69562a5bfe47SSteven Rostedt (VMware) 
69572a5bfe47SSteven Rostedt (VMware) 	for (pg = tmp_page; pg; pg = tmp_page) {
69582a5bfe47SSteven Rostedt (VMware) 
69592a5bfe47SSteven Rostedt (VMware) 		/* Needs to be called outside of ftrace_lock */
69602a5bfe47SSteven Rostedt (VMware) 		clear_mod_from_hashes(pg);
69612a5bfe47SSteven Rostedt (VMware) 
6962db42523bSLinus Torvalds 		if (pg->records) {
6963db42523bSLinus Torvalds 			free_pages((unsigned long)pg->records, pg->order);
6964db42523bSLinus Torvalds 			ftrace_number_of_pages -= 1 << pg->order;
6965db42523bSLinus Torvalds 		}
69662a5bfe47SSteven Rostedt (VMware) 		tmp_page = pg->next;
69672a5bfe47SSteven Rostedt (VMware) 		kfree(pg);
6968da537f0aSSteven Rostedt (VMware) 		ftrace_number_of_groups--;
69692a5bfe47SSteven Rostedt (VMware) 	}
697093eb677dSSteven Rostedt }
697193eb677dSSteven Rostedt 
69727dcd182bSJessica Yu void ftrace_module_enable(struct module *mod)
6973b7ffffbbSSteven Rostedt (Red Hat) {
6974b7ffffbbSSteven Rostedt (Red Hat) 	struct dyn_ftrace *rec;
6975b7ffffbbSSteven Rostedt (Red Hat) 	struct ftrace_page *pg;
6976b7ffffbbSSteven Rostedt (Red Hat) 
6977b7ffffbbSSteven Rostedt (Red Hat) 	mutex_lock(&ftrace_lock);
6978b7ffffbbSSteven Rostedt (Red Hat) 
6979b7ffffbbSSteven Rostedt (Red Hat) 	if (ftrace_disabled)
6980b7ffffbbSSteven Rostedt (Red Hat) 		goto out_unlock;
6981b7ffffbbSSteven Rostedt (Red Hat) 
6982b7ffffbbSSteven Rostedt (Red Hat) 	/*
6983b7ffffbbSSteven Rostedt (Red Hat) 	 * If the tracing is enabled, go ahead and enable the record.
6984b7ffffbbSSteven Rostedt (Red Hat) 	 *
69859efb85c5SHariprasad Kelam 	 * The reason not to enable the record immediately is the
6986b7ffffbbSSteven Rostedt (Red Hat) 	 * inherent check of ftrace_make_nop/ftrace_make_call for
6987b7ffffbbSSteven Rostedt (Red Hat) 	 * correct previous instructions.  Making first the NOP
6988b7ffffbbSSteven Rostedt (Red Hat) 	 * conversion puts the module to the correct state, thus
6989b7ffffbbSSteven Rostedt (Red Hat) 	 * passing the ftrace_make_call check.
6990b7ffffbbSSteven Rostedt (Red Hat) 	 *
6991b7ffffbbSSteven Rostedt (Red Hat) 	 * We also delay this to after the module code already set the
6992b7ffffbbSSteven Rostedt (Red Hat) 	 * text to read-only, as we now need to set it back to read-write
6993b7ffffbbSSteven Rostedt (Red Hat) 	 * so that we can modify the text.
6994b7ffffbbSSteven Rostedt (Red Hat) 	 */
6995b7ffffbbSSteven Rostedt (Red Hat) 	if (ftrace_start_up)
6996b7ffffbbSSteven Rostedt (Red Hat) 		ftrace_arch_code_modify_prepare();
6997b7ffffbbSSteven Rostedt (Red Hat) 
6998b7ffffbbSSteven Rostedt (Red Hat) 	do_for_each_ftrace_rec(pg, rec) {
6999b7ffffbbSSteven Rostedt (Red Hat) 		int cnt;
7000b7ffffbbSSteven Rostedt (Red Hat) 		/*
7001b7ffffbbSSteven Rostedt (Red Hat) 		 * do_for_each_ftrace_rec() is a double loop.
7002b7ffffbbSSteven Rostedt (Red Hat) 		 * module text shares the pg. If a record is
7003b7ffffbbSSteven Rostedt (Red Hat) 		 * not part of this module, then skip this pg,
7004b7ffffbbSSteven Rostedt (Red Hat) 		 * which the "break" will do.
7005b7ffffbbSSteven Rostedt (Red Hat) 		 */
70063e234289SSteven Rostedt (VMware) 		if (!within_module_core(rec->ip, mod) &&
70073e234289SSteven Rostedt (VMware) 		    !within_module_init(rec->ip, mod))
7008b7ffffbbSSteven Rostedt (Red Hat) 			break;
7009b7ffffbbSSteven Rostedt (Red Hat) 
7010b39181f7SSteven Rostedt (Google) 		/* Weak functions should still be ignored */
7011b39181f7SSteven Rostedt (Google) 		if (!test_for_valid_rec(rec)) {
7012b39181f7SSteven Rostedt (Google) 			/* Clear all other flags. Should not be enabled anyway */
7013b39181f7SSteven Rostedt (Google) 			rec->flags = FTRACE_FL_DISABLED;
7014b39181f7SSteven Rostedt (Google) 			continue;
7015b39181f7SSteven Rostedt (Google) 		}
7016b39181f7SSteven Rostedt (Google) 
7017b7ffffbbSSteven Rostedt (Red Hat) 		cnt = 0;
7018b7ffffbbSSteven Rostedt (Red Hat) 
7019b7ffffbbSSteven Rostedt (Red Hat) 		/*
7020b7ffffbbSSteven Rostedt (Red Hat) 		 * When adding a module, we need to check if tracers are
7021b7ffffbbSSteven Rostedt (Red Hat) 		 * currently enabled and if they are, and can trace this record,
7022b7ffffbbSSteven Rostedt (Red Hat) 		 * we need to enable the module functions as well as update the
7023b7ffffbbSSteven Rostedt (Red Hat) 		 * reference counts for those function records.
7024b7ffffbbSSteven Rostedt (Red Hat) 		 */
7025b7ffffbbSSteven Rostedt (Red Hat) 		if (ftrace_start_up)
7026b7ffffbbSSteven Rostedt (Red Hat) 			cnt += referenced_filters(rec);
7027b7ffffbbSSteven Rostedt (Red Hat) 
70288a224ffbSChengming Zhou 		rec->flags &= ~FTRACE_FL_DISABLED;
70298a224ffbSChengming Zhou 		rec->flags += cnt;
7030b7ffffbbSSteven Rostedt (Red Hat) 
7031b7ffffbbSSteven Rostedt (Red Hat) 		if (ftrace_start_up && cnt) {
7032b7ffffbbSSteven Rostedt (Red Hat) 			int failed = __ftrace_replace_code(rec, 1);
7033b7ffffbbSSteven Rostedt (Red Hat) 			if (failed) {
7034b7ffffbbSSteven Rostedt (Red Hat) 				ftrace_bug(failed, rec);
7035b7ffffbbSSteven Rostedt (Red Hat) 				goto out_loop;
7036b7ffffbbSSteven Rostedt (Red Hat) 			}
7037b7ffffbbSSteven Rostedt (Red Hat) 		}
7038b7ffffbbSSteven Rostedt (Red Hat) 
7039b7ffffbbSSteven Rostedt (Red Hat) 	} while_for_each_ftrace_rec();
7040b7ffffbbSSteven Rostedt (Red Hat) 
7041b7ffffbbSSteven Rostedt (Red Hat)  out_loop:
7042b7ffffbbSSteven Rostedt (Red Hat) 	if (ftrace_start_up)
7043b7ffffbbSSteven Rostedt (Red Hat) 		ftrace_arch_code_modify_post_process();
7044b7ffffbbSSteven Rostedt (Red Hat) 
7045b7ffffbbSSteven Rostedt (Red Hat)  out_unlock:
7046b7ffffbbSSteven Rostedt (Red Hat) 	mutex_unlock(&ftrace_lock);
7047d7fbf8dfSSteven Rostedt (VMware) 
7048d7fbf8dfSSteven Rostedt (VMware) 	process_cached_mods(mod->name);
7049b7ffffbbSSteven Rostedt (Red Hat) }
7050b7ffffbbSSteven Rostedt (Red Hat) 
7051a949ae56SSteven Rostedt (Red Hat) void ftrace_module_init(struct module *mod)
705293eb677dSSteven Rostedt {
70532889c658SYuntao Wang 	int ret;
70542889c658SYuntao Wang 
705597e9b4fcSSteven Rostedt (Red Hat) 	if (ftrace_disabled || !mod->num_ftrace_callsites)
7056b6b71f66SAbel Vesa 		return;
7057b6b71f66SAbel Vesa 
70582889c658SYuntao Wang 	ret = ftrace_process_locs(mod, mod->ftrace_callsites,
705997e9b4fcSSteven Rostedt (Red Hat) 				  mod->ftrace_callsites + mod->num_ftrace_callsites);
70602889c658SYuntao Wang 	if (ret)
70612889c658SYuntao Wang 		pr_warn("ftrace: failed to allocate entries for module '%s' functions\n",
70622889c658SYuntao Wang 			mod->name);
706393eb677dSSteven Rostedt }
7064aba4b5c2SSteven Rostedt (VMware) 
7065aba4b5c2SSteven Rostedt (VMware) static void save_ftrace_mod_rec(struct ftrace_mod_map *mod_map,
7066aba4b5c2SSteven Rostedt (VMware) 				struct dyn_ftrace *rec)
7067aba4b5c2SSteven Rostedt (VMware) {
7068aba4b5c2SSteven Rostedt (VMware) 	struct ftrace_mod_func *mod_func;
7069aba4b5c2SSteven Rostedt (VMware) 	unsigned long symsize;
7070aba4b5c2SSteven Rostedt (VMware) 	unsigned long offset;
7071aba4b5c2SSteven Rostedt (VMware) 	char str[KSYM_SYMBOL_LEN];
7072aba4b5c2SSteven Rostedt (VMware) 	char *modname;
7073aba4b5c2SSteven Rostedt (VMware) 	const char *ret;
7074aba4b5c2SSteven Rostedt (VMware) 
7075aba4b5c2SSteven Rostedt (VMware) 	ret = kallsyms_lookup(rec->ip, &symsize, &offset, &modname, str);
7076aba4b5c2SSteven Rostedt (VMware) 	if (!ret)
7077aba4b5c2SSteven Rostedt (VMware) 		return;
7078aba4b5c2SSteven Rostedt (VMware) 
7079aba4b5c2SSteven Rostedt (VMware) 	mod_func = kmalloc(sizeof(*mod_func), GFP_KERNEL);
7080aba4b5c2SSteven Rostedt (VMware) 	if (!mod_func)
7081aba4b5c2SSteven Rostedt (VMware) 		return;
7082aba4b5c2SSteven Rostedt (VMware) 
7083aba4b5c2SSteven Rostedt (VMware) 	mod_func->name = kstrdup(str, GFP_KERNEL);
7084aba4b5c2SSteven Rostedt (VMware) 	if (!mod_func->name) {
7085aba4b5c2SSteven Rostedt (VMware) 		kfree(mod_func);
7086aba4b5c2SSteven Rostedt (VMware) 		return;
7087aba4b5c2SSteven Rostedt (VMware) 	}
7088aba4b5c2SSteven Rostedt (VMware) 
7089aba4b5c2SSteven Rostedt (VMware) 	mod_func->ip = rec->ip - offset;
7090aba4b5c2SSteven Rostedt (VMware) 	mod_func->size = symsize;
7091aba4b5c2SSteven Rostedt (VMware) 
70926171a031SSteven Rostedt (VMware) 	mod_map->num_funcs++;
70936171a031SSteven Rostedt (VMware) 
7094aba4b5c2SSteven Rostedt (VMware) 	list_add_rcu(&mod_func->list, &mod_map->funcs);
7095aba4b5c2SSteven Rostedt (VMware) }
7096aba4b5c2SSteven Rostedt (VMware) 
7097aba4b5c2SSteven Rostedt (VMware) static struct ftrace_mod_map *
7098aba4b5c2SSteven Rostedt (VMware) allocate_ftrace_mod_map(struct module *mod,
7099aba4b5c2SSteven Rostedt (VMware) 			unsigned long start, unsigned long end)
7100aba4b5c2SSteven Rostedt (VMware) {
7101aba4b5c2SSteven Rostedt (VMware) 	struct ftrace_mod_map *mod_map;
7102aba4b5c2SSteven Rostedt (VMware) 
7103aba4b5c2SSteven Rostedt (VMware) 	mod_map = kmalloc(sizeof(*mod_map), GFP_KERNEL);
7104aba4b5c2SSteven Rostedt (VMware) 	if (!mod_map)
7105aba4b5c2SSteven Rostedt (VMware) 		return NULL;
7106aba4b5c2SSteven Rostedt (VMware) 
7107aba4b5c2SSteven Rostedt (VMware) 	mod_map->mod = mod;
7108aba4b5c2SSteven Rostedt (VMware) 	mod_map->start_addr = start;
7109aba4b5c2SSteven Rostedt (VMware) 	mod_map->end_addr = end;
71106171a031SSteven Rostedt (VMware) 	mod_map->num_funcs = 0;
7111aba4b5c2SSteven Rostedt (VMware) 
7112aba4b5c2SSteven Rostedt (VMware) 	INIT_LIST_HEAD_RCU(&mod_map->funcs);
7113aba4b5c2SSteven Rostedt (VMware) 
7114aba4b5c2SSteven Rostedt (VMware) 	list_add_rcu(&mod_map->list, &ftrace_mod_maps);
7115aba4b5c2SSteven Rostedt (VMware) 
7116aba4b5c2SSteven Rostedt (VMware) 	return mod_map;
7117aba4b5c2SSteven Rostedt (VMware) }
7118aba4b5c2SSteven Rostedt (VMware) 
7119aba4b5c2SSteven Rostedt (VMware) static const char *
7120aba4b5c2SSteven Rostedt (VMware) ftrace_func_address_lookup(struct ftrace_mod_map *mod_map,
7121aba4b5c2SSteven Rostedt (VMware) 			   unsigned long addr, unsigned long *size,
7122aba4b5c2SSteven Rostedt (VMware) 			   unsigned long *off, char *sym)
7123aba4b5c2SSteven Rostedt (VMware) {
7124aba4b5c2SSteven Rostedt (VMware) 	struct ftrace_mod_func *found_func =  NULL;
7125aba4b5c2SSteven Rostedt (VMware) 	struct ftrace_mod_func *mod_func;
7126aba4b5c2SSteven Rostedt (VMware) 
7127aba4b5c2SSteven Rostedt (VMware) 	list_for_each_entry_rcu(mod_func, &mod_map->funcs, list) {
7128aba4b5c2SSteven Rostedt (VMware) 		if (addr >= mod_func->ip &&
7129aba4b5c2SSteven Rostedt (VMware) 		    addr < mod_func->ip + mod_func->size) {
7130aba4b5c2SSteven Rostedt (VMware) 			found_func = mod_func;
7131aba4b5c2SSteven Rostedt (VMware) 			break;
7132aba4b5c2SSteven Rostedt (VMware) 		}
7133aba4b5c2SSteven Rostedt (VMware) 	}
7134aba4b5c2SSteven Rostedt (VMware) 
7135aba4b5c2SSteven Rostedt (VMware) 	if (found_func) {
7136aba4b5c2SSteven Rostedt (VMware) 		if (size)
7137aba4b5c2SSteven Rostedt (VMware) 			*size = found_func->size;
7138aba4b5c2SSteven Rostedt (VMware) 		if (off)
7139aba4b5c2SSteven Rostedt (VMware) 			*off = addr - found_func->ip;
7140aba4b5c2SSteven Rostedt (VMware) 		if (sym)
7141aba4b5c2SSteven Rostedt (VMware) 			strlcpy(sym, found_func->name, KSYM_NAME_LEN);
7142aba4b5c2SSteven Rostedt (VMware) 
7143aba4b5c2SSteven Rostedt (VMware) 		return found_func->name;
7144aba4b5c2SSteven Rostedt (VMware) 	}
7145aba4b5c2SSteven Rostedt (VMware) 
7146aba4b5c2SSteven Rostedt (VMware) 	return NULL;
7147aba4b5c2SSteven Rostedt (VMware) }
7148aba4b5c2SSteven Rostedt (VMware) 
7149aba4b5c2SSteven Rostedt (VMware) const char *
7150aba4b5c2SSteven Rostedt (VMware) ftrace_mod_address_lookup(unsigned long addr, unsigned long *size,
7151aba4b5c2SSteven Rostedt (VMware) 		   unsigned long *off, char **modname, char *sym)
7152aba4b5c2SSteven Rostedt (VMware) {
7153aba4b5c2SSteven Rostedt (VMware) 	struct ftrace_mod_map *mod_map;
7154aba4b5c2SSteven Rostedt (VMware) 	const char *ret = NULL;
7155aba4b5c2SSteven Rostedt (VMware) 
715674401729SPaul E. McKenney 	/* mod_map is freed via call_rcu() */
7157aba4b5c2SSteven Rostedt (VMware) 	preempt_disable();
7158aba4b5c2SSteven Rostedt (VMware) 	list_for_each_entry_rcu(mod_map, &ftrace_mod_maps, list) {
7159aba4b5c2SSteven Rostedt (VMware) 		ret = ftrace_func_address_lookup(mod_map, addr, size, off, sym);
7160aba4b5c2SSteven Rostedt (VMware) 		if (ret) {
7161aba4b5c2SSteven Rostedt (VMware) 			if (modname)
7162aba4b5c2SSteven Rostedt (VMware) 				*modname = mod_map->mod->name;
7163aba4b5c2SSteven Rostedt (VMware) 			break;
7164aba4b5c2SSteven Rostedt (VMware) 		}
7165aba4b5c2SSteven Rostedt (VMware) 	}
7166aba4b5c2SSteven Rostedt (VMware) 	preempt_enable();
7167aba4b5c2SSteven Rostedt (VMware) 
7168aba4b5c2SSteven Rostedt (VMware) 	return ret;
7169aba4b5c2SSteven Rostedt (VMware) }
7170aba4b5c2SSteven Rostedt (VMware) 
71716171a031SSteven Rostedt (VMware) int ftrace_mod_get_kallsym(unsigned int symnum, unsigned long *value,
71726171a031SSteven Rostedt (VMware) 			   char *type, char *name,
71736171a031SSteven Rostedt (VMware) 			   char *module_name, int *exported)
71746171a031SSteven Rostedt (VMware) {
71756171a031SSteven Rostedt (VMware) 	struct ftrace_mod_map *mod_map;
71766171a031SSteven Rostedt (VMware) 	struct ftrace_mod_func *mod_func;
7177fc0ea795SAdrian Hunter 	int ret;
71786171a031SSteven Rostedt (VMware) 
71796171a031SSteven Rostedt (VMware) 	preempt_disable();
71806171a031SSteven Rostedt (VMware) 	list_for_each_entry_rcu(mod_map, &ftrace_mod_maps, list) {
71816171a031SSteven Rostedt (VMware) 
71826171a031SSteven Rostedt (VMware) 		if (symnum >= mod_map->num_funcs) {
71836171a031SSteven Rostedt (VMware) 			symnum -= mod_map->num_funcs;
71846171a031SSteven Rostedt (VMware) 			continue;
71856171a031SSteven Rostedt (VMware) 		}
71866171a031SSteven Rostedt (VMware) 
71876171a031SSteven Rostedt (VMware) 		list_for_each_entry_rcu(mod_func, &mod_map->funcs, list) {
71886171a031SSteven Rostedt (VMware) 			if (symnum > 1) {
71896171a031SSteven Rostedt (VMware) 				symnum--;
71906171a031SSteven Rostedt (VMware) 				continue;
71916171a031SSteven Rostedt (VMware) 			}
71926171a031SSteven Rostedt (VMware) 
71936171a031SSteven Rostedt (VMware) 			*value = mod_func->ip;
71946171a031SSteven Rostedt (VMware) 			*type = 'T';
71956171a031SSteven Rostedt (VMware) 			strlcpy(name, mod_func->name, KSYM_NAME_LEN);
71966171a031SSteven Rostedt (VMware) 			strlcpy(module_name, mod_map->mod->name, MODULE_NAME_LEN);
71976171a031SSteven Rostedt (VMware) 			*exported = 1;
71986171a031SSteven Rostedt (VMware) 			preempt_enable();
71996171a031SSteven Rostedt (VMware) 			return 0;
72006171a031SSteven Rostedt (VMware) 		}
72016171a031SSteven Rostedt (VMware) 		WARN_ON(1);
72026171a031SSteven Rostedt (VMware) 		break;
72036171a031SSteven Rostedt (VMware) 	}
7204fc0ea795SAdrian Hunter 	ret = ftrace_get_trampoline_kallsym(symnum, value, type, name,
7205fc0ea795SAdrian Hunter 					    module_name, exported);
72066171a031SSteven Rostedt (VMware) 	preempt_enable();
7207fc0ea795SAdrian Hunter 	return ret;
72086171a031SSteven Rostedt (VMware) }
72096171a031SSteven Rostedt (VMware) 
7210aba4b5c2SSteven Rostedt (VMware) #else
7211aba4b5c2SSteven Rostedt (VMware) static void save_ftrace_mod_rec(struct ftrace_mod_map *mod_map,
7212aba4b5c2SSteven Rostedt (VMware) 				struct dyn_ftrace *rec) { }
7213aba4b5c2SSteven Rostedt (VMware) static inline struct ftrace_mod_map *
7214aba4b5c2SSteven Rostedt (VMware) allocate_ftrace_mod_map(struct module *mod,
7215aba4b5c2SSteven Rostedt (VMware) 			unsigned long start, unsigned long end)
7216aba4b5c2SSteven Rostedt (VMware) {
7217aba4b5c2SSteven Rostedt (VMware) 	return NULL;
7218aba4b5c2SSteven Rostedt (VMware) }
7219fc0ea795SAdrian Hunter int ftrace_mod_get_kallsym(unsigned int symnum, unsigned long *value,
7220fc0ea795SAdrian Hunter 			   char *type, char *name, char *module_name,
7221fc0ea795SAdrian Hunter 			   int *exported)
7222fc0ea795SAdrian Hunter {
7223fc0ea795SAdrian Hunter 	int ret;
7224fc0ea795SAdrian Hunter 
7225fc0ea795SAdrian Hunter 	preempt_disable();
7226fc0ea795SAdrian Hunter 	ret = ftrace_get_trampoline_kallsym(symnum, value, type, name,
7227fc0ea795SAdrian Hunter 					    module_name, exported);
7228fc0ea795SAdrian Hunter 	preempt_enable();
7229fc0ea795SAdrian Hunter 	return ret;
7230fc0ea795SAdrian Hunter }
723193eb677dSSteven Rostedt #endif /* CONFIG_MODULES */
723293eb677dSSteven Rostedt 
72338715b108SJoel Fernandes struct ftrace_init_func {
72348715b108SJoel Fernandes 	struct list_head list;
72358715b108SJoel Fernandes 	unsigned long ip;
72368715b108SJoel Fernandes };
72378715b108SJoel Fernandes 
72388715b108SJoel Fernandes /* Clear any init ips from hashes */
72398715b108SJoel Fernandes static void
72408715b108SJoel Fernandes clear_func_from_hash(struct ftrace_init_func *func, struct ftrace_hash *hash)
724142c269c8SSteven Rostedt (VMware) {
72428715b108SJoel Fernandes 	struct ftrace_func_entry *entry;
72438715b108SJoel Fernandes 
724408468754SChangbin Du 	entry = ftrace_lookup_ip(hash, func->ip);
72458715b108SJoel Fernandes 	/*
72468715b108SJoel Fernandes 	 * Do not allow this rec to match again.
72478715b108SJoel Fernandes 	 * Yeah, it may waste some memory, but will be removed
72488715b108SJoel Fernandes 	 * if/when the hash is modified again.
72498715b108SJoel Fernandes 	 */
72508715b108SJoel Fernandes 	if (entry)
72518715b108SJoel Fernandes 		entry->ip = 0;
72528715b108SJoel Fernandes }
72538715b108SJoel Fernandes 
72548715b108SJoel Fernandes static void
72558715b108SJoel Fernandes clear_func_from_hashes(struct ftrace_init_func *func)
72568715b108SJoel Fernandes {
72578715b108SJoel Fernandes 	struct trace_array *tr;
72588715b108SJoel Fernandes 
72598715b108SJoel Fernandes 	mutex_lock(&trace_types_lock);
72608715b108SJoel Fernandes 	list_for_each_entry(tr, &ftrace_trace_arrays, list) {
72618715b108SJoel Fernandes 		if (!tr->ops || !tr->ops->func_hash)
72628715b108SJoel Fernandes 			continue;
72638715b108SJoel Fernandes 		mutex_lock(&tr->ops->func_hash->regex_lock);
72648715b108SJoel Fernandes 		clear_func_from_hash(func, tr->ops->func_hash->filter_hash);
72658715b108SJoel Fernandes 		clear_func_from_hash(func, tr->ops->func_hash->notrace_hash);
72668715b108SJoel Fernandes 		mutex_unlock(&tr->ops->func_hash->regex_lock);
72678715b108SJoel Fernandes 	}
72688715b108SJoel Fernandes 	mutex_unlock(&trace_types_lock);
72698715b108SJoel Fernandes }
72708715b108SJoel Fernandes 
72718715b108SJoel Fernandes static void add_to_clear_hash_list(struct list_head *clear_list,
72728715b108SJoel Fernandes 				   struct dyn_ftrace *rec)
72738715b108SJoel Fernandes {
72748715b108SJoel Fernandes 	struct ftrace_init_func *func;
72758715b108SJoel Fernandes 
72768715b108SJoel Fernandes 	func = kmalloc(sizeof(*func), GFP_KERNEL);
72778715b108SJoel Fernandes 	if (!func) {
727824589e3aSSteven Rostedt (VMware) 		MEM_FAIL(1, "alloc failure, ftrace filter could be stale\n");
72798715b108SJoel Fernandes 		return;
72808715b108SJoel Fernandes 	}
72818715b108SJoel Fernandes 
72828715b108SJoel Fernandes 	func->ip = rec->ip;
72838715b108SJoel Fernandes 	list_add(&func->list, clear_list);
72848715b108SJoel Fernandes }
72858715b108SJoel Fernandes 
7286aba4b5c2SSteven Rostedt (VMware) void ftrace_free_mem(struct module *mod, void *start_ptr, void *end_ptr)
728742c269c8SSteven Rostedt (VMware) {
72886cafbe15SSteven Rostedt (VMware) 	unsigned long start = (unsigned long)(start_ptr);
72896cafbe15SSteven Rostedt (VMware) 	unsigned long end = (unsigned long)(end_ptr);
729042c269c8SSteven Rostedt (VMware) 	struct ftrace_page **last_pg = &ftrace_pages_start;
729142c269c8SSteven Rostedt (VMware) 	struct ftrace_page *pg;
729242c269c8SSteven Rostedt (VMware) 	struct dyn_ftrace *rec;
729342c269c8SSteven Rostedt (VMware) 	struct dyn_ftrace key;
7294aba4b5c2SSteven Rostedt (VMware) 	struct ftrace_mod_map *mod_map = NULL;
72958715b108SJoel Fernandes 	struct ftrace_init_func *func, *func_next;
72968715b108SJoel Fernandes 	struct list_head clear_hash;
729742c269c8SSteven Rostedt (VMware) 
72988715b108SJoel Fernandes 	INIT_LIST_HEAD(&clear_hash);
72998715b108SJoel Fernandes 
730042c269c8SSteven Rostedt (VMware) 	key.ip = start;
730142c269c8SSteven Rostedt (VMware) 	key.flags = end;	/* overload flags, as it is unsigned long */
730242c269c8SSteven Rostedt (VMware) 
730342c269c8SSteven Rostedt (VMware) 	mutex_lock(&ftrace_lock);
730442c269c8SSteven Rostedt (VMware) 
7305aba4b5c2SSteven Rostedt (VMware) 	/*
7306aba4b5c2SSteven Rostedt (VMware) 	 * If we are freeing module init memory, then check if
7307aba4b5c2SSteven Rostedt (VMware) 	 * any tracer is active. If so, we need to save a mapping of
7308aba4b5c2SSteven Rostedt (VMware) 	 * the module functions being freed with the address.
7309aba4b5c2SSteven Rostedt (VMware) 	 */
7310aba4b5c2SSteven Rostedt (VMware) 	if (mod && ftrace_ops_list != &ftrace_list_end)
7311aba4b5c2SSteven Rostedt (VMware) 		mod_map = allocate_ftrace_mod_map(mod, start, end);
7312aba4b5c2SSteven Rostedt (VMware) 
731342c269c8SSteven Rostedt (VMware) 	for (pg = ftrace_pages_start; pg; last_pg = &pg->next, pg = *last_pg) {
731442c269c8SSteven Rostedt (VMware) 		if (end < pg->records[0].ip ||
731542c269c8SSteven Rostedt (VMware) 		    start >= (pg->records[pg->index - 1].ip + MCOUNT_INSN_SIZE))
731642c269c8SSteven Rostedt (VMware) 			continue;
731742c269c8SSteven Rostedt (VMware)  again:
731842c269c8SSteven Rostedt (VMware) 		rec = bsearch(&key, pg->records, pg->index,
731942c269c8SSteven Rostedt (VMware) 			      sizeof(struct dyn_ftrace),
732042c269c8SSteven Rostedt (VMware) 			      ftrace_cmp_recs);
732142c269c8SSteven Rostedt (VMware) 		if (!rec)
732242c269c8SSteven Rostedt (VMware) 			continue;
7323aba4b5c2SSteven Rostedt (VMware) 
73248715b108SJoel Fernandes 		/* rec will be cleared from hashes after ftrace_lock unlock */
73258715b108SJoel Fernandes 		add_to_clear_hash_list(&clear_hash, rec);
73268715b108SJoel Fernandes 
7327aba4b5c2SSteven Rostedt (VMware) 		if (mod_map)
7328aba4b5c2SSteven Rostedt (VMware) 			save_ftrace_mod_rec(mod_map, rec);
7329aba4b5c2SSteven Rostedt (VMware) 
733042c269c8SSteven Rostedt (VMware) 		pg->index--;
73314ec78467SSteven Rostedt (VMware) 		ftrace_update_tot_cnt--;
733242c269c8SSteven Rostedt (VMware) 		if (!pg->index) {
733342c269c8SSteven Rostedt (VMware) 			*last_pg = pg->next;
7334db42523bSLinus Torvalds 			if (pg->records) {
7335db42523bSLinus Torvalds 				free_pages((unsigned long)pg->records, pg->order);
7336db42523bSLinus Torvalds 				ftrace_number_of_pages -= 1 << pg->order;
7337db42523bSLinus Torvalds 			}
7338da537f0aSSteven Rostedt (VMware) 			ftrace_number_of_groups--;
733942c269c8SSteven Rostedt (VMware) 			kfree(pg);
734042c269c8SSteven Rostedt (VMware) 			pg = container_of(last_pg, struct ftrace_page, next);
734142c269c8SSteven Rostedt (VMware) 			if (!(*last_pg))
734242c269c8SSteven Rostedt (VMware) 				ftrace_pages = pg;
734342c269c8SSteven Rostedt (VMware) 			continue;
734442c269c8SSteven Rostedt (VMware) 		}
734542c269c8SSteven Rostedt (VMware) 		memmove(rec, rec + 1,
734642c269c8SSteven Rostedt (VMware) 			(pg->index - (rec - pg->records)) * sizeof(*rec));
734742c269c8SSteven Rostedt (VMware) 		/* More than one function may be in this block */
734842c269c8SSteven Rostedt (VMware) 		goto again;
734942c269c8SSteven Rostedt (VMware) 	}
735042c269c8SSteven Rostedt (VMware) 	mutex_unlock(&ftrace_lock);
73518715b108SJoel Fernandes 
73528715b108SJoel Fernandes 	list_for_each_entry_safe(func, func_next, &clear_hash, list) {
73538715b108SJoel Fernandes 		clear_func_from_hashes(func);
73548715b108SJoel Fernandes 		kfree(func);
73558715b108SJoel Fernandes 	}
735642c269c8SSteven Rostedt (VMware) }
735742c269c8SSteven Rostedt (VMware) 
73586cafbe15SSteven Rostedt (VMware) void __init ftrace_free_init_mem(void)
73596cafbe15SSteven Rostedt (VMware) {
73606cafbe15SSteven Rostedt (VMware) 	void *start = (void *)(&__init_begin);
73616cafbe15SSteven Rostedt (VMware) 	void *end = (void *)(&__init_end);
73626cafbe15SSteven Rostedt (VMware) 
7363380af29bSSteven Rostedt (Google) 	ftrace_boot_snapshot();
7364380af29bSSteven Rostedt (Google) 
7365aba4b5c2SSteven Rostedt (VMware) 	ftrace_free_mem(NULL, start, end);
736693eb677dSSteven Rostedt }
736793eb677dSSteven Rostedt 
73686644c654SWeizhao Ouyang int __init __weak ftrace_dyn_arch_init(void)
73696644c654SWeizhao Ouyang {
73706644c654SWeizhao Ouyang 	return 0;
73716644c654SWeizhao Ouyang }
73726644c654SWeizhao Ouyang 
737368bf21aaSSteven Rostedt void __init ftrace_init(void)
737468bf21aaSSteven Rostedt {
73751dc43cf0SJiri Slaby 	extern unsigned long __start_mcount_loc[];
73761dc43cf0SJiri Slaby 	extern unsigned long __stop_mcount_loc[];
73773a36cb11SJiri Slaby 	unsigned long count, flags;
737868bf21aaSSteven Rostedt 	int ret;
737968bf21aaSSteven Rostedt 
738068bf21aaSSteven Rostedt 	local_irq_save(flags);
73813a36cb11SJiri Slaby 	ret = ftrace_dyn_arch_init();
738268bf21aaSSteven Rostedt 	local_irq_restore(flags);
7383af64a7cbSJiri Slaby 	if (ret)
738468bf21aaSSteven Rostedt 		goto failed;
738568bf21aaSSteven Rostedt 
738668bf21aaSSteven Rostedt 	count = __stop_mcount_loc - __start_mcount_loc;
7387c867ccd8SJiri Slaby 	if (!count) {
7388c867ccd8SJiri Slaby 		pr_info("ftrace: No functions to be traced?\n");
738968bf21aaSSteven Rostedt 		goto failed;
7390c867ccd8SJiri Slaby 	}
7391c867ccd8SJiri Slaby 
7392c867ccd8SJiri Slaby 	pr_info("ftrace: allocating %ld entries in %ld pages\n",
7393c867ccd8SJiri Slaby 		count, count / ENTRIES_PER_PAGE + 1);
739468bf21aaSSteven Rostedt 
73955cb084bbSJiri Olsa 	ret = ftrace_process_locs(NULL,
739631e88909SSteven Rostedt 				  __start_mcount_loc,
739768bf21aaSSteven Rostedt 				  __stop_mcount_loc);
73982889c658SYuntao Wang 	if (ret) {
73992889c658SYuntao Wang 		pr_warn("ftrace: failed to allocate entries for functions\n");
74002889c658SYuntao Wang 		goto failed;
74012889c658SYuntao Wang 	}
740268bf21aaSSteven Rostedt 
7403da537f0aSSteven Rostedt (VMware) 	pr_info("ftrace: allocated %ld pages with %ld groups\n",
7404da537f0aSSteven Rostedt (VMware) 		ftrace_number_of_pages, ftrace_number_of_groups);
7405da537f0aSSteven Rostedt (VMware) 
74062889c658SYuntao Wang 	last_ftrace_enabled = ftrace_enabled = 1;
74072889c658SYuntao Wang 
74082af15d6aSSteven Rostedt 	set_ftrace_early_filters();
74092af15d6aSSteven Rostedt 
741068bf21aaSSteven Rostedt 	return;
741168bf21aaSSteven Rostedt  failed:
741268bf21aaSSteven Rostedt 	ftrace_disabled = 1;
741368bf21aaSSteven Rostedt }
741468bf21aaSSteven Rostedt 
7415f3bea491SSteven Rostedt (Red Hat) /* Do nothing if arch does not support this */
7416f3bea491SSteven Rostedt (Red Hat) void __weak arch_ftrace_update_trampoline(struct ftrace_ops *ops)
7417f3bea491SSteven Rostedt (Red Hat) {
7418f3bea491SSteven Rostedt (Red Hat) }
7419f3bea491SSteven Rostedt (Red Hat) 
7420f3bea491SSteven Rostedt (Red Hat) static void ftrace_update_trampoline(struct ftrace_ops *ops)
7421f3bea491SSteven Rostedt (Red Hat) {
7422fc0ea795SAdrian Hunter 	unsigned long trampoline = ops->trampoline;
7423fc0ea795SAdrian Hunter 
7424f3bea491SSteven Rostedt (Red Hat) 	arch_ftrace_update_trampoline(ops);
7425fc0ea795SAdrian Hunter 	if (ops->trampoline && ops->trampoline != trampoline &&
7426dd9ddf46SAdrian Hunter 	    (ops->flags & FTRACE_OPS_FL_ALLOC_TRAMP)) {
7427dd9ddf46SAdrian Hunter 		/* Add to kallsyms before the perf events */
7428fc0ea795SAdrian Hunter 		ftrace_add_trampoline_to_kallsyms(ops);
7429dd9ddf46SAdrian Hunter 		perf_event_ksymbol(PERF_RECORD_KSYMBOL_TYPE_OOL,
7430dd9ddf46SAdrian Hunter 				   ops->trampoline, ops->trampoline_size, false,
7431dd9ddf46SAdrian Hunter 				   FTRACE_TRAMPOLINE_SYM);
7432548e1f6cSAdrian Hunter 		/*
7433548e1f6cSAdrian Hunter 		 * Record the perf text poke event after the ksymbol register
7434548e1f6cSAdrian Hunter 		 * event.
7435548e1f6cSAdrian Hunter 		 */
7436548e1f6cSAdrian Hunter 		perf_event_text_poke((void *)ops->trampoline, NULL, 0,
7437548e1f6cSAdrian Hunter 				     (void *)ops->trampoline,
7438548e1f6cSAdrian Hunter 				     ops->trampoline_size);
7439dd9ddf46SAdrian Hunter 	}
7440f3bea491SSteven Rostedt (Red Hat) }
7441f3bea491SSteven Rostedt (Red Hat) 
744204ec7bb6SSteven Rostedt (VMware) void ftrace_init_trace_array(struct trace_array *tr)
744304ec7bb6SSteven Rostedt (VMware) {
744404ec7bb6SSteven Rostedt (VMware) 	INIT_LIST_HEAD(&tr->func_probes);
7445673feb9dSSteven Rostedt (VMware) 	INIT_LIST_HEAD(&tr->mod_trace);
7446673feb9dSSteven Rostedt (VMware) 	INIT_LIST_HEAD(&tr->mod_notrace);
744704ec7bb6SSteven Rostedt (VMware) }
74483d083395SSteven Rostedt #else
74490b6e4d56SFrederic Weisbecker 
74503306fc4aSSteven Rostedt (VMware) struct ftrace_ops global_ops = {
7451bd69c30bSSteven Rostedt 	.func			= ftrace_stub,
7452a25d036dSSteven Rostedt (VMware) 	.flags			= FTRACE_OPS_FL_INITIALIZED |
7453e3eea140SSteven Rostedt (Red Hat) 				  FTRACE_OPS_FL_PID,
7454bd69c30bSSteven Rostedt };
7455bd69c30bSSteven Rostedt 
74560b6e4d56SFrederic Weisbecker static int __init ftrace_nodyn_init(void)
74570b6e4d56SFrederic Weisbecker {
74580b6e4d56SFrederic Weisbecker 	ftrace_enabled = 1;
74590b6e4d56SFrederic Weisbecker 	return 0;
74600b6e4d56SFrederic Weisbecker }
74616f415672SSteven Rostedt core_initcall(ftrace_nodyn_init);
74620b6e4d56SFrederic Weisbecker 
74638434dc93SSteven Rostedt (Red Hat) static inline int ftrace_init_dyn_tracefs(struct dentry *d_tracer) { return 0; }
7464e1effa01SSteven Rostedt (Red Hat) static inline void ftrace_startup_all(int command) { }
74658a56d776SSteven Rostedt (Red Hat) 
7466f3bea491SSteven Rostedt (Red Hat) static void ftrace_update_trampoline(struct ftrace_ops *ops)
7467f3bea491SSteven Rostedt (Red Hat) {
7468f3bea491SSteven Rostedt (Red Hat) }
7469f3bea491SSteven Rostedt (Red Hat) 
74703d083395SSteven Rostedt #endif /* CONFIG_DYNAMIC_FTRACE */
74713d083395SSteven Rostedt 
74724104d326SSteven Rostedt (Red Hat) __init void ftrace_init_global_array_ops(struct trace_array *tr)
74734104d326SSteven Rostedt (Red Hat) {
74744104d326SSteven Rostedt (Red Hat) 	tr->ops = &global_ops;
74754104d326SSteven Rostedt (Red Hat) 	tr->ops->private = tr;
747604ec7bb6SSteven Rostedt (VMware) 	ftrace_init_trace_array(tr);
74774104d326SSteven Rostedt (Red Hat) }
74784104d326SSteven Rostedt (Red Hat) 
74794104d326SSteven Rostedt (Red Hat) void ftrace_init_array_ops(struct trace_array *tr, ftrace_func_t func)
74804104d326SSteven Rostedt (Red Hat) {
74814104d326SSteven Rostedt (Red Hat) 	/* If we filter on pids, update to use the pid function */
74824104d326SSteven Rostedt (Red Hat) 	if (tr->flags & TRACE_ARRAY_FL_GLOBAL) {
74834104d326SSteven Rostedt (Red Hat) 		if (WARN_ON(tr->ops->func != ftrace_stub))
74844104d326SSteven Rostedt (Red Hat) 			printk("ftrace ops had %pS for function\n",
74854104d326SSteven Rostedt (Red Hat) 			       tr->ops->func);
74864104d326SSteven Rostedt (Red Hat) 	}
74874104d326SSteven Rostedt (Red Hat) 	tr->ops->func = func;
74884104d326SSteven Rostedt (Red Hat) 	tr->ops->private = tr;
74894104d326SSteven Rostedt (Red Hat) }
74904104d326SSteven Rostedt (Red Hat) 
74914104d326SSteven Rostedt (Red Hat) void ftrace_reset_array_ops(struct trace_array *tr)
74924104d326SSteven Rostedt (Red Hat) {
74934104d326SSteven Rostedt (Red Hat) 	tr->ops->func = ftrace_stub;
74944104d326SSteven Rostedt (Red Hat) }
74954104d326SSteven Rostedt (Red Hat) 
7496fabe38abSMasami Hiramatsu static nokprobe_inline void
74972f5f6ad9SSteven Rostedt __ftrace_ops_list_func(unsigned long ip, unsigned long parent_ip,
7498d19ad077SSteven Rostedt (VMware) 		       struct ftrace_ops *ignored, struct ftrace_regs *fregs)
7499b848914cSSteven Rostedt {
7500d19ad077SSteven Rostedt (VMware) 	struct pt_regs *regs = ftrace_get_regs(fregs);
7501cdbe61bfSSteven Rostedt 	struct ftrace_ops *op;
7502edc15cafSSteven Rostedt 	int bit;
7503b848914cSSteven Rostedt 
7504ce5e4803S王贇 	/*
7505ce5e4803S王贇 	 * The ftrace_test_and_set_recursion() will disable preemption,
7506ce5e4803S王贇 	 * which is required since some of the ops may be dynamically
7507ce5e4803S王贇 	 * allocated, they must be freed after a synchronize_rcu().
7508ce5e4803S王贇 	 */
7509ed65df63SSteven Rostedt (VMware) 	bit = trace_test_and_set_recursion(ip, parent_ip, TRACE_LIST_START);
7510edc15cafSSteven Rostedt 	if (bit < 0)
7511b1cff0adSSteven Rostedt 		return;
7512b1cff0adSSteven Rostedt 
75130a016409SSteven Rostedt 	do_for_each_ftrace_op(op, ftrace_ops_list) {
75142fa717a0SSteven Rostedt (VMware) 		/* Stub functions don't need to be called nor tested */
75152fa717a0SSteven Rostedt (VMware) 		if (op->flags & FTRACE_OPS_FL_STUB)
75162fa717a0SSteven Rostedt (VMware) 			continue;
7517ba27f2bcSSteven Rostedt (Red Hat) 		/*
7518ba27f2bcSSteven Rostedt (Red Hat) 		 * Check the following for each ops before calling their func:
7519ba27f2bcSSteven Rostedt (Red Hat) 		 *  if RCU flag is set, then rcu_is_watching() must be true
7520ba27f2bcSSteven Rostedt (Red Hat) 		 *  if PER_CPU is set, then ftrace_function_local_disable()
7521ba27f2bcSSteven Rostedt (Red Hat) 		 *                          must be false
7522ba27f2bcSSteven Rostedt (Red Hat) 		 *  Otherwise test if the ip matches the ops filter
7523ba27f2bcSSteven Rostedt (Red Hat) 		 *
7524ba27f2bcSSteven Rostedt (Red Hat) 		 * If any of the above fails then the op->func() is not executed.
7525ba27f2bcSSteven Rostedt (Red Hat) 		 */
7526ba27f2bcSSteven Rostedt (Red Hat) 		if ((!(op->flags & FTRACE_OPS_FL_RCU) || rcu_is_watching()) &&
7527ba27f2bcSSteven Rostedt (Red Hat) 		    ftrace_ops_test(op, ip, regs)) {
75281d48d596SSteven Rostedt (Red Hat) 			if (FTRACE_WARN_ON(!op->func)) {
75291d48d596SSteven Rostedt (Red Hat) 				pr_warn("op=%p %pS\n", op, op);
75304104d326SSteven Rostedt (Red Hat) 				goto out;
75314104d326SSteven Rostedt (Red Hat) 			}
7532d19ad077SSteven Rostedt (VMware) 			op->func(ip, parent_ip, op, fregs);
75334104d326SSteven Rostedt (Red Hat) 		}
75340a016409SSteven Rostedt 	} while_for_each_ftrace_op(op);
75354104d326SSteven Rostedt (Red Hat) out:
7536edc15cafSSteven Rostedt 	trace_clear_recursion(bit);
7537b848914cSSteven Rostedt }
7538b848914cSSteven Rostedt 
75392f5f6ad9SSteven Rostedt /*
75402f5f6ad9SSteven Rostedt  * Some archs only support passing ip and parent_ip. Even though
75412f5f6ad9SSteven Rostedt  * the list function ignores the op parameter, we do not want any
75422f5f6ad9SSteven Rostedt  * C side effects, where a function is called without the caller
75432f5f6ad9SSteven Rostedt  * sending a third parameter.
7544a1e2e31dSSteven Rostedt  * Archs are to support both the regs and ftrace_ops at the same time.
7545a1e2e31dSSteven Rostedt  * If they support ftrace_ops, it is assumed they support regs.
7546a1e2e31dSSteven Rostedt  * If call backs want to use regs, they must either check for regs
754706aeaaeaSMasami Hiramatsu  * being NULL, or CONFIG_DYNAMIC_FTRACE_WITH_REGS.
754806aeaaeaSMasami Hiramatsu  * Note, CONFIG_DYNAMIC_FTRACE_WITH_REGS expects a full regs to be saved.
7549a1e2e31dSSteven Rostedt  * An architecture can pass partial regs with ftrace_ops and still
7550b8ec330aSLi Bin  * set the ARCH_SUPPORTS_FTRACE_OPS.
755134cdd18bSSteven Rostedt (VMware)  *
755234cdd18bSSteven Rostedt (VMware)  * In vmlinux.lds.h, ftrace_ops_list_func() is defined to be
755334cdd18bSSteven Rostedt (VMware)  * arch_ftrace_ops_list_func.
75542f5f6ad9SSteven Rostedt  */
75552f5f6ad9SSteven Rostedt #if ARCH_SUPPORTS_FTRACE_OPS
755634cdd18bSSteven Rostedt (VMware) void arch_ftrace_ops_list_func(unsigned long ip, unsigned long parent_ip,
7557d19ad077SSteven Rostedt (VMware) 			       struct ftrace_ops *op, struct ftrace_regs *fregs)
75582f5f6ad9SSteven Rostedt {
7559d19ad077SSteven Rostedt (VMware) 	__ftrace_ops_list_func(ip, parent_ip, NULL, fregs);
75602f5f6ad9SSteven Rostedt }
75612f5f6ad9SSteven Rostedt #else
756234cdd18bSSteven Rostedt (VMware) void arch_ftrace_ops_list_func(unsigned long ip, unsigned long parent_ip)
75632f5f6ad9SSteven Rostedt {
7564a1e2e31dSSteven Rostedt 	__ftrace_ops_list_func(ip, parent_ip, NULL, NULL);
75652f5f6ad9SSteven Rostedt }
75662f5f6ad9SSteven Rostedt #endif
756734cdd18bSSteven Rostedt (VMware) NOKPROBE_SYMBOL(arch_ftrace_ops_list_func);
75682f5f6ad9SSteven Rostedt 
7569f1ff6348SSteven Rostedt (Red Hat) /*
7570f1ff6348SSteven Rostedt (Red Hat)  * If there's only one function registered but it does not support
7571c68c0fa2SSteven Rostedt (Red Hat)  * recursion, needs RCU protection and/or requires per cpu handling, then
7572c68c0fa2SSteven Rostedt (Red Hat)  * this function will be called by the mcount trampoline.
7573f1ff6348SSteven Rostedt (Red Hat)  */
7574c68c0fa2SSteven Rostedt (Red Hat) static void ftrace_ops_assist_func(unsigned long ip, unsigned long parent_ip,
7575d19ad077SSteven Rostedt (VMware) 				   struct ftrace_ops *op, struct ftrace_regs *fregs)
7576f1ff6348SSteven Rostedt (Red Hat) {
7577f1ff6348SSteven Rostedt (Red Hat) 	int bit;
7578f1ff6348SSteven Rostedt (Red Hat) 
7579ed65df63SSteven Rostedt (VMware) 	bit = trace_test_and_set_recursion(ip, parent_ip, TRACE_LIST_START);
7580f1ff6348SSteven Rostedt (Red Hat) 	if (bit < 0)
7581f1ff6348SSteven Rostedt (Red Hat) 		return;
7582f1ff6348SSteven Rostedt (Red Hat) 
7583b40341faSSteven Rostedt (VMware) 	if (!(op->flags & FTRACE_OPS_FL_RCU) || rcu_is_watching())
7584d19ad077SSteven Rostedt (VMware) 		op->func(ip, parent_ip, op, fregs);
7585c68c0fa2SSteven Rostedt (Red Hat) 
7586f1ff6348SSteven Rostedt (Red Hat) 	trace_clear_recursion(bit);
7587f1ff6348SSteven Rostedt (Red Hat) }
7588fabe38abSMasami Hiramatsu NOKPROBE_SYMBOL(ftrace_ops_assist_func);
7589f1ff6348SSteven Rostedt (Red Hat) 
759087354059SSteven Rostedt (Red Hat) /**
759187354059SSteven Rostedt (Red Hat)  * ftrace_ops_get_func - get the function a trampoline should call
759287354059SSteven Rostedt (Red Hat)  * @ops: the ops to get the function for
759387354059SSteven Rostedt (Red Hat)  *
759487354059SSteven Rostedt (Red Hat)  * Normally the mcount trampoline will call the ops->func, but there
759587354059SSteven Rostedt (Red Hat)  * are times that it should not. For example, if the ops does not
759687354059SSteven Rostedt (Red Hat)  * have its own recursion protection, then it should call the
75973a150df9SChunyu Hu  * ftrace_ops_assist_func() instead.
759887354059SSteven Rostedt (Red Hat)  *
759987354059SSteven Rostedt (Red Hat)  * Returns the function that the trampoline should call for @ops.
760087354059SSteven Rostedt (Red Hat)  */
760187354059SSteven Rostedt (Red Hat) ftrace_func_t ftrace_ops_get_func(struct ftrace_ops *ops)
760287354059SSteven Rostedt (Red Hat) {
760387354059SSteven Rostedt (Red Hat) 	/*
7604a25d036dSSteven Rostedt (VMware) 	 * If the function does not handle recursion or needs to be RCU safe,
7605a25d036dSSteven Rostedt (VMware) 	 * then we need to call the assist handler.
760687354059SSteven Rostedt (Red Hat) 	 */
7607a25d036dSSteven Rostedt (VMware) 	if (ops->flags & (FTRACE_OPS_FL_RECURSION |
7608a25d036dSSteven Rostedt (VMware) 			  FTRACE_OPS_FL_RCU))
7609c68c0fa2SSteven Rostedt (Red Hat) 		return ftrace_ops_assist_func;
761087354059SSteven Rostedt (Red Hat) 
761187354059SSteven Rostedt (Red Hat) 	return ops->func;
761287354059SSteven Rostedt (Red Hat) }
761387354059SSteven Rostedt (Red Hat) 
7614345ddcc8SSteven Rostedt (Red Hat) static void
7615345ddcc8SSteven Rostedt (Red Hat) ftrace_filter_pid_sched_switch_probe(void *data, bool preempt,
7616fa2c3254SValentin Schneider 				     struct task_struct *prev,
76179c2136beSDelyan Kratunov 				     struct task_struct *next,
76189c2136beSDelyan Kratunov 				     unsigned int prev_state)
7619e32d8956SSteven Rostedt {
7620345ddcc8SSteven Rostedt (Red Hat) 	struct trace_array *tr = data;
7621345ddcc8SSteven Rostedt (Red Hat) 	struct trace_pid_list *pid_list;
7622b3b1e6edSSteven Rostedt (VMware) 	struct trace_pid_list *no_pid_list;
7623345ddcc8SSteven Rostedt (Red Hat) 
7624345ddcc8SSteven Rostedt (Red Hat) 	pid_list = rcu_dereference_sched(tr->function_pids);
7625b3b1e6edSSteven Rostedt (VMware) 	no_pid_list = rcu_dereference_sched(tr->function_no_pids);
7626345ddcc8SSteven Rostedt (Red Hat) 
7627b3b1e6edSSteven Rostedt (VMware) 	if (trace_ignore_this_task(pid_list, no_pid_list, next))
76281c5eb448SSteven Rostedt (VMware) 		this_cpu_write(tr->array_buffer.data->ftrace_ignore_pid,
7629717e3f5eSSteven Rostedt (VMware) 			       FTRACE_PID_IGNORE);
7630717e3f5eSSteven Rostedt (VMware) 	else
7631717e3f5eSSteven Rostedt (VMware) 		this_cpu_write(tr->array_buffer.data->ftrace_ignore_pid,
7632717e3f5eSSteven Rostedt (VMware) 			       next->pid);
7633345ddcc8SSteven Rostedt (Red Hat) }
7634345ddcc8SSteven Rostedt (Red Hat) 
76351e10486fSNamhyung Kim static void
76361e10486fSNamhyung Kim ftrace_pid_follow_sched_process_fork(void *data,
76371e10486fSNamhyung Kim 				     struct task_struct *self,
76381e10486fSNamhyung Kim 				     struct task_struct *task)
76391e10486fSNamhyung Kim {
76401e10486fSNamhyung Kim 	struct trace_pid_list *pid_list;
76411e10486fSNamhyung Kim 	struct trace_array *tr = data;
76421e10486fSNamhyung Kim 
76431e10486fSNamhyung Kim 	pid_list = rcu_dereference_sched(tr->function_pids);
76441e10486fSNamhyung Kim 	trace_filter_add_remove_task(pid_list, self, task);
7645b3b1e6edSSteven Rostedt (VMware) 
7646b3b1e6edSSteven Rostedt (VMware) 	pid_list = rcu_dereference_sched(tr->function_no_pids);
7647b3b1e6edSSteven Rostedt (VMware) 	trace_filter_add_remove_task(pid_list, self, task);
76481e10486fSNamhyung Kim }
76491e10486fSNamhyung Kim 
76501e10486fSNamhyung Kim static void
76511e10486fSNamhyung Kim ftrace_pid_follow_sched_process_exit(void *data, struct task_struct *task)
76521e10486fSNamhyung Kim {
76531e10486fSNamhyung Kim 	struct trace_pid_list *pid_list;
76541e10486fSNamhyung Kim 	struct trace_array *tr = data;
76551e10486fSNamhyung Kim 
76561e10486fSNamhyung Kim 	pid_list = rcu_dereference_sched(tr->function_pids);
76571e10486fSNamhyung Kim 	trace_filter_add_remove_task(pid_list, NULL, task);
7658b3b1e6edSSteven Rostedt (VMware) 
7659b3b1e6edSSteven Rostedt (VMware) 	pid_list = rcu_dereference_sched(tr->function_no_pids);
7660b3b1e6edSSteven Rostedt (VMware) 	trace_filter_add_remove_task(pid_list, NULL, task);
76611e10486fSNamhyung Kim }
76621e10486fSNamhyung Kim 
76631e10486fSNamhyung Kim void ftrace_pid_follow_fork(struct trace_array *tr, bool enable)
76641e10486fSNamhyung Kim {
76651e10486fSNamhyung Kim 	if (enable) {
76661e10486fSNamhyung Kim 		register_trace_sched_process_fork(ftrace_pid_follow_sched_process_fork,
76671e10486fSNamhyung Kim 						  tr);
7668afcab636SSteven Rostedt (VMware) 		register_trace_sched_process_free(ftrace_pid_follow_sched_process_exit,
76691e10486fSNamhyung Kim 						  tr);
76701e10486fSNamhyung Kim 	} else {
76711e10486fSNamhyung Kim 		unregister_trace_sched_process_fork(ftrace_pid_follow_sched_process_fork,
76721e10486fSNamhyung Kim 						    tr);
7673afcab636SSteven Rostedt (VMware) 		unregister_trace_sched_process_free(ftrace_pid_follow_sched_process_exit,
76741e10486fSNamhyung Kim 						    tr);
76751e10486fSNamhyung Kim 	}
76761e10486fSNamhyung Kim }
76771e10486fSNamhyung Kim 
7678b3b1e6edSSteven Rostedt (VMware) static void clear_ftrace_pids(struct trace_array *tr, int type)
7679345ddcc8SSteven Rostedt (Red Hat) {
7680345ddcc8SSteven Rostedt (Red Hat) 	struct trace_pid_list *pid_list;
7681b3b1e6edSSteven Rostedt (VMware) 	struct trace_pid_list *no_pid_list;
7682e32d8956SSteven Rostedt 	int cpu;
7683e32d8956SSteven Rostedt 
7684345ddcc8SSteven Rostedt (Red Hat) 	pid_list = rcu_dereference_protected(tr->function_pids,
7685345ddcc8SSteven Rostedt (Red Hat) 					     lockdep_is_held(&ftrace_lock));
7686b3b1e6edSSteven Rostedt (VMware) 	no_pid_list = rcu_dereference_protected(tr->function_no_pids,
7687b3b1e6edSSteven Rostedt (VMware) 						lockdep_is_held(&ftrace_lock));
7688b3b1e6edSSteven Rostedt (VMware) 
7689b3b1e6edSSteven Rostedt (VMware) 	/* Make sure there's something to do */
769027683626SSteven Rostedt (VMware) 	if (!pid_type_enabled(type, pid_list, no_pid_list))
7691345ddcc8SSteven Rostedt (Red Hat) 		return;
7692345ddcc8SSteven Rostedt (Red Hat) 
7693b3b1e6edSSteven Rostedt (VMware) 	/* See if the pids still need to be checked after this */
769427683626SSteven Rostedt (VMware) 	if (!still_need_pid_events(type, pid_list, no_pid_list)) {
7695345ddcc8SSteven Rostedt (Red Hat) 		unregister_trace_sched_switch(ftrace_filter_pid_sched_switch_probe, tr);
7696345ddcc8SSteven Rostedt (Red Hat) 		for_each_possible_cpu(cpu)
7697717e3f5eSSteven Rostedt (VMware) 			per_cpu_ptr(tr->array_buffer.data, cpu)->ftrace_ignore_pid = FTRACE_PID_TRACE;
7698b3b1e6edSSteven Rostedt (VMware) 	}
7699345ddcc8SSteven Rostedt (Red Hat) 
7700b3b1e6edSSteven Rostedt (VMware) 	if (type & TRACE_PIDS)
7701345ddcc8SSteven Rostedt (Red Hat) 		rcu_assign_pointer(tr->function_pids, NULL);
7702345ddcc8SSteven Rostedt (Red Hat) 
7703b3b1e6edSSteven Rostedt (VMware) 	if (type & TRACE_NO_PIDS)
7704b3b1e6edSSteven Rostedt (VMware) 		rcu_assign_pointer(tr->function_no_pids, NULL);
7705b3b1e6edSSteven Rostedt (VMware) 
7706345ddcc8SSteven Rostedt (Red Hat) 	/* Wait till all users are no longer using pid filtering */
770774401729SPaul E. McKenney 	synchronize_rcu();
7708345ddcc8SSteven Rostedt (Red Hat) 
7709b3b1e6edSSteven Rostedt (VMware) 	if ((type & TRACE_PIDS) && pid_list)
77106954e415SSteven Rostedt (VMware) 		trace_pid_list_free(pid_list);
7711b3b1e6edSSteven Rostedt (VMware) 
7712b3b1e6edSSteven Rostedt (VMware) 	if ((type & TRACE_NO_PIDS) && no_pid_list)
77136954e415SSteven Rostedt (VMware) 		trace_pid_list_free(no_pid_list);
7714e32d8956SSteven Rostedt }
7715e32d8956SSteven Rostedt 
7716d879d0b8SNamhyung Kim void ftrace_clear_pids(struct trace_array *tr)
7717d879d0b8SNamhyung Kim {
7718d879d0b8SNamhyung Kim 	mutex_lock(&ftrace_lock);
7719d879d0b8SNamhyung Kim 
7720b3b1e6edSSteven Rostedt (VMware) 	clear_ftrace_pids(tr, TRACE_PIDS | TRACE_NO_PIDS);
7721d879d0b8SNamhyung Kim 
7722d879d0b8SNamhyung Kim 	mutex_unlock(&ftrace_lock);
7723d879d0b8SNamhyung Kim }
7724d879d0b8SNamhyung Kim 
7725b3b1e6edSSteven Rostedt (VMware) static void ftrace_pid_reset(struct trace_array *tr, int type)
7726e32d8956SSteven Rostedt {
7727756d17eeS[email protected] 	mutex_lock(&ftrace_lock);
7728b3b1e6edSSteven Rostedt (VMware) 	clear_ftrace_pids(tr, type);
7729756d17eeS[email protected] 
7730756d17eeS[email protected] 	ftrace_update_pid_func();
7731e1effa01SSteven Rostedt (Red Hat) 	ftrace_startup_all(0);
7732756d17eeS[email protected] 
7733756d17eeS[email protected] 	mutex_unlock(&ftrace_lock);
7734756d17eeS[email protected] }
7735756d17eeS[email protected] 
7736345ddcc8SSteven Rostedt (Red Hat) /* Greater than any max PID */
7737345ddcc8SSteven Rostedt (Red Hat) #define FTRACE_NO_PIDS		(void *)(PID_MAX_LIMIT + 1)
7738345ddcc8SSteven Rostedt (Red Hat) 
7739756d17eeS[email protected] static void *fpid_start(struct seq_file *m, loff_t *pos)
7740345ddcc8SSteven Rostedt (Red Hat) 	__acquires(RCU)
7741756d17eeS[email protected] {
7742345ddcc8SSteven Rostedt (Red Hat) 	struct trace_pid_list *pid_list;
7743345ddcc8SSteven Rostedt (Red Hat) 	struct trace_array *tr = m->private;
7744345ddcc8SSteven Rostedt (Red Hat) 
7745756d17eeS[email protected] 	mutex_lock(&ftrace_lock);
7746345ddcc8SSteven Rostedt (Red Hat) 	rcu_read_lock_sched();
7747756d17eeS[email protected] 
7748345ddcc8SSteven Rostedt (Red Hat) 	pid_list = rcu_dereference_sched(tr->function_pids);
7749756d17eeS[email protected] 
7750345ddcc8SSteven Rostedt (Red Hat) 	if (!pid_list)
7751345ddcc8SSteven Rostedt (Red Hat) 		return !(*pos) ? FTRACE_NO_PIDS : NULL;
7752345ddcc8SSteven Rostedt (Red Hat) 
7753345ddcc8SSteven Rostedt (Red Hat) 	return trace_pid_start(pid_list, pos);
7754756d17eeS[email protected] }
7755756d17eeS[email protected] 
7756756d17eeS[email protected] static void *fpid_next(struct seq_file *m, void *v, loff_t *pos)
7757756d17eeS[email protected] {
7758345ddcc8SSteven Rostedt (Red Hat) 	struct trace_array *tr = m->private;
7759345ddcc8SSteven Rostedt (Red Hat) 	struct trace_pid_list *pid_list = rcu_dereference_sched(tr->function_pids);
7760345ddcc8SSteven Rostedt (Red Hat) 
7761e4075e8bSVasily Averin 	if (v == FTRACE_NO_PIDS) {
7762e4075e8bSVasily Averin 		(*pos)++;
7763756d17eeS[email protected] 		return NULL;
7764e4075e8bSVasily Averin 	}
7765345ddcc8SSteven Rostedt (Red Hat) 	return trace_pid_next(pid_list, v, pos);
7766756d17eeS[email protected] }
7767756d17eeS[email protected] 
7768756d17eeS[email protected] static void fpid_stop(struct seq_file *m, void *p)
7769345ddcc8SSteven Rostedt (Red Hat) 	__releases(RCU)
7770756d17eeS[email protected] {
7771345ddcc8SSteven Rostedt (Red Hat) 	rcu_read_unlock_sched();
7772756d17eeS[email protected] 	mutex_unlock(&ftrace_lock);
7773756d17eeS[email protected] }
7774756d17eeS[email protected] 
7775756d17eeS[email protected] static int fpid_show(struct seq_file *m, void *v)
7776756d17eeS[email protected] {
7777345ddcc8SSteven Rostedt (Red Hat) 	if (v == FTRACE_NO_PIDS) {
7778fa6f0cc7SRasmus Villemoes 		seq_puts(m, "no pid\n");
7779756d17eeS[email protected] 		return 0;
7780756d17eeS[email protected] 	}
7781756d17eeS[email protected] 
7782345ddcc8SSteven Rostedt (Red Hat) 	return trace_pid_show(m, v);
7783756d17eeS[email protected] }
7784756d17eeS[email protected] 
7785756d17eeS[email protected] static const struct seq_operations ftrace_pid_sops = {
7786756d17eeS[email protected] 	.start = fpid_start,
7787756d17eeS[email protected] 	.next = fpid_next,
7788756d17eeS[email protected] 	.stop = fpid_stop,
7789756d17eeS[email protected] 	.show = fpid_show,
7790756d17eeS[email protected] };
7791756d17eeS[email protected] 
7792b3b1e6edSSteven Rostedt (VMware) static void *fnpid_start(struct seq_file *m, loff_t *pos)
7793b3b1e6edSSteven Rostedt (VMware) 	__acquires(RCU)
7794756d17eeS[email protected] {
7795b3b1e6edSSteven Rostedt (VMware) 	struct trace_pid_list *pid_list;
7796b3b1e6edSSteven Rostedt (VMware) 	struct trace_array *tr = m->private;
7797b3b1e6edSSteven Rostedt (VMware) 
7798b3b1e6edSSteven Rostedt (VMware) 	mutex_lock(&ftrace_lock);
7799b3b1e6edSSteven Rostedt (VMware) 	rcu_read_lock_sched();
7800b3b1e6edSSteven Rostedt (VMware) 
7801b3b1e6edSSteven Rostedt (VMware) 	pid_list = rcu_dereference_sched(tr->function_no_pids);
7802b3b1e6edSSteven Rostedt (VMware) 
7803b3b1e6edSSteven Rostedt (VMware) 	if (!pid_list)
7804b3b1e6edSSteven Rostedt (VMware) 		return !(*pos) ? FTRACE_NO_PIDS : NULL;
7805b3b1e6edSSteven Rostedt (VMware) 
7806b3b1e6edSSteven Rostedt (VMware) 	return trace_pid_start(pid_list, pos);
7807b3b1e6edSSteven Rostedt (VMware) }
7808b3b1e6edSSteven Rostedt (VMware) 
7809b3b1e6edSSteven Rostedt (VMware) static void *fnpid_next(struct seq_file *m, void *v, loff_t *pos)
7810b3b1e6edSSteven Rostedt (VMware) {
7811b3b1e6edSSteven Rostedt (VMware) 	struct trace_array *tr = m->private;
7812b3b1e6edSSteven Rostedt (VMware) 	struct trace_pid_list *pid_list = rcu_dereference_sched(tr->function_no_pids);
7813b3b1e6edSSteven Rostedt (VMware) 
7814b3b1e6edSSteven Rostedt (VMware) 	if (v == FTRACE_NO_PIDS) {
7815b3b1e6edSSteven Rostedt (VMware) 		(*pos)++;
7816b3b1e6edSSteven Rostedt (VMware) 		return NULL;
7817b3b1e6edSSteven Rostedt (VMware) 	}
7818b3b1e6edSSteven Rostedt (VMware) 	return trace_pid_next(pid_list, v, pos);
7819b3b1e6edSSteven Rostedt (VMware) }
7820b3b1e6edSSteven Rostedt (VMware) 
7821b3b1e6edSSteven Rostedt (VMware) static const struct seq_operations ftrace_no_pid_sops = {
7822b3b1e6edSSteven Rostedt (VMware) 	.start = fnpid_start,
7823b3b1e6edSSteven Rostedt (VMware) 	.next = fnpid_next,
7824b3b1e6edSSteven Rostedt (VMware) 	.stop = fpid_stop,
7825b3b1e6edSSteven Rostedt (VMware) 	.show = fpid_show,
7826b3b1e6edSSteven Rostedt (VMware) };
7827b3b1e6edSSteven Rostedt (VMware) 
7828b3b1e6edSSteven Rostedt (VMware) static int pid_open(struct inode *inode, struct file *file, int type)
7829b3b1e6edSSteven Rostedt (VMware) {
7830b3b1e6edSSteven Rostedt (VMware) 	const struct seq_operations *seq_ops;
7831345ddcc8SSteven Rostedt (Red Hat) 	struct trace_array *tr = inode->i_private;
7832345ddcc8SSteven Rostedt (Red Hat) 	struct seq_file *m;
7833756d17eeS[email protected] 	int ret = 0;
7834756d17eeS[email protected] 
78358530dec6SSteven Rostedt (VMware) 	ret = tracing_check_open_get_tr(tr);
78368530dec6SSteven Rostedt (VMware) 	if (ret)
78378530dec6SSteven Rostedt (VMware) 		return ret;
7838345ddcc8SSteven Rostedt (Red Hat) 
7839756d17eeS[email protected] 	if ((file->f_mode & FMODE_WRITE) &&
7840756d17eeS[email protected] 	    (file->f_flags & O_TRUNC))
7841b3b1e6edSSteven Rostedt (VMware) 		ftrace_pid_reset(tr, type);
7842756d17eeS[email protected] 
7843b3b1e6edSSteven Rostedt (VMware) 	switch (type) {
7844b3b1e6edSSteven Rostedt (VMware) 	case TRACE_PIDS:
7845b3b1e6edSSteven Rostedt (VMware) 		seq_ops = &ftrace_pid_sops;
7846b3b1e6edSSteven Rostedt (VMware) 		break;
7847b3b1e6edSSteven Rostedt (VMware) 	case TRACE_NO_PIDS:
7848b3b1e6edSSteven Rostedt (VMware) 		seq_ops = &ftrace_no_pid_sops;
7849b3b1e6edSSteven Rostedt (VMware) 		break;
7850026bb845SKaitao Cheng 	default:
7851026bb845SKaitao Cheng 		trace_array_put(tr);
7852026bb845SKaitao Cheng 		WARN_ON_ONCE(1);
7853026bb845SKaitao Cheng 		return -EINVAL;
7854b3b1e6edSSteven Rostedt (VMware) 	}
7855b3b1e6edSSteven Rostedt (VMware) 
7856b3b1e6edSSteven Rostedt (VMware) 	ret = seq_open(file, seq_ops);
7857345ddcc8SSteven Rostedt (Red Hat) 	if (ret < 0) {
7858345ddcc8SSteven Rostedt (Red Hat) 		trace_array_put(tr);
7859345ddcc8SSteven Rostedt (Red Hat) 	} else {
7860345ddcc8SSteven Rostedt (Red Hat) 		m = file->private_data;
7861345ddcc8SSteven Rostedt (Red Hat) 		/* copy tr over to seq ops */
7862345ddcc8SSteven Rostedt (Red Hat) 		m->private = tr;
7863345ddcc8SSteven Rostedt (Red Hat) 	}
7864756d17eeS[email protected] 
7865756d17eeS[email protected] 	return ret;
7866756d17eeS[email protected] }
7867756d17eeS[email protected] 
7868b3b1e6edSSteven Rostedt (VMware) static int
7869b3b1e6edSSteven Rostedt (VMware) ftrace_pid_open(struct inode *inode, struct file *file)
7870b3b1e6edSSteven Rostedt (VMware) {
7871b3b1e6edSSteven Rostedt (VMware) 	return pid_open(inode, file, TRACE_PIDS);
7872b3b1e6edSSteven Rostedt (VMware) }
7873b3b1e6edSSteven Rostedt (VMware) 
7874b3b1e6edSSteven Rostedt (VMware) static int
7875b3b1e6edSSteven Rostedt (VMware) ftrace_no_pid_open(struct inode *inode, struct file *file)
7876b3b1e6edSSteven Rostedt (VMware) {
7877b3b1e6edSSteven Rostedt (VMware) 	return pid_open(inode, file, TRACE_NO_PIDS);
7878b3b1e6edSSteven Rostedt (VMware) }
7879b3b1e6edSSteven Rostedt (VMware) 
7880345ddcc8SSteven Rostedt (Red Hat) static void ignore_task_cpu(void *data)
7881345ddcc8SSteven Rostedt (Red Hat) {
7882345ddcc8SSteven Rostedt (Red Hat) 	struct trace_array *tr = data;
7883345ddcc8SSteven Rostedt (Red Hat) 	struct trace_pid_list *pid_list;
7884b3b1e6edSSteven Rostedt (VMware) 	struct trace_pid_list *no_pid_list;
7885345ddcc8SSteven Rostedt (Red Hat) 
7886345ddcc8SSteven Rostedt (Red Hat) 	/*
7887345ddcc8SSteven Rostedt (Red Hat) 	 * This function is called by on_each_cpu() while the
7888345ddcc8SSteven Rostedt (Red Hat) 	 * event_mutex is held.
7889345ddcc8SSteven Rostedt (Red Hat) 	 */
7890345ddcc8SSteven Rostedt (Red Hat) 	pid_list = rcu_dereference_protected(tr->function_pids,
7891345ddcc8SSteven Rostedt (Red Hat) 					     mutex_is_locked(&ftrace_lock));
7892b3b1e6edSSteven Rostedt (VMware) 	no_pid_list = rcu_dereference_protected(tr->function_no_pids,
7893b3b1e6edSSteven Rostedt (VMware) 						mutex_is_locked(&ftrace_lock));
7894345ddcc8SSteven Rostedt (Red Hat) 
7895b3b1e6edSSteven Rostedt (VMware) 	if (trace_ignore_this_task(pid_list, no_pid_list, current))
78961c5eb448SSteven Rostedt (VMware) 		this_cpu_write(tr->array_buffer.data->ftrace_ignore_pid,
7897717e3f5eSSteven Rostedt (VMware) 			       FTRACE_PID_IGNORE);
7898717e3f5eSSteven Rostedt (VMware) 	else
7899717e3f5eSSteven Rostedt (VMware) 		this_cpu_write(tr->array_buffer.data->ftrace_ignore_pid,
7900717e3f5eSSteven Rostedt (VMware) 			       current->pid);
7901345ddcc8SSteven Rostedt (Red Hat) }
7902345ddcc8SSteven Rostedt (Red Hat) 
7903df4fc315SSteven Rostedt static ssize_t
7904b3b1e6edSSteven Rostedt (VMware) pid_write(struct file *filp, const char __user *ubuf,
7905b3b1e6edSSteven Rostedt (VMware) 	  size_t cnt, loff_t *ppos, int type)
7906df4fc315SSteven Rostedt {
7907345ddcc8SSteven Rostedt (Red Hat) 	struct seq_file *m = filp->private_data;
7908345ddcc8SSteven Rostedt (Red Hat) 	struct trace_array *tr = m->private;
7909b3b1e6edSSteven Rostedt (VMware) 	struct trace_pid_list *filtered_pids;
7910b3b1e6edSSteven Rostedt (VMware) 	struct trace_pid_list *other_pids;
7911345ddcc8SSteven Rostedt (Red Hat) 	struct trace_pid_list *pid_list;
7912345ddcc8SSteven Rostedt (Red Hat) 	ssize_t ret;
7913df4fc315SSteven Rostedt 
7914345ddcc8SSteven Rostedt (Red Hat) 	if (!cnt)
7915345ddcc8SSteven Rostedt (Red Hat) 		return 0;
7916df4fc315SSteven Rostedt 
7917345ddcc8SSteven Rostedt (Red Hat) 	mutex_lock(&ftrace_lock);
7918df4fc315SSteven Rostedt 
7919b3b1e6edSSteven Rostedt (VMware) 	switch (type) {
7920b3b1e6edSSteven Rostedt (VMware) 	case TRACE_PIDS:
7921345ddcc8SSteven Rostedt (Red Hat) 		filtered_pids = rcu_dereference_protected(tr->function_pids,
7922345ddcc8SSteven Rostedt (Red Hat) 					     lockdep_is_held(&ftrace_lock));
7923b3b1e6edSSteven Rostedt (VMware) 		other_pids = rcu_dereference_protected(tr->function_no_pids,
7924b3b1e6edSSteven Rostedt (VMware) 					     lockdep_is_held(&ftrace_lock));
7925b3b1e6edSSteven Rostedt (VMware) 		break;
7926b3b1e6edSSteven Rostedt (VMware) 	case TRACE_NO_PIDS:
7927b3b1e6edSSteven Rostedt (VMware) 		filtered_pids = rcu_dereference_protected(tr->function_no_pids,
7928b3b1e6edSSteven Rostedt (VMware) 					     lockdep_is_held(&ftrace_lock));
7929b3b1e6edSSteven Rostedt (VMware) 		other_pids = rcu_dereference_protected(tr->function_pids,
7930b3b1e6edSSteven Rostedt (VMware) 					     lockdep_is_held(&ftrace_lock));
7931b3b1e6edSSteven Rostedt (VMware) 		break;
7932026bb845SKaitao Cheng 	default:
7933026bb845SKaitao Cheng 		ret = -EINVAL;
7934026bb845SKaitao Cheng 		WARN_ON_ONCE(1);
7935026bb845SKaitao Cheng 		goto out;
7936b3b1e6edSSteven Rostedt (VMware) 	}
7937345ddcc8SSteven Rostedt (Red Hat) 
7938345ddcc8SSteven Rostedt (Red Hat) 	ret = trace_pid_write(filtered_pids, &pid_list, ubuf, cnt);
7939345ddcc8SSteven Rostedt (Red Hat) 	if (ret < 0)
7940345ddcc8SSteven Rostedt (Red Hat) 		goto out;
7941345ddcc8SSteven Rostedt (Red Hat) 
7942b3b1e6edSSteven Rostedt (VMware) 	switch (type) {
7943b3b1e6edSSteven Rostedt (VMware) 	case TRACE_PIDS:
7944345ddcc8SSteven Rostedt (Red Hat) 		rcu_assign_pointer(tr->function_pids, pid_list);
7945b3b1e6edSSteven Rostedt (VMware) 		break;
7946b3b1e6edSSteven Rostedt (VMware) 	case TRACE_NO_PIDS:
7947b3b1e6edSSteven Rostedt (VMware) 		rcu_assign_pointer(tr->function_no_pids, pid_list);
7948b3b1e6edSSteven Rostedt (VMware) 		break;
7949b3b1e6edSSteven Rostedt (VMware) 	}
7950b3b1e6edSSteven Rostedt (VMware) 
7951345ddcc8SSteven Rostedt (Red Hat) 
7952345ddcc8SSteven Rostedt (Red Hat) 	if (filtered_pids) {
795374401729SPaul E. McKenney 		synchronize_rcu();
79546954e415SSteven Rostedt (VMware) 		trace_pid_list_free(filtered_pids);
7955b3b1e6edSSteven Rostedt (VMware) 	} else if (pid_list && !other_pids) {
7956345ddcc8SSteven Rostedt (Red Hat) 		/* Register a probe to set whether to ignore the tracing of a task */
7957345ddcc8SSteven Rostedt (Red Hat) 		register_trace_sched_switch(ftrace_filter_pid_sched_switch_probe, tr);
7958345ddcc8SSteven Rostedt (Red Hat) 	}
7959df4fc315SSteven Rostedt 
7960756d17eeS[email protected] 	/*
7961345ddcc8SSteven Rostedt (Red Hat) 	 * Ignoring of pids is done at task switch. But we have to
7962345ddcc8SSteven Rostedt (Red Hat) 	 * check for those tasks that are currently running.
7963345ddcc8SSteven Rostedt (Red Hat) 	 * Always do this in case a pid was appended or removed.
7964756d17eeS[email protected] 	 */
7965345ddcc8SSteven Rostedt (Red Hat) 	on_each_cpu(ignore_task_cpu, tr, 1);
7966756d17eeS[email protected] 
7967345ddcc8SSteven Rostedt (Red Hat) 	ftrace_update_pid_func();
7968345ddcc8SSteven Rostedt (Red Hat) 	ftrace_startup_all(0);
7969345ddcc8SSteven Rostedt (Red Hat)  out:
7970345ddcc8SSteven Rostedt (Red Hat) 	mutex_unlock(&ftrace_lock);
7971345ddcc8SSteven Rostedt (Red Hat) 
7972345ddcc8SSteven Rostedt (Red Hat) 	if (ret > 0)
7973345ddcc8SSteven Rostedt (Red Hat) 		*ppos += ret;
7974345ddcc8SSteven Rostedt (Red Hat) 
7975df4fc315SSteven Rostedt 	return ret;
7976e32d8956SSteven Rostedt }
7977978f3a45SSteven Rostedt 
7978b3b1e6edSSteven Rostedt (VMware) static ssize_t
7979b3b1e6edSSteven Rostedt (VMware) ftrace_pid_write(struct file *filp, const char __user *ubuf,
7980b3b1e6edSSteven Rostedt (VMware) 		 size_t cnt, loff_t *ppos)
7981b3b1e6edSSteven Rostedt (VMware) {
7982b3b1e6edSSteven Rostedt (VMware) 	return pid_write(filp, ubuf, cnt, ppos, TRACE_PIDS);
7983b3b1e6edSSteven Rostedt (VMware) }
7984b3b1e6edSSteven Rostedt (VMware) 
7985b3b1e6edSSteven Rostedt (VMware) static ssize_t
7986b3b1e6edSSteven Rostedt (VMware) ftrace_no_pid_write(struct file *filp, const char __user *ubuf,
7987b3b1e6edSSteven Rostedt (VMware) 		    size_t cnt, loff_t *ppos)
7988b3b1e6edSSteven Rostedt (VMware) {
7989b3b1e6edSSteven Rostedt (VMware) 	return pid_write(filp, ubuf, cnt, ppos, TRACE_NO_PIDS);
7990b3b1e6edSSteven Rostedt (VMware) }
7991b3b1e6edSSteven Rostedt (VMware) 
7992756d17eeS[email protected] static int
7993756d17eeS[email protected] ftrace_pid_release(struct inode *inode, struct file *file)
7994756d17eeS[email protected] {
7995345ddcc8SSteven Rostedt (Red Hat) 	struct trace_array *tr = inode->i_private;
7996978f3a45SSteven Rostedt 
7997345ddcc8SSteven Rostedt (Red Hat) 	trace_array_put(tr);
7998345ddcc8SSteven Rostedt (Red Hat) 
7999345ddcc8SSteven Rostedt (Red Hat) 	return seq_release(inode, file);
8000df4fc315SSteven Rostedt }
8001df4fc315SSteven Rostedt 
80025e2336a0SSteven Rostedt static const struct file_operations ftrace_pid_fops = {
8003756d17eeS[email protected] 	.open		= ftrace_pid_open,
8004df4fc315SSteven Rostedt 	.write		= ftrace_pid_write,
8005756d17eeS[email protected] 	.read		= seq_read,
8006098c879eSSteven Rostedt (Red Hat) 	.llseek		= tracing_lseek,
8007756d17eeS[email protected] 	.release	= ftrace_pid_release,
8008df4fc315SSteven Rostedt };
8009df4fc315SSteven Rostedt 
8010b3b1e6edSSteven Rostedt (VMware) static const struct file_operations ftrace_no_pid_fops = {
8011b3b1e6edSSteven Rostedt (VMware) 	.open		= ftrace_no_pid_open,
8012b3b1e6edSSteven Rostedt (VMware) 	.write		= ftrace_no_pid_write,
8013b3b1e6edSSteven Rostedt (VMware) 	.read		= seq_read,
8014b3b1e6edSSteven Rostedt (VMware) 	.llseek		= tracing_lseek,
8015b3b1e6edSSteven Rostedt (VMware) 	.release	= ftrace_pid_release,
8016b3b1e6edSSteven Rostedt (VMware) };
8017b3b1e6edSSteven Rostedt (VMware) 
8018345ddcc8SSteven Rostedt (Red Hat) void ftrace_init_tracefs(struct trace_array *tr, struct dentry *d_tracer)
8019df4fc315SSteven Rostedt {
802021ccc9cdSSteven Rostedt (VMware) 	trace_create_file("set_ftrace_pid", TRACE_MODE_WRITE, d_tracer,
8021345ddcc8SSteven Rostedt (Red Hat) 			    tr, &ftrace_pid_fops);
802221ccc9cdSSteven Rostedt (VMware) 	trace_create_file("set_ftrace_notrace_pid", TRACE_MODE_WRITE,
802321ccc9cdSSteven Rostedt (VMware) 			  d_tracer, tr, &ftrace_no_pid_fops);
8024df4fc315SSteven Rostedt }
8025df4fc315SSteven Rostedt 
8026501c2375SSteven Rostedt (Red Hat) void __init ftrace_init_tracefs_toplevel(struct trace_array *tr,
8027501c2375SSteven Rostedt (Red Hat) 					 struct dentry *d_tracer)
8028501c2375SSteven Rostedt (Red Hat) {
8029501c2375SSteven Rostedt (Red Hat) 	/* Only the top level directory has the dyn_tracefs and profile */
8030501c2375SSteven Rostedt (Red Hat) 	WARN_ON(!(tr->flags & TRACE_ARRAY_FL_GLOBAL));
8031501c2375SSteven Rostedt (Red Hat) 
8032501c2375SSteven Rostedt (Red Hat) 	ftrace_init_dyn_tracefs(d_tracer);
8033501c2375SSteven Rostedt (Red Hat) 	ftrace_profile_tracefs(d_tracer);
8034501c2375SSteven Rostedt (Red Hat) }
8035501c2375SSteven Rostedt (Red Hat) 
80363d083395SSteven Rostedt /**
803781adbdc0SSteven Rostedt  * ftrace_kill - kill ftrace
8038a2bb6a3dSSteven Rostedt  *
8039a2bb6a3dSSteven Rostedt  * This function should be used by panic code. It stops ftrace
8040a2bb6a3dSSteven Rostedt  * but in a not so nice way. If you need to simply kill ftrace
8041a2bb6a3dSSteven Rostedt  * from a non-atomic section, use ftrace_kill.
8042a2bb6a3dSSteven Rostedt  */
804381adbdc0SSteven Rostedt void ftrace_kill(void)
8044a2bb6a3dSSteven Rostedt {
8045a2bb6a3dSSteven Rostedt 	ftrace_disabled = 1;
8046a2bb6a3dSSteven Rostedt 	ftrace_enabled = 0;
80475ccba64aSYisheng Xie 	ftrace_trace_function = ftrace_stub;
8048a2bb6a3dSSteven Rostedt }
8049a2bb6a3dSSteven Rostedt 
8050a2bb6a3dSSteven Rostedt /**
80516130722fSSteven Rostedt (VMware)  * ftrace_is_dead - Test if ftrace is dead or not.
80526130722fSSteven Rostedt (VMware)  *
80536130722fSSteven Rostedt (VMware)  * Returns 1 if ftrace is "dead", zero otherwise.
8054e0a413f6SSteven Rostedt  */
8055e0a413f6SSteven Rostedt int ftrace_is_dead(void)
8056e0a413f6SSteven Rostedt {
8057e0a413f6SSteven Rostedt 	return ftrace_disabled;
8058e0a413f6SSteven Rostedt }
8059e0a413f6SSteven Rostedt 
806053cd885bSSong Liu #ifdef CONFIG_DYNAMIC_FTRACE_WITH_DIRECT_CALLS
806153cd885bSSong Liu /*
806253cd885bSSong Liu  * When registering ftrace_ops with IPMODIFY, it is necessary to make sure
806353cd885bSSong Liu  * it doesn't conflict with any direct ftrace_ops. If there is existing
806453cd885bSSong Liu  * direct ftrace_ops on a kernel function being patched, call
806553cd885bSSong Liu  * FTRACE_OPS_CMD_ENABLE_SHARE_IPMODIFY_PEER on it to enable sharing.
806653cd885bSSong Liu  *
806753cd885bSSong Liu  * @ops:     ftrace_ops being registered.
806853cd885bSSong Liu  *
806953cd885bSSong Liu  * Returns:
807053cd885bSSong Liu  *         0 on success;
807153cd885bSSong Liu  *         Negative on failure.
807253cd885bSSong Liu  */
807353cd885bSSong Liu static int prepare_direct_functions_for_ipmodify(struct ftrace_ops *ops)
807453cd885bSSong Liu {
807553cd885bSSong Liu 	struct ftrace_func_entry *entry;
807653cd885bSSong Liu 	struct ftrace_hash *hash;
807753cd885bSSong Liu 	struct ftrace_ops *op;
807853cd885bSSong Liu 	int size, i, ret;
807953cd885bSSong Liu 
808053cd885bSSong Liu 	lockdep_assert_held_once(&direct_mutex);
808153cd885bSSong Liu 
808253cd885bSSong Liu 	if (!(ops->flags & FTRACE_OPS_FL_IPMODIFY))
808353cd885bSSong Liu 		return 0;
808453cd885bSSong Liu 
808553cd885bSSong Liu 	hash = ops->func_hash->filter_hash;
808653cd885bSSong Liu 	size = 1 << hash->size_bits;
808753cd885bSSong Liu 	for (i = 0; i < size; i++) {
808853cd885bSSong Liu 		hlist_for_each_entry(entry, &hash->buckets[i], hlist) {
808953cd885bSSong Liu 			unsigned long ip = entry->ip;
809053cd885bSSong Liu 			bool found_op = false;
809153cd885bSSong Liu 
809253cd885bSSong Liu 			mutex_lock(&ftrace_lock);
809353cd885bSSong Liu 			do_for_each_ftrace_op(op, ftrace_ops_list) {
809453cd885bSSong Liu 				if (!(op->flags & FTRACE_OPS_FL_DIRECT))
809553cd885bSSong Liu 					continue;
809653cd885bSSong Liu 				if (ops_references_ip(op, ip)) {
809753cd885bSSong Liu 					found_op = true;
809853cd885bSSong Liu 					break;
809953cd885bSSong Liu 				}
810053cd885bSSong Liu 			} while_for_each_ftrace_op(op);
810153cd885bSSong Liu 			mutex_unlock(&ftrace_lock);
810253cd885bSSong Liu 
810353cd885bSSong Liu 			if (found_op) {
810453cd885bSSong Liu 				if (!op->ops_func)
810553cd885bSSong Liu 					return -EBUSY;
810653cd885bSSong Liu 
810753cd885bSSong Liu 				ret = op->ops_func(op, FTRACE_OPS_CMD_ENABLE_SHARE_IPMODIFY_PEER);
810853cd885bSSong Liu 				if (ret)
810953cd885bSSong Liu 					return ret;
811053cd885bSSong Liu 			}
811153cd885bSSong Liu 		}
811253cd885bSSong Liu 	}
811353cd885bSSong Liu 
811453cd885bSSong Liu 	return 0;
811553cd885bSSong Liu }
811653cd885bSSong Liu 
811753cd885bSSong Liu /*
811853cd885bSSong Liu  * Similar to prepare_direct_functions_for_ipmodify, clean up after ops
811953cd885bSSong Liu  * with IPMODIFY is unregistered. The cleanup is optional for most DIRECT
812053cd885bSSong Liu  * ops.
812153cd885bSSong Liu  */
812253cd885bSSong Liu static void cleanup_direct_functions_after_ipmodify(struct ftrace_ops *ops)
812353cd885bSSong Liu {
812453cd885bSSong Liu 	struct ftrace_func_entry *entry;
812553cd885bSSong Liu 	struct ftrace_hash *hash;
812653cd885bSSong Liu 	struct ftrace_ops *op;
812753cd885bSSong Liu 	int size, i;
812853cd885bSSong Liu 
812953cd885bSSong Liu 	if (!(ops->flags & FTRACE_OPS_FL_IPMODIFY))
813053cd885bSSong Liu 		return;
813153cd885bSSong Liu 
813253cd885bSSong Liu 	mutex_lock(&direct_mutex);
813353cd885bSSong Liu 
813453cd885bSSong Liu 	hash = ops->func_hash->filter_hash;
813553cd885bSSong Liu 	size = 1 << hash->size_bits;
813653cd885bSSong Liu 	for (i = 0; i < size; i++) {
813753cd885bSSong Liu 		hlist_for_each_entry(entry, &hash->buckets[i], hlist) {
813853cd885bSSong Liu 			unsigned long ip = entry->ip;
813953cd885bSSong Liu 			bool found_op = false;
814053cd885bSSong Liu 
814153cd885bSSong Liu 			mutex_lock(&ftrace_lock);
814253cd885bSSong Liu 			do_for_each_ftrace_op(op, ftrace_ops_list) {
814353cd885bSSong Liu 				if (!(op->flags & FTRACE_OPS_FL_DIRECT))
814453cd885bSSong Liu 					continue;
814553cd885bSSong Liu 				if (ops_references_ip(op, ip)) {
814653cd885bSSong Liu 					found_op = true;
814753cd885bSSong Liu 					break;
814853cd885bSSong Liu 				}
814953cd885bSSong Liu 			} while_for_each_ftrace_op(op);
815053cd885bSSong Liu 			mutex_unlock(&ftrace_lock);
815153cd885bSSong Liu 
815253cd885bSSong Liu 			/* The cleanup is optional, ignore any errors */
815353cd885bSSong Liu 			if (found_op && op->ops_func)
815453cd885bSSong Liu 				op->ops_func(op, FTRACE_OPS_CMD_DISABLE_SHARE_IPMODIFY_PEER);
815553cd885bSSong Liu 		}
815653cd885bSSong Liu 	}
815753cd885bSSong Liu 	mutex_unlock(&direct_mutex);
815853cd885bSSong Liu }
815953cd885bSSong Liu 
816053cd885bSSong Liu #define lock_direct_mutex()	mutex_lock(&direct_mutex)
816153cd885bSSong Liu #define unlock_direct_mutex()	mutex_unlock(&direct_mutex)
816253cd885bSSong Liu 
816353cd885bSSong Liu #else  /* CONFIG_DYNAMIC_FTRACE_WITH_DIRECT_CALLS */
816453cd885bSSong Liu 
816553cd885bSSong Liu static int prepare_direct_functions_for_ipmodify(struct ftrace_ops *ops)
816653cd885bSSong Liu {
816753cd885bSSong Liu 	return 0;
816853cd885bSSong Liu }
816953cd885bSSong Liu 
817053cd885bSSong Liu static void cleanup_direct_functions_after_ipmodify(struct ftrace_ops *ops)
817153cd885bSSong Liu {
817253cd885bSSong Liu }
817353cd885bSSong Liu 
817453cd885bSSong Liu #define lock_direct_mutex()	do { } while (0)
817553cd885bSSong Liu #define unlock_direct_mutex()	do { } while (0)
817653cd885bSSong Liu 
817753cd885bSSong Liu #endif  /* CONFIG_DYNAMIC_FTRACE_WITH_DIRECT_CALLS */
817853cd885bSSong Liu 
817953cd885bSSong Liu /*
818053cd885bSSong Liu  * Similar to register_ftrace_function, except we don't lock direct_mutex.
818153cd885bSSong Liu  */
818253cd885bSSong Liu static int register_ftrace_function_nolock(struct ftrace_ops *ops)
818353cd885bSSong Liu {
818453cd885bSSong Liu 	int ret;
818553cd885bSSong Liu 
818653cd885bSSong Liu 	ftrace_ops_init(ops);
818753cd885bSSong Liu 
818853cd885bSSong Liu 	mutex_lock(&ftrace_lock);
818953cd885bSSong Liu 
819053cd885bSSong Liu 	ret = ftrace_startup(ops, 0);
819153cd885bSSong Liu 
819253cd885bSSong Liu 	mutex_unlock(&ftrace_lock);
819353cd885bSSong Liu 
819453cd885bSSong Liu 	return ret;
819553cd885bSSong Liu }
819653cd885bSSong Liu 
8197e0a413f6SSteven Rostedt /**
81983d083395SSteven Rostedt  * register_ftrace_function - register a function for profiling
819978cbc651SJiapeng Chong  * @ops:	ops structure that holds the function for profiling.
82003d083395SSteven Rostedt  *
82013d083395SSteven Rostedt  * Register a function to be called by all functions in the
82023d083395SSteven Rostedt  * kernel.
82033d083395SSteven Rostedt  *
82043d083395SSteven Rostedt  * Note: @ops->func and all the functions it calls must be labeled
82053d083395SSteven Rostedt  *       with "notrace", otherwise it will go into a
82063d083395SSteven Rostedt  *       recursive loop.
82073d083395SSteven Rostedt  */
82083d083395SSteven Rostedt int register_ftrace_function(struct ftrace_ops *ops)
82093d083395SSteven Rostedt {
82103b1a8f45SColin Ian King 	int ret;
82114eebcc81SSteven Rostedt 
821253cd885bSSong Liu 	lock_direct_mutex();
821353cd885bSSong Liu 	ret = prepare_direct_functions_for_ipmodify(ops);
821453cd885bSSong Liu 	if (ret < 0)
821553cd885bSSong Liu 		goto out_unlock;
8216f04f24fbSMasami Hiramatsu 
821753cd885bSSong Liu 	ret = register_ftrace_function_nolock(ops);
8218e7d3737eSFrederic Weisbecker 
821953cd885bSSong Liu out_unlock:
822053cd885bSSong Liu 	unlock_direct_mutex();
8221b0fc494fSSteven Rostedt 	return ret;
82223d083395SSteven Rostedt }
8223cdbe61bfSSteven Rostedt EXPORT_SYMBOL_GPL(register_ftrace_function);
82243d083395SSteven Rostedt 
82253d083395SSteven Rostedt /**
822632632920SUwe Kleine-Koenig  * unregister_ftrace_function - unregister a function for profiling.
822778cbc651SJiapeng Chong  * @ops:	ops structure that holds the function to unregister
82283d083395SSteven Rostedt  *
82293d083395SSteven Rostedt  * Unregister a function that was added to be called by ftrace profiling.
82303d083395SSteven Rostedt  */
82313d083395SSteven Rostedt int unregister_ftrace_function(struct ftrace_ops *ops)
82323d083395SSteven Rostedt {
82333d083395SSteven Rostedt 	int ret;
82343d083395SSteven Rostedt 
8235e6ea44e9SSteven Rostedt 	mutex_lock(&ftrace_lock);
82368a56d776SSteven Rostedt (Red Hat) 	ret = ftrace_shutdown(ops, 0);
8237e6ea44e9SSteven Rostedt 	mutex_unlock(&ftrace_lock);
8238b0fc494fSSteven Rostedt 
823953cd885bSSong Liu 	cleanup_direct_functions_after_ipmodify(ops);
8240b0fc494fSSteven Rostedt 	return ret;
8241b0fc494fSSteven Rostedt }
8242cdbe61bfSSteven Rostedt EXPORT_SYMBOL_GPL(unregister_ftrace_function);
8243b0fc494fSSteven Rostedt 
8244bed0d9a5SJiri Olsa static int symbols_cmp(const void *a, const void *b)
8245bed0d9a5SJiri Olsa {
8246bed0d9a5SJiri Olsa 	const char **str_a = (const char **) a;
8247bed0d9a5SJiri Olsa 	const char **str_b = (const char **) b;
8248bed0d9a5SJiri Olsa 
8249bed0d9a5SJiri Olsa 	return strcmp(*str_a, *str_b);
8250bed0d9a5SJiri Olsa }
8251bed0d9a5SJiri Olsa 
8252bed0d9a5SJiri Olsa struct kallsyms_data {
8253bed0d9a5SJiri Olsa 	unsigned long *addrs;
8254bed0d9a5SJiri Olsa 	const char **syms;
8255bed0d9a5SJiri Olsa 	size_t cnt;
8256bed0d9a5SJiri Olsa 	size_t found;
8257bed0d9a5SJiri Olsa };
8258bed0d9a5SJiri Olsa 
8259bed0d9a5SJiri Olsa static int kallsyms_callback(void *data, const char *name,
8260bed0d9a5SJiri Olsa 			     struct module *mod, unsigned long addr)
8261bed0d9a5SJiri Olsa {
8262bed0d9a5SJiri Olsa 	struct kallsyms_data *args = data;
8263eb1b2985SJiri Olsa 	const char **sym;
8264eb1b2985SJiri Olsa 	int idx;
8265bed0d9a5SJiri Olsa 
8266eb1b2985SJiri Olsa 	sym = bsearch(&name, args->syms, args->cnt, sizeof(*args->syms), symbols_cmp);
8267eb1b2985SJiri Olsa 	if (!sym)
8268eb1b2985SJiri Olsa 		return 0;
8269eb1b2985SJiri Olsa 
8270eb1b2985SJiri Olsa 	idx = sym - args->syms;
8271eb1b2985SJiri Olsa 	if (args->addrs[idx])
8272bed0d9a5SJiri Olsa 		return 0;
8273bed0d9a5SJiri Olsa 
82749d68c19cSJiri Olsa 	if (!ftrace_location(addr))
8275bed0d9a5SJiri Olsa 		return 0;
8276bed0d9a5SJiri Olsa 
8277eb1b2985SJiri Olsa 	args->addrs[idx] = addr;
8278eb1b2985SJiri Olsa 	args->found++;
8279bed0d9a5SJiri Olsa 	return args->found == args->cnt ? 1 : 0;
8280bed0d9a5SJiri Olsa }
8281bed0d9a5SJiri Olsa 
8282bed0d9a5SJiri Olsa /**
8283bed0d9a5SJiri Olsa  * ftrace_lookup_symbols - Lookup addresses for array of symbols
8284bed0d9a5SJiri Olsa  *
8285bed0d9a5SJiri Olsa  * @sorted_syms: array of symbols pointers symbols to resolve,
8286bed0d9a5SJiri Olsa  * must be alphabetically sorted
8287bed0d9a5SJiri Olsa  * @cnt: number of symbols/addresses in @syms/@addrs arrays
8288bed0d9a5SJiri Olsa  * @addrs: array for storing resulting addresses
8289bed0d9a5SJiri Olsa  *
8290bed0d9a5SJiri Olsa  * This function looks up addresses for array of symbols provided in
8291bed0d9a5SJiri Olsa  * @syms array (must be alphabetically sorted) and stores them in
8292bed0d9a5SJiri Olsa  * @addrs array, which needs to be big enough to store at least @cnt
8293bed0d9a5SJiri Olsa  * addresses.
8294bed0d9a5SJiri Olsa  *
8295bed0d9a5SJiri Olsa  * This function returns 0 if all provided symbols are found,
8296bed0d9a5SJiri Olsa  * -ESRCH otherwise.
8297bed0d9a5SJiri Olsa  */
8298bed0d9a5SJiri Olsa int ftrace_lookup_symbols(const char **sorted_syms, size_t cnt, unsigned long *addrs)
8299bed0d9a5SJiri Olsa {
8300bed0d9a5SJiri Olsa 	struct kallsyms_data args;
8301bed0d9a5SJiri Olsa 	int err;
8302bed0d9a5SJiri Olsa 
8303eb1b2985SJiri Olsa 	memset(addrs, 0, sizeof(*addrs) * cnt);
8304bed0d9a5SJiri Olsa 	args.addrs = addrs;
8305bed0d9a5SJiri Olsa 	args.syms = sorted_syms;
8306bed0d9a5SJiri Olsa 	args.cnt = cnt;
8307bed0d9a5SJiri Olsa 	args.found = 0;
8308bed0d9a5SJiri Olsa 	err = kallsyms_on_each_symbol(kallsyms_callback, &args);
8309bed0d9a5SJiri Olsa 	if (err < 0)
8310bed0d9a5SJiri Olsa 		return err;
8311bed0d9a5SJiri Olsa 	return args.found == args.cnt ? 0 : -ESRCH;
8312bed0d9a5SJiri Olsa }
831344d35720SLinus Torvalds 
83145d79fa0dSYueHaibing #ifdef CONFIG_SYSCTL
83158fd7c214SLuis Chamberlain 
83168fd7c214SLuis Chamberlain #ifdef CONFIG_DYNAMIC_FTRACE
8317f8b7d2b4SLuis Chamberlain static void ftrace_startup_sysctl(void)
8318f8b7d2b4SLuis Chamberlain {
8319f8b7d2b4SLuis Chamberlain 	int command;
8320f8b7d2b4SLuis Chamberlain 
8321f8b7d2b4SLuis Chamberlain 	if (unlikely(ftrace_disabled))
8322f8b7d2b4SLuis Chamberlain 		return;
8323f8b7d2b4SLuis Chamberlain 
8324f8b7d2b4SLuis Chamberlain 	/* Force update next time */
8325f8b7d2b4SLuis Chamberlain 	saved_ftrace_func = NULL;
8326f8b7d2b4SLuis Chamberlain 	/* ftrace_start_up is true if we want ftrace running */
8327f8b7d2b4SLuis Chamberlain 	if (ftrace_start_up) {
8328f8b7d2b4SLuis Chamberlain 		command = FTRACE_UPDATE_CALLS;
8329f8b7d2b4SLuis Chamberlain 		if (ftrace_graph_active)
8330f8b7d2b4SLuis Chamberlain 			command |= FTRACE_START_FUNC_RET;
8331f8b7d2b4SLuis Chamberlain 		ftrace_startup_enable(command);
8332f8b7d2b4SLuis Chamberlain 	}
8333f8b7d2b4SLuis Chamberlain }
8334f8b7d2b4SLuis Chamberlain 
8335f8b7d2b4SLuis Chamberlain static void ftrace_shutdown_sysctl(void)
8336f8b7d2b4SLuis Chamberlain {
8337f8b7d2b4SLuis Chamberlain 	int command;
8338f8b7d2b4SLuis Chamberlain 
8339f8b7d2b4SLuis Chamberlain 	if (unlikely(ftrace_disabled))
8340f8b7d2b4SLuis Chamberlain 		return;
8341f8b7d2b4SLuis Chamberlain 
8342f8b7d2b4SLuis Chamberlain 	/* ftrace_start_up is true if ftrace is running */
8343f8b7d2b4SLuis Chamberlain 	if (ftrace_start_up) {
8344f8b7d2b4SLuis Chamberlain 		command = FTRACE_DISABLE_CALLS;
8345f8b7d2b4SLuis Chamberlain 		if (ftrace_graph_active)
8346f8b7d2b4SLuis Chamberlain 			command |= FTRACE_STOP_FUNC_RET;
8347f8b7d2b4SLuis Chamberlain 		ftrace_run_update_code(command);
8348f8b7d2b4SLuis Chamberlain 	}
8349f8b7d2b4SLuis Chamberlain }
83508fd7c214SLuis Chamberlain #else
83518fd7c214SLuis Chamberlain # define ftrace_startup_sysctl()       do { } while (0)
83528fd7c214SLuis Chamberlain # define ftrace_shutdown_sysctl()      do { } while (0)
83538fd7c214SLuis Chamberlain #endif /* CONFIG_DYNAMIC_FTRACE */
8354f8b7d2b4SLuis Chamberlain 
83557162431dSMiroslav Benes static bool is_permanent_ops_registered(void)
83567162431dSMiroslav Benes {
83577162431dSMiroslav Benes 	struct ftrace_ops *op;
83587162431dSMiroslav Benes 
83597162431dSMiroslav Benes 	do_for_each_ftrace_op(op, ftrace_ops_list) {
83607162431dSMiroslav Benes 		if (op->flags & FTRACE_OPS_FL_PERMANENT)
83617162431dSMiroslav Benes 			return true;
83627162431dSMiroslav Benes 	} while_for_each_ftrace_op(op);
83637162431dSMiroslav Benes 
83647162431dSMiroslav Benes 	return false;
83657162431dSMiroslav Benes }
83667162431dSMiroslav Benes 
83678e4e83b2SWei Xiao static int
8368b0fc494fSSteven Rostedt ftrace_enable_sysctl(struct ctl_table *table, int write,
836954fa9ba5STobias Klauser 		     void *buffer, size_t *lenp, loff_t *ppos)
8370b0fc494fSSteven Rostedt {
837145a4a237SSteven Rostedt 	int ret = -ENODEV;
83724eebcc81SSteven Rostedt 
8373e6ea44e9SSteven Rostedt 	mutex_lock(&ftrace_lock);
8374b0fc494fSSteven Rostedt 
837545a4a237SSteven Rostedt 	if (unlikely(ftrace_disabled))
837645a4a237SSteven Rostedt 		goto out;
837745a4a237SSteven Rostedt 
83788d65af78SAlexey Dobriyan 	ret = proc_dointvec(table, write, buffer, lenp, ppos);
8379b0fc494fSSteven Rostedt 
8380a32c7765SLi Zefan 	if (ret || !write || (last_ftrace_enabled == !!ftrace_enabled))
8381b0fc494fSSteven Rostedt 		goto out;
8382b0fc494fSSteven Rostedt 
8383b0fc494fSSteven Rostedt 	if (ftrace_enabled) {
8384b0fc494fSSteven Rostedt 
8385b0fc494fSSteven Rostedt 		/* we are starting ftrace again */
8386f86f4180SChunyan Zhang 		if (rcu_dereference_protected(ftrace_ops_list,
8387f86f4180SChunyan Zhang 			lockdep_is_held(&ftrace_lock)) != &ftrace_list_end)
83885000c418SJan Kiszka 			update_ftrace_function();
8389b0fc494fSSteven Rostedt 
8390524a3868SSteven Rostedt (Red Hat) 		ftrace_startup_sysctl();
8391524a3868SSteven Rostedt (Red Hat) 
8392b0fc494fSSteven Rostedt 	} else {
83937162431dSMiroslav Benes 		if (is_permanent_ops_registered()) {
83947162431dSMiroslav Benes 			ftrace_enabled = true;
83957162431dSMiroslav Benes 			ret = -EBUSY;
83967162431dSMiroslav Benes 			goto out;
83977162431dSMiroslav Benes 		}
83987162431dSMiroslav Benes 
8399b0fc494fSSteven Rostedt 		/* stopping ftrace calls (just send to ftrace_stub) */
8400b0fc494fSSteven Rostedt 		ftrace_trace_function = ftrace_stub;
8401b0fc494fSSteven Rostedt 
8402b0fc494fSSteven Rostedt 		ftrace_shutdown_sysctl();
8403b0fc494fSSteven Rostedt 	}
8404b0fc494fSSteven Rostedt 
84057162431dSMiroslav Benes 	last_ftrace_enabled = !!ftrace_enabled;
8406b0fc494fSSteven Rostedt  out:
8407e6ea44e9SSteven Rostedt 	mutex_unlock(&ftrace_lock);
84083d083395SSteven Rostedt 	return ret;
840916444a8aSArnaldo Carvalho de Melo }
84108e4e83b2SWei Xiao 
84118e4e83b2SWei Xiao static struct ctl_table ftrace_sysctls[] = {
84128e4e83b2SWei Xiao 	{
84138e4e83b2SWei Xiao 		.procname       = "ftrace_enabled",
84148e4e83b2SWei Xiao 		.data           = &ftrace_enabled,
84158e4e83b2SWei Xiao 		.maxlen         = sizeof(int),
84168e4e83b2SWei Xiao 		.mode           = 0644,
84178e4e83b2SWei Xiao 		.proc_handler   = ftrace_enable_sysctl,
84188e4e83b2SWei Xiao 	},
84198e4e83b2SWei Xiao 	{}
84208e4e83b2SWei Xiao };
84218e4e83b2SWei Xiao 
84228e4e83b2SWei Xiao static int __init ftrace_sysctl_init(void)
84238e4e83b2SWei Xiao {
84248e4e83b2SWei Xiao 	register_sysctl_init("kernel", ftrace_sysctls);
84258e4e83b2SWei Xiao 	return 0;
84268e4e83b2SWei Xiao }
84278e4e83b2SWei Xiao late_initcall(ftrace_sysctl_init);
84288e4e83b2SWei Xiao #endif
8429