xref: /linux-6.15/kernel/trace/ftrace.c (revision bcea02b0)
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) {
2490d19ad077SSteven Rostedt (VMware) 	struct pt_regs *regs = ftrace_get_regs(fregs);
2491763e34e7SSteven Rostedt (VMware) 	unsigned long addr;
2492763e34e7SSteven Rostedt (VMware) 
2493ff205766SAlexei Starovoitov 	addr = ftrace_find_rec_direct(ip);
2494763e34e7SSteven Rostedt (VMware) 	if (!addr)
2495763e34e7SSteven Rostedt (VMware) 		return;
2496763e34e7SSteven Rostedt (VMware) 
2497763e34e7SSteven Rostedt (VMware) 	arch_ftrace_set_direct_caller(regs, addr);
2498763e34e7SSteven Rostedt (VMware) }
2499763e34e7SSteven Rostedt (VMware) 
2500763e34e7SSteven Rostedt (VMware) struct ftrace_ops direct_ops = {
2501763e34e7SSteven Rostedt (VMware) 	.func		= call_direct_funcs,
250253cd885bSSong Liu 	.flags		= FTRACE_OPS_FL_DIRECT | FTRACE_OPS_FL_SAVE_REGS
2503763e34e7SSteven Rostedt (VMware) 			  | FTRACE_OPS_FL_PERMANENT,
25045da7cd11SSteven Rostedt (VMware) 	/*
25055da7cd11SSteven Rostedt (VMware) 	 * By declaring the main trampoline as this trampoline
25065da7cd11SSteven Rostedt (VMware) 	 * it will never have one allocated for it. Allocated
25075da7cd11SSteven Rostedt (VMware) 	 * trampolines should not call direct functions.
25085da7cd11SSteven Rostedt (VMware) 	 * The direct_ops should only be called by the builtin
25095da7cd11SSteven Rostedt (VMware) 	 * ftrace_regs_caller trampoline.
25105da7cd11SSteven Rostedt (VMware) 	 */
25115da7cd11SSteven Rostedt (VMware) 	.trampoline	= FTRACE_REGS_ADDR,
2512763e34e7SSteven Rostedt (VMware) };
2513763e34e7SSteven Rostedt (VMware) #endif /* CONFIG_DYNAMIC_FTRACE_WITH_DIRECT_CALLS */
2514763e34e7SSteven Rostedt (VMware) 
25157413af1fSSteven Rostedt (Red Hat) /**
25167413af1fSSteven Rostedt (Red Hat)  * ftrace_get_addr_new - Get the call address to set to
25177413af1fSSteven Rostedt (Red Hat)  * @rec:  The ftrace record descriptor
25187413af1fSSteven Rostedt (Red Hat)  *
25197413af1fSSteven Rostedt (Red Hat)  * If the record has the FTRACE_FL_REGS set, that means that it
25207413af1fSSteven Rostedt (Red Hat)  * wants to convert to a callback that saves all regs. If FTRACE_FL_REGS
25215c8c206eSRandy Dunlap  * is not set, then it wants to convert to the normal callback.
25227413af1fSSteven Rostedt (Red Hat)  *
25237413af1fSSteven Rostedt (Red Hat)  * Returns the address of the trampoline to set to
25247413af1fSSteven Rostedt (Red Hat)  */
25257413af1fSSteven Rostedt (Red Hat) unsigned long ftrace_get_addr_new(struct dyn_ftrace *rec)
25267413af1fSSteven Rostedt (Red Hat) {
252779922b80SSteven Rostedt (Red Hat) 	struct ftrace_ops *ops;
2528763e34e7SSteven Rostedt (VMware) 	unsigned long addr;
2529763e34e7SSteven Rostedt (VMware) 
2530763e34e7SSteven Rostedt (VMware) 	if ((rec->flags & FTRACE_FL_DIRECT) &&
2531763e34e7SSteven Rostedt (VMware) 	    (ftrace_rec_count(rec) == 1)) {
2532ff205766SAlexei Starovoitov 		addr = ftrace_find_rec_direct(rec->ip);
2533763e34e7SSteven Rostedt (VMware) 		if (addr)
2534763e34e7SSteven Rostedt (VMware) 			return addr;
2535763e34e7SSteven Rostedt (VMware) 		WARN_ON_ONCE(1);
2536763e34e7SSteven Rostedt (VMware) 	}
253779922b80SSteven Rostedt (Red Hat) 
253879922b80SSteven Rostedt (Red Hat) 	/* Trampolines take precedence over regs */
253979922b80SSteven Rostedt (Red Hat) 	if (rec->flags & FTRACE_FL_TRAMP) {
254079922b80SSteven Rostedt (Red Hat) 		ops = ftrace_find_tramp_ops_new(rec);
254179922b80SSteven Rostedt (Red Hat) 		if (FTRACE_WARN_ON(!ops || !ops->trampoline)) {
2542bce0b6c5SSteven Rostedt (Red Hat) 			pr_warn("Bad trampoline accounting at: %p (%pS) (%lx)\n",
2543bce0b6c5SSteven Rostedt (Red Hat) 				(void *)rec->ip, (void *)rec->ip, rec->flags);
254479922b80SSteven Rostedt (Red Hat) 			/* Ftrace is shutting down, return anything */
254579922b80SSteven Rostedt (Red Hat) 			return (unsigned long)FTRACE_ADDR;
254679922b80SSteven Rostedt (Red Hat) 		}
254779922b80SSteven Rostedt (Red Hat) 		return ops->trampoline;
254879922b80SSteven Rostedt (Red Hat) 	}
254979922b80SSteven Rostedt (Red Hat) 
25507413af1fSSteven Rostedt (Red Hat) 	if (rec->flags & FTRACE_FL_REGS)
25517413af1fSSteven Rostedt (Red Hat) 		return (unsigned long)FTRACE_REGS_ADDR;
25527413af1fSSteven Rostedt (Red Hat) 	else
25537413af1fSSteven Rostedt (Red Hat) 		return (unsigned long)FTRACE_ADDR;
25547413af1fSSteven Rostedt (Red Hat) }
25557413af1fSSteven Rostedt (Red Hat) 
25567413af1fSSteven Rostedt (Red Hat) /**
25577413af1fSSteven Rostedt (Red Hat)  * ftrace_get_addr_curr - Get the call address that is already there
25587413af1fSSteven Rostedt (Red Hat)  * @rec:  The ftrace record descriptor
25597413af1fSSteven Rostedt (Red Hat)  *
25607413af1fSSteven Rostedt (Red Hat)  * The FTRACE_FL_REGS_EN is set when the record already points to
25617413af1fSSteven Rostedt (Red Hat)  * a function that saves all the regs. Basically the '_EN' version
25627413af1fSSteven Rostedt (Red Hat)  * represents the current state of the function.
25637413af1fSSteven Rostedt (Red Hat)  *
25647413af1fSSteven Rostedt (Red Hat)  * Returns the address of the trampoline that is currently being called
25657413af1fSSteven Rostedt (Red Hat)  */
25667413af1fSSteven Rostedt (Red Hat) unsigned long ftrace_get_addr_curr(struct dyn_ftrace *rec)
25677413af1fSSteven Rostedt (Red Hat) {
256879922b80SSteven Rostedt (Red Hat) 	struct ftrace_ops *ops;
2569763e34e7SSteven Rostedt (VMware) 	unsigned long addr;
2570763e34e7SSteven Rostedt (VMware) 
2571763e34e7SSteven Rostedt (VMware) 	/* Direct calls take precedence over trampolines */
2572763e34e7SSteven Rostedt (VMware) 	if (rec->flags & FTRACE_FL_DIRECT_EN) {
2573ff205766SAlexei Starovoitov 		addr = ftrace_find_rec_direct(rec->ip);
2574763e34e7SSteven Rostedt (VMware) 		if (addr)
2575763e34e7SSteven Rostedt (VMware) 			return addr;
2576763e34e7SSteven Rostedt (VMware) 		WARN_ON_ONCE(1);
2577763e34e7SSteven Rostedt (VMware) 	}
257879922b80SSteven Rostedt (Red Hat) 
257979922b80SSteven Rostedt (Red Hat) 	/* Trampolines take precedence over regs */
258079922b80SSteven Rostedt (Red Hat) 	if (rec->flags & FTRACE_FL_TRAMP_EN) {
258179922b80SSteven Rostedt (Red Hat) 		ops = ftrace_find_tramp_ops_curr(rec);
258279922b80SSteven Rostedt (Red Hat) 		if (FTRACE_WARN_ON(!ops)) {
2583a395d6a7SJoe Perches 			pr_warn("Bad trampoline accounting at: %p (%pS)\n",
258479922b80SSteven Rostedt (Red Hat) 				(void *)rec->ip, (void *)rec->ip);
258579922b80SSteven Rostedt (Red Hat) 			/* Ftrace is shutting down, return anything */
258679922b80SSteven Rostedt (Red Hat) 			return (unsigned long)FTRACE_ADDR;
258779922b80SSteven Rostedt (Red Hat) 		}
258879922b80SSteven Rostedt (Red Hat) 		return ops->trampoline;
258979922b80SSteven Rostedt (Red Hat) 	}
259079922b80SSteven Rostedt (Red Hat) 
25917413af1fSSteven Rostedt (Red Hat) 	if (rec->flags & FTRACE_FL_REGS_EN)
25927413af1fSSteven Rostedt (Red Hat) 		return (unsigned long)FTRACE_REGS_ADDR;
25937413af1fSSteven Rostedt (Red Hat) 	else
25947413af1fSSteven Rostedt (Red Hat) 		return (unsigned long)FTRACE_ADDR;
25957413af1fSSteven Rostedt (Red Hat) }
25967413af1fSSteven Rostedt (Red Hat) 
2597c88fd863SSteven Rostedt static int
25987375dca1SSteven Rostedt (VMware) __ftrace_replace_code(struct dyn_ftrace *rec, bool enable)
2599c88fd863SSteven Rostedt {
260008f6fba5SSteven Rostedt 	unsigned long ftrace_old_addr;
2601c88fd863SSteven Rostedt 	unsigned long ftrace_addr;
2602c88fd863SSteven Rostedt 	int ret;
2603c88fd863SSteven Rostedt 
26047c0868e0SSteven Rostedt (Red Hat) 	ftrace_addr = ftrace_get_addr_new(rec);
2605c88fd863SSteven Rostedt 
26067c0868e0SSteven Rostedt (Red Hat) 	/* This needs to be done before we call ftrace_update_record */
26077c0868e0SSteven Rostedt (Red Hat) 	ftrace_old_addr = ftrace_get_addr_curr(rec);
26087c0868e0SSteven Rostedt (Red Hat) 
26097c0868e0SSteven Rostedt (Red Hat) 	ret = ftrace_update_record(rec, enable);
261008f6fba5SSteven Rostedt 
261102a392a0SSteven Rostedt (Red Hat) 	ftrace_bug_type = FTRACE_BUG_UNKNOWN;
261202a392a0SSteven Rostedt (Red Hat) 
2613c88fd863SSteven Rostedt 	switch (ret) {
2614c88fd863SSteven Rostedt 	case FTRACE_UPDATE_IGNORE:
2615c88fd863SSteven Rostedt 		return 0;
2616c88fd863SSteven Rostedt 
2617c88fd863SSteven Rostedt 	case FTRACE_UPDATE_MAKE_CALL:
261802a392a0SSteven Rostedt (Red Hat) 		ftrace_bug_type = FTRACE_BUG_CALL;
2619c88fd863SSteven Rostedt 		return ftrace_make_call(rec, ftrace_addr);
2620c88fd863SSteven Rostedt 
2621c88fd863SSteven Rostedt 	case FTRACE_UPDATE_MAKE_NOP:
262202a392a0SSteven Rostedt (Red Hat) 		ftrace_bug_type = FTRACE_BUG_NOP;
262339b5552cSSteven Rostedt (Red Hat) 		return ftrace_make_nop(NULL, rec, ftrace_old_addr);
262408f6fba5SSteven Rostedt 
262508f6fba5SSteven Rostedt 	case FTRACE_UPDATE_MODIFY_CALL:
262602a392a0SSteven Rostedt (Red Hat) 		ftrace_bug_type = FTRACE_BUG_UPDATE;
262708f6fba5SSteven Rostedt 		return ftrace_modify_call(rec, ftrace_old_addr, ftrace_addr);
26283d083395SSteven Rostedt 	}
26293d083395SSteven Rostedt 
26309efb85c5SHariprasad Kelam 	return -1; /* unknown ftrace bug */
2631c88fd863SSteven Rostedt }
2632c88fd863SSteven Rostedt 
2633a0572f68SSteven Rostedt (VMware) void __weak ftrace_replace_code(int mod_flags)
26343d083395SSteven Rostedt {
26353d083395SSteven Rostedt 	struct dyn_ftrace *rec;
26363d083395SSteven Rostedt 	struct ftrace_page *pg;
26377375dca1SSteven Rostedt (VMware) 	bool enable = mod_flags & FTRACE_MODIFY_ENABLE_FL;
2638a0572f68SSteven Rostedt (VMware) 	int schedulable = mod_flags & FTRACE_MODIFY_MAY_SLEEP_FL;
26396a24a244SSteven Rostedt 	int failed;
26403d083395SSteven Rostedt 
264145a4a237SSteven Rostedt 	if (unlikely(ftrace_disabled))
264245a4a237SSteven Rostedt 		return;
264345a4a237SSteven Rostedt 
2644265c831cSSteven Rostedt 	do_for_each_ftrace_rec(pg, rec) {
2645546fece4SSteven Rostedt (Red Hat) 
2646cf04f2d5SSteven Rostedt (Google) 		if (skip_record(rec))
2647546fece4SSteven Rostedt (Red Hat) 			continue;
2648546fece4SSteven Rostedt (Red Hat) 
2649e4f5d544SSteven Rostedt 		failed = __ftrace_replace_code(rec, enable);
2650fa9d13cfSZhaolei 		if (failed) {
26514fd3279bSSteven Rostedt (Red Hat) 			ftrace_bug(failed, rec);
26524377245aSSteven Rostedt 			/* Stop processing */
26534377245aSSteven Rostedt 			return;
26544377245aSSteven Rostedt 		}
2655a0572f68SSteven Rostedt (VMware) 		if (schedulable)
2656a0572f68SSteven Rostedt (VMware) 			cond_resched();
2657265c831cSSteven Rostedt 	} while_for_each_ftrace_rec();
26583d083395SSteven Rostedt }
26593c1720f0SSteven Rostedt 
2660c88fd863SSteven Rostedt struct ftrace_rec_iter {
2661c88fd863SSteven Rostedt 	struct ftrace_page	*pg;
2662c88fd863SSteven Rostedt 	int			index;
2663c88fd863SSteven Rostedt };
2664c88fd863SSteven Rostedt 
2665c88fd863SSteven Rostedt /**
26666130722fSSteven Rostedt (VMware)  * ftrace_rec_iter_start - start up iterating over traced functions
2667c88fd863SSteven Rostedt  *
2668c88fd863SSteven Rostedt  * Returns an iterator handle that is used to iterate over all
2669c88fd863SSteven Rostedt  * the records that represent address locations where functions
2670c88fd863SSteven Rostedt  * are traced.
2671c88fd863SSteven Rostedt  *
2672c88fd863SSteven Rostedt  * May return NULL if no records are available.
2673c88fd863SSteven Rostedt  */
2674c88fd863SSteven Rostedt struct ftrace_rec_iter *ftrace_rec_iter_start(void)
2675c88fd863SSteven Rostedt {
2676c88fd863SSteven Rostedt 	/*
2677c88fd863SSteven Rostedt 	 * We only use a single iterator.
2678c88fd863SSteven Rostedt 	 * Protected by the ftrace_lock mutex.
2679c88fd863SSteven Rostedt 	 */
2680c88fd863SSteven Rostedt 	static struct ftrace_rec_iter ftrace_rec_iter;
2681c88fd863SSteven Rostedt 	struct ftrace_rec_iter *iter = &ftrace_rec_iter;
2682c88fd863SSteven Rostedt 
2683c88fd863SSteven Rostedt 	iter->pg = ftrace_pages_start;
2684c88fd863SSteven Rostedt 	iter->index = 0;
2685c88fd863SSteven Rostedt 
2686c88fd863SSteven Rostedt 	/* Could have empty pages */
2687c88fd863SSteven Rostedt 	while (iter->pg && !iter->pg->index)
2688c88fd863SSteven Rostedt 		iter->pg = iter->pg->next;
2689c88fd863SSteven Rostedt 
2690c88fd863SSteven Rostedt 	if (!iter->pg)
2691c88fd863SSteven Rostedt 		return NULL;
2692c88fd863SSteven Rostedt 
2693c88fd863SSteven Rostedt 	return iter;
2694c88fd863SSteven Rostedt }
2695c88fd863SSteven Rostedt 
2696c88fd863SSteven Rostedt /**
26976130722fSSteven Rostedt (VMware)  * ftrace_rec_iter_next - get the next record to process.
2698c88fd863SSteven Rostedt  * @iter: The handle to the iterator.
2699c88fd863SSteven Rostedt  *
2700c88fd863SSteven Rostedt  * Returns the next iterator after the given iterator @iter.
2701c88fd863SSteven Rostedt  */
2702c88fd863SSteven Rostedt struct ftrace_rec_iter *ftrace_rec_iter_next(struct ftrace_rec_iter *iter)
2703c88fd863SSteven Rostedt {
2704c88fd863SSteven Rostedt 	iter->index++;
2705c88fd863SSteven Rostedt 
2706c88fd863SSteven Rostedt 	if (iter->index >= iter->pg->index) {
2707c88fd863SSteven Rostedt 		iter->pg = iter->pg->next;
2708c88fd863SSteven Rostedt 		iter->index = 0;
2709c88fd863SSteven Rostedt 
2710c88fd863SSteven Rostedt 		/* Could have empty pages */
2711c88fd863SSteven Rostedt 		while (iter->pg && !iter->pg->index)
2712c88fd863SSteven Rostedt 			iter->pg = iter->pg->next;
2713c88fd863SSteven Rostedt 	}
2714c88fd863SSteven Rostedt 
2715c88fd863SSteven Rostedt 	if (!iter->pg)
2716c88fd863SSteven Rostedt 		return NULL;
2717c88fd863SSteven Rostedt 
2718c88fd863SSteven Rostedt 	return iter;
2719c88fd863SSteven Rostedt }
2720c88fd863SSteven Rostedt 
2721c88fd863SSteven Rostedt /**
27226130722fSSteven Rostedt (VMware)  * ftrace_rec_iter_record - get the record at the iterator location
2723c88fd863SSteven Rostedt  * @iter: The current iterator location
2724c88fd863SSteven Rostedt  *
2725c88fd863SSteven Rostedt  * Returns the record that the current @iter is at.
2726c88fd863SSteven Rostedt  */
2727c88fd863SSteven Rostedt struct dyn_ftrace *ftrace_rec_iter_record(struct ftrace_rec_iter *iter)
2728c88fd863SSteven Rostedt {
2729c88fd863SSteven Rostedt 	return &iter->pg->records[iter->index];
2730c88fd863SSteven Rostedt }
2731c88fd863SSteven Rostedt 
27323b47bfc1SSteven Rostedt static int
2733fbf6c73cSMark Rutland ftrace_nop_initialize(struct module *mod, struct dyn_ftrace *rec)
27343c1720f0SSteven Rostedt {
2735492a7ea5SAbhishek Sagar 	int ret;
273637ad5084SSteven Rostedt 
273745a4a237SSteven Rostedt 	if (unlikely(ftrace_disabled))
273845a4a237SSteven Rostedt 		return 0;
273945a4a237SSteven Rostedt 
2740fbf6c73cSMark Rutland 	ret = ftrace_init_nop(mod, rec);
27413d083395SSteven Rostedt 	if (ret) {
274202a392a0SSteven Rostedt (Red Hat) 		ftrace_bug_type = FTRACE_BUG_INIT;
27434fd3279bSSteven Rostedt (Red Hat) 		ftrace_bug(ret, rec);
27443d083395SSteven Rostedt 		return 0;
2745d61f82d0SSteven Rostedt 	}
2746d61f82d0SSteven Rostedt 	return 1;
27473d083395SSteven Rostedt }
27483d083395SSteven Rostedt 
2749000ab691SSteven Rostedt /*
2750000ab691SSteven Rostedt  * archs can override this function if they must do something
2751000ab691SSteven Rostedt  * before the modifying code is performed.
2752000ab691SSteven Rostedt  */
27533a2bfec0SLi kunyu void __weak ftrace_arch_code_modify_prepare(void)
2754000ab691SSteven Rostedt {
2755000ab691SSteven Rostedt }
2756000ab691SSteven Rostedt 
2757000ab691SSteven Rostedt /*
2758000ab691SSteven Rostedt  * archs can override this function if they must do something
2759000ab691SSteven Rostedt  * after the modifying code is performed.
2760000ab691SSteven Rostedt  */
27613a2bfec0SLi kunyu void __weak ftrace_arch_code_modify_post_process(void)
2762000ab691SSteven Rostedt {
2763000ab691SSteven Rostedt }
2764000ab691SSteven Rostedt 
27658ed3e2cfSSteven Rostedt void ftrace_modify_all_code(int command)
27668ed3e2cfSSteven Rostedt {
276759338f75SSteven Rostedt (Red Hat) 	int update = command & FTRACE_UPDATE_TRACE_FUNC;
2768a0572f68SSteven Rostedt (VMware) 	int mod_flags = 0;
2769cd21067fSPetr Mladek 	int err = 0;
277059338f75SSteven Rostedt (Red Hat) 
2771a0572f68SSteven Rostedt (VMware) 	if (command & FTRACE_MAY_SLEEP)
2772a0572f68SSteven Rostedt (VMware) 		mod_flags = FTRACE_MODIFY_MAY_SLEEP_FL;
2773a0572f68SSteven Rostedt (VMware) 
277459338f75SSteven Rostedt (Red Hat) 	/*
277559338f75SSteven Rostedt (Red Hat) 	 * If the ftrace_caller calls a ftrace_ops func directly,
277659338f75SSteven Rostedt (Red Hat) 	 * we need to make sure that it only traces functions it
277759338f75SSteven Rostedt (Red Hat) 	 * expects to trace. When doing the switch of functions,
277859338f75SSteven Rostedt (Red Hat) 	 * we need to update to the ftrace_ops_list_func first
277959338f75SSteven Rostedt (Red Hat) 	 * before the transition between old and new calls are set,
278059338f75SSteven Rostedt (Red Hat) 	 * as the ftrace_ops_list_func will check the ops hashes
278159338f75SSteven Rostedt (Red Hat) 	 * to make sure the ops are having the right functions
278259338f75SSteven Rostedt (Red Hat) 	 * traced.
278359338f75SSteven Rostedt (Red Hat) 	 */
2784cd21067fSPetr Mladek 	if (update) {
2785cd21067fSPetr Mladek 		err = ftrace_update_ftrace_func(ftrace_ops_list_func);
2786cd21067fSPetr Mladek 		if (FTRACE_WARN_ON(err))
2787cd21067fSPetr Mladek 			return;
2788cd21067fSPetr Mladek 	}
278959338f75SSteven Rostedt (Red Hat) 
27908ed3e2cfSSteven Rostedt 	if (command & FTRACE_UPDATE_CALLS)
2791a0572f68SSteven Rostedt (VMware) 		ftrace_replace_code(mod_flags | FTRACE_MODIFY_ENABLE_FL);
27928ed3e2cfSSteven Rostedt 	else if (command & FTRACE_DISABLE_CALLS)
2793a0572f68SSteven Rostedt (VMware) 		ftrace_replace_code(mod_flags);
27948ed3e2cfSSteven Rostedt 
2795405e1d83SSteven Rostedt (Red Hat) 	if (update && ftrace_trace_function != ftrace_ops_list_func) {
2796405e1d83SSteven Rostedt (Red Hat) 		function_trace_op = set_function_trace_op;
2797405e1d83SSteven Rostedt (Red Hat) 		smp_wmb();
2798405e1d83SSteven Rostedt (Red Hat) 		/* If irqs are disabled, we are in stop machine */
2799405e1d83SSteven Rostedt (Red Hat) 		if (!irqs_disabled())
2800405e1d83SSteven Rostedt (Red Hat) 			smp_call_function(ftrace_sync_ipi, NULL, 1);
2801cd21067fSPetr Mladek 		err = ftrace_update_ftrace_func(ftrace_trace_function);
2802cd21067fSPetr Mladek 		if (FTRACE_WARN_ON(err))
2803cd21067fSPetr Mladek 			return;
2804405e1d83SSteven Rostedt (Red Hat) 	}
28058ed3e2cfSSteven Rostedt 
28068ed3e2cfSSteven Rostedt 	if (command & FTRACE_START_FUNC_RET)
2807cd21067fSPetr Mladek 		err = ftrace_enable_ftrace_graph_caller();
28088ed3e2cfSSteven Rostedt 	else if (command & FTRACE_STOP_FUNC_RET)
2809cd21067fSPetr Mladek 		err = ftrace_disable_ftrace_graph_caller();
2810cd21067fSPetr Mladek 	FTRACE_WARN_ON(err);
28118ed3e2cfSSteven Rostedt }
28128ed3e2cfSSteven Rostedt 
28133d083395SSteven Rostedt static int __ftrace_modify_code(void *data)
28143d083395SSteven Rostedt {
28153d083395SSteven Rostedt 	int *command = data;
28163d083395SSteven Rostedt 
28178ed3e2cfSSteven Rostedt 	ftrace_modify_all_code(*command);
28185a45cfe1SSteven Rostedt 
2819c88fd863SSteven Rostedt 	return 0;
2820c88fd863SSteven Rostedt }
2821c88fd863SSteven Rostedt 
2822c88fd863SSteven Rostedt /**
28236130722fSSteven Rostedt (VMware)  * ftrace_run_stop_machine - go back to the stop machine method
2824c88fd863SSteven Rostedt  * @command: The command to tell ftrace what to do
2825c88fd863SSteven Rostedt  *
2826c88fd863SSteven Rostedt  * If an arch needs to fall back to the stop machine method, the
2827c88fd863SSteven Rostedt  * it can call this function.
2828c88fd863SSteven Rostedt  */
2829c88fd863SSteven Rostedt void ftrace_run_stop_machine(int command)
2830c88fd863SSteven Rostedt {
2831c88fd863SSteven Rostedt 	stop_machine(__ftrace_modify_code, &command, NULL);
2832c88fd863SSteven Rostedt }
2833c88fd863SSteven Rostedt 
2834c88fd863SSteven Rostedt /**
28356130722fSSteven Rostedt (VMware)  * arch_ftrace_update_code - modify the code to trace or not trace
2836c88fd863SSteven Rostedt  * @command: The command that needs to be done
2837c88fd863SSteven Rostedt  *
2838c88fd863SSteven Rostedt  * Archs can override this function if it does not need to
2839c88fd863SSteven Rostedt  * run stop_machine() to modify code.
2840c88fd863SSteven Rostedt  */
2841c88fd863SSteven Rostedt void __weak arch_ftrace_update_code(int command)
2842c88fd863SSteven Rostedt {
2843c88fd863SSteven Rostedt 	ftrace_run_stop_machine(command);
2844c88fd863SSteven Rostedt }
2845c88fd863SSteven Rostedt 
2846c88fd863SSteven Rostedt static void ftrace_run_update_code(int command)
2847c88fd863SSteven Rostedt {
28483a2bfec0SLi kunyu 	ftrace_arch_code_modify_prepare();
2849c88fd863SSteven Rostedt 
2850c88fd863SSteven Rostedt 	/*
2851c88fd863SSteven Rostedt 	 * By default we use stop_machine() to modify the code.
2852c88fd863SSteven Rostedt 	 * But archs can do what ever they want as long as it
2853c88fd863SSteven Rostedt 	 * is safe. The stop_machine() is the safest, but also
2854c88fd863SSteven Rostedt 	 * produces the most overhead.
2855c88fd863SSteven Rostedt 	 */
2856c88fd863SSteven Rostedt 	arch_ftrace_update_code(command);
2857c88fd863SSteven Rostedt 
28583a2bfec0SLi kunyu 	ftrace_arch_code_modify_post_process();
28593d083395SSteven Rostedt }
28603d083395SSteven Rostedt 
28618252ecf3SSteven Rostedt (Red Hat) static void ftrace_run_modify_code(struct ftrace_ops *ops, int command,
28627485058eSSteven Rostedt (Red Hat) 				   struct ftrace_ops_hash *old_hash)
2863e1effa01SSteven Rostedt (Red Hat) {
2864e1effa01SSteven Rostedt (Red Hat) 	ops->flags |= FTRACE_OPS_FL_MODIFYING;
28657485058eSSteven Rostedt (Red Hat) 	ops->old_hash.filter_hash = old_hash->filter_hash;
28667485058eSSteven Rostedt (Red Hat) 	ops->old_hash.notrace_hash = old_hash->notrace_hash;
2867e1effa01SSteven Rostedt (Red Hat) 	ftrace_run_update_code(command);
28688252ecf3SSteven Rostedt (Red Hat) 	ops->old_hash.filter_hash = NULL;
28697485058eSSteven Rostedt (Red Hat) 	ops->old_hash.notrace_hash = NULL;
2870e1effa01SSteven Rostedt (Red Hat) 	ops->flags &= ~FTRACE_OPS_FL_MODIFYING;
2871e1effa01SSteven Rostedt (Red Hat) }
2872e1effa01SSteven Rostedt (Red Hat) 
28733d083395SSteven Rostedt static ftrace_func_t saved_ftrace_func;
287460a7ecf4SSteven Rostedt static int ftrace_start_up;
2875df4fc315SSteven Rostedt 
287612cce594SSteven Rostedt (Red Hat) void __weak arch_ftrace_trampoline_free(struct ftrace_ops *ops)
287712cce594SSteven Rostedt (Red Hat) {
287812cce594SSteven Rostedt (Red Hat) }
287912cce594SSteven Rostedt (Red Hat) 
2880fc0ea795SAdrian Hunter /* List of trace_ops that have allocated trampolines */
2881fc0ea795SAdrian Hunter static LIST_HEAD(ftrace_ops_trampoline_list);
2882fc0ea795SAdrian Hunter 
2883fc0ea795SAdrian Hunter static void ftrace_add_trampoline_to_kallsyms(struct ftrace_ops *ops)
2884fc0ea795SAdrian Hunter {
2885fc0ea795SAdrian Hunter 	lockdep_assert_held(&ftrace_lock);
2886fc0ea795SAdrian Hunter 	list_add_rcu(&ops->list, &ftrace_ops_trampoline_list);
2887fc0ea795SAdrian Hunter }
2888fc0ea795SAdrian Hunter 
2889fc0ea795SAdrian Hunter static void ftrace_remove_trampoline_from_kallsyms(struct ftrace_ops *ops)
2890fc0ea795SAdrian Hunter {
2891fc0ea795SAdrian Hunter 	lockdep_assert_held(&ftrace_lock);
2892fc0ea795SAdrian Hunter 	list_del_rcu(&ops->list);
2893478ece95SAdrian Hunter 	synchronize_rcu();
2894fc0ea795SAdrian Hunter }
2895fc0ea795SAdrian Hunter 
2896fc0ea795SAdrian Hunter /*
2897fc0ea795SAdrian Hunter  * "__builtin__ftrace" is used as a module name in /proc/kallsyms for symbols
2898fc0ea795SAdrian Hunter  * for pages allocated for ftrace purposes, even though "__builtin__ftrace" is
2899fc0ea795SAdrian Hunter  * not a module.
2900fc0ea795SAdrian Hunter  */
2901fc0ea795SAdrian Hunter #define FTRACE_TRAMPOLINE_MOD "__builtin__ftrace"
2902fc0ea795SAdrian Hunter #define FTRACE_TRAMPOLINE_SYM "ftrace_trampoline"
2903fc0ea795SAdrian Hunter 
2904fc0ea795SAdrian Hunter static void ftrace_trampoline_free(struct ftrace_ops *ops)
2905fc0ea795SAdrian Hunter {
2906fc0ea795SAdrian Hunter 	if (ops && (ops->flags & FTRACE_OPS_FL_ALLOC_TRAMP) &&
2907dd9ddf46SAdrian Hunter 	    ops->trampoline) {
2908548e1f6cSAdrian Hunter 		/*
2909548e1f6cSAdrian Hunter 		 * Record the text poke event before the ksymbol unregister
2910548e1f6cSAdrian Hunter 		 * event.
2911548e1f6cSAdrian Hunter 		 */
2912548e1f6cSAdrian Hunter 		perf_event_text_poke((void *)ops->trampoline,
2913548e1f6cSAdrian Hunter 				     (void *)ops->trampoline,
2914548e1f6cSAdrian Hunter 				     ops->trampoline_size, NULL, 0);
2915dd9ddf46SAdrian Hunter 		perf_event_ksymbol(PERF_RECORD_KSYMBOL_TYPE_OOL,
2916dd9ddf46SAdrian Hunter 				   ops->trampoline, ops->trampoline_size,
2917dd9ddf46SAdrian Hunter 				   true, FTRACE_TRAMPOLINE_SYM);
2918dd9ddf46SAdrian Hunter 		/* Remove from kallsyms after the perf events */
2919fc0ea795SAdrian Hunter 		ftrace_remove_trampoline_from_kallsyms(ops);
2920dd9ddf46SAdrian Hunter 	}
2921fc0ea795SAdrian Hunter 
2922fc0ea795SAdrian Hunter 	arch_ftrace_trampoline_free(ops);
2923fc0ea795SAdrian Hunter }
2924fc0ea795SAdrian Hunter 
2925df4fc315SSteven Rostedt static void ftrace_startup_enable(int command)
2926df4fc315SSteven Rostedt {
2927df4fc315SSteven Rostedt 	if (saved_ftrace_func != ftrace_trace_function) {
2928df4fc315SSteven Rostedt 		saved_ftrace_func = ftrace_trace_function;
2929df4fc315SSteven Rostedt 		command |= FTRACE_UPDATE_TRACE_FUNC;
2930df4fc315SSteven Rostedt 	}
2931df4fc315SSteven Rostedt 
2932df4fc315SSteven Rostedt 	if (!command || !ftrace_enabled)
2933df4fc315SSteven Rostedt 		return;
2934df4fc315SSteven Rostedt 
2935df4fc315SSteven Rostedt 	ftrace_run_update_code(command);
2936df4fc315SSteven Rostedt }
29373d083395SSteven Rostedt 
2938e1effa01SSteven Rostedt (Red Hat) static void ftrace_startup_all(int command)
2939e1effa01SSteven Rostedt (Red Hat) {
2940e1effa01SSteven Rostedt (Red Hat) 	update_all_ops = true;
2941e1effa01SSteven Rostedt (Red Hat) 	ftrace_startup_enable(command);
2942e1effa01SSteven Rostedt (Red Hat) 	update_all_ops = false;
2943e1effa01SSteven Rostedt (Red Hat) }
2944e1effa01SSteven Rostedt (Red Hat) 
29453306fc4aSSteven Rostedt (VMware) int ftrace_startup(struct ftrace_ops *ops, int command)
29463d083395SSteven Rostedt {
29478a56d776SSteven Rostedt (Red Hat) 	int ret;
2948b848914cSSteven Rostedt 
29494eebcc81SSteven Rostedt 	if (unlikely(ftrace_disabled))
2950a1cd6173SSteven Rostedt 		return -ENODEV;
29514eebcc81SSteven Rostedt 
29528a56d776SSteven Rostedt (Red Hat) 	ret = __register_ftrace_function(ops);
29538a56d776SSteven Rostedt (Red Hat) 	if (ret)
29548a56d776SSteven Rostedt (Red Hat) 		return ret;
29558a56d776SSteven Rostedt (Red Hat) 
295660a7ecf4SSteven Rostedt 	ftrace_start_up++;
29573d083395SSteven Rostedt 
2958e1effa01SSteven Rostedt (Red Hat) 	/*
2959e1effa01SSteven Rostedt (Red Hat) 	 * Note that ftrace probes uses this to start up
2960e1effa01SSteven Rostedt (Red Hat) 	 * and modify functions it will probe. But we still
2961e1effa01SSteven Rostedt (Red Hat) 	 * set the ADDING flag for modification, as probes
2962e1effa01SSteven Rostedt (Red Hat) 	 * do not have trampolines. If they add them in the
2963e1effa01SSteven Rostedt (Red Hat) 	 * future, then the probes will need to distinguish
2964e1effa01SSteven Rostedt (Red Hat) 	 * between adding and updating probes.
2965e1effa01SSteven Rostedt (Red Hat) 	 */
2966e1effa01SSteven Rostedt (Red Hat) 	ops->flags |= FTRACE_OPS_FL_ENABLED | FTRACE_OPS_FL_ADDING;
296766209a5bSSteven Rostedt (Red Hat) 
2968f8b8be8aSMasami Hiramatsu 	ret = ftrace_hash_ipmodify_enable(ops);
2969f8b8be8aSMasami Hiramatsu 	if (ret < 0) {
2970f8b8be8aSMasami Hiramatsu 		/* Rollback registration process */
2971f8b8be8aSMasami Hiramatsu 		__unregister_ftrace_function(ops);
2972f8b8be8aSMasami Hiramatsu 		ftrace_start_up--;
2973f8b8be8aSMasami Hiramatsu 		ops->flags &= ~FTRACE_OPS_FL_ENABLED;
2974d5e47505SMiroslav Benes 		if (ops->flags & FTRACE_OPS_FL_DYNAMIC)
2975d5e47505SMiroslav Benes 			ftrace_trampoline_free(ops);
2976f8b8be8aSMasami Hiramatsu 		return ret;
2977f8b8be8aSMasami Hiramatsu 	}
2978f8b8be8aSMasami Hiramatsu 
29797f50d06bSJiri Olsa 	if (ftrace_hash_rec_enable(ops, 1))
29807f50d06bSJiri Olsa 		command |= FTRACE_UPDATE_CALLS;
2981ed926f9bSSteven Rostedt 
2982df4fc315SSteven Rostedt 	ftrace_startup_enable(command);
2983a1cd6173SSteven Rostedt 
2984c3b0f72eSYang Jihong 	/*
2985c3b0f72eSYang Jihong 	 * If ftrace is in an undefined state, we just remove ops from list
2986c3b0f72eSYang Jihong 	 * to prevent the NULL pointer, instead of totally rolling it back and
2987c3b0f72eSYang Jihong 	 * free trampoline, because those actions could cause further damage.
2988c3b0f72eSYang Jihong 	 */
2989c3b0f72eSYang Jihong 	if (unlikely(ftrace_disabled)) {
2990c3b0f72eSYang Jihong 		__unregister_ftrace_function(ops);
2991c3b0f72eSYang Jihong 		return -ENODEV;
2992c3b0f72eSYang Jihong 	}
2993c3b0f72eSYang Jihong 
2994e1effa01SSteven Rostedt (Red Hat) 	ops->flags &= ~FTRACE_OPS_FL_ADDING;
2995e1effa01SSteven Rostedt (Red Hat) 
2996a1cd6173SSteven Rostedt 	return 0;
29973d083395SSteven Rostedt }
29983d083395SSteven Rostedt 
29993306fc4aSSteven Rostedt (VMware) int ftrace_shutdown(struct ftrace_ops *ops, int command)
30003d083395SSteven Rostedt {
30018a56d776SSteven Rostedt (Red Hat) 	int ret;
3002b848914cSSteven Rostedt 
30034eebcc81SSteven Rostedt 	if (unlikely(ftrace_disabled))
30048a56d776SSteven Rostedt (Red Hat) 		return -ENODEV;
30058a56d776SSteven Rostedt (Red Hat) 
30068a56d776SSteven Rostedt (Red Hat) 	ret = __unregister_ftrace_function(ops);
30078a56d776SSteven Rostedt (Red Hat) 	if (ret)
30088a56d776SSteven Rostedt (Red Hat) 		return ret;
30094eebcc81SSteven Rostedt 
301060a7ecf4SSteven Rostedt 	ftrace_start_up--;
30119ea1a153SFrederic Weisbecker 	/*
30129ea1a153SFrederic Weisbecker 	 * Just warn in case of unbalance, no need to kill ftrace, it's not
30139ea1a153SFrederic Weisbecker 	 * critical but the ftrace_call callers may be never nopped again after
30149ea1a153SFrederic Weisbecker 	 * further ftrace uses.
30159ea1a153SFrederic Weisbecker 	 */
30169ea1a153SFrederic Weisbecker 	WARN_ON_ONCE(ftrace_start_up < 0);
30179ea1a153SFrederic Weisbecker 
3018f8b8be8aSMasami Hiramatsu 	/* Disabling ipmodify never fails */
3019f8b8be8aSMasami Hiramatsu 	ftrace_hash_ipmodify_disable(ops);
30207f50d06bSJiri Olsa 
30217f50d06bSJiri Olsa 	if (ftrace_hash_rec_disable(ops, 1))
30227f50d06bSJiri Olsa 		command |= FTRACE_UPDATE_CALLS;
3023ed926f9bSSteven Rostedt 
3024ed926f9bSSteven Rostedt 	ops->flags &= ~FTRACE_OPS_FL_ENABLED;
3025b848914cSSteven Rostedt 
3026d61f82d0SSteven Rostedt 	if (saved_ftrace_func != ftrace_trace_function) {
3027d61f82d0SSteven Rostedt 		saved_ftrace_func = ftrace_trace_function;
3028d61f82d0SSteven Rostedt 		command |= FTRACE_UPDATE_TRACE_FUNC;
3029d61f82d0SSteven Rostedt 	}
3030d61f82d0SSteven Rostedt 
30310e792b89SLi Huafei 	if (!command || !ftrace_enabled)
30320e792b89SLi Huafei 		goto out;
30333d083395SSteven Rostedt 
303479922b80SSteven Rostedt (Red Hat) 	/*
303579922b80SSteven Rostedt (Red Hat) 	 * If the ops uses a trampoline, then it needs to be
303679922b80SSteven Rostedt (Red Hat) 	 * tested first on update.
303779922b80SSteven Rostedt (Red Hat) 	 */
3038e1effa01SSteven Rostedt (Red Hat) 	ops->flags |= FTRACE_OPS_FL_REMOVING;
303979922b80SSteven Rostedt (Red Hat) 	removed_ops = ops;
304079922b80SSteven Rostedt (Red Hat) 
3041fef5aeeeSSteven Rostedt (Red Hat) 	/* The trampoline logic checks the old hashes */
3042fef5aeeeSSteven Rostedt (Red Hat) 	ops->old_hash.filter_hash = ops->func_hash->filter_hash;
3043fef5aeeeSSteven Rostedt (Red Hat) 	ops->old_hash.notrace_hash = ops->func_hash->notrace_hash;
3044fef5aeeeSSteven Rostedt (Red Hat) 
3045d61f82d0SSteven Rostedt 	ftrace_run_update_code(command);
3046a4c35ed2SSteven Rostedt (Red Hat) 
304784bde62cSSteven Rostedt (Red Hat) 	/*
304884bde62cSSteven Rostedt (Red Hat) 	 * If there's no more ops registered with ftrace, run a
304984bde62cSSteven Rostedt (Red Hat) 	 * sanity check to make sure all rec flags are cleared.
305084bde62cSSteven Rostedt (Red Hat) 	 */
3051f86f4180SChunyan Zhang 	if (rcu_dereference_protected(ftrace_ops_list,
3052f86f4180SChunyan Zhang 			lockdep_is_held(&ftrace_lock)) == &ftrace_list_end) {
305384bde62cSSteven Rostedt (Red Hat) 		struct ftrace_page *pg;
305484bde62cSSteven Rostedt (Red Hat) 		struct dyn_ftrace *rec;
305584bde62cSSteven Rostedt (Red Hat) 
305684bde62cSSteven Rostedt (Red Hat) 		do_for_each_ftrace_rec(pg, rec) {
3057977c1f9cSAlexei Starovoitov 			if (FTRACE_WARN_ON_ONCE(rec->flags & ~FTRACE_FL_DISABLED))
305884bde62cSSteven Rostedt (Red Hat) 				pr_warn("  %pS flags:%lx\n",
305984bde62cSSteven Rostedt (Red Hat) 					(void *)rec->ip, rec->flags);
306084bde62cSSteven Rostedt (Red Hat) 		} while_for_each_ftrace_rec();
306184bde62cSSteven Rostedt (Red Hat) 	}
306284bde62cSSteven Rostedt (Red Hat) 
3063fef5aeeeSSteven Rostedt (Red Hat) 	ops->old_hash.filter_hash = NULL;
3064fef5aeeeSSteven Rostedt (Red Hat) 	ops->old_hash.notrace_hash = NULL;
3065fef5aeeeSSteven Rostedt (Red Hat) 
3066fef5aeeeSSteven Rostedt (Red Hat) 	removed_ops = NULL;
3067e1effa01SSteven Rostedt (Red Hat) 	ops->flags &= ~FTRACE_OPS_FL_REMOVING;
306879922b80SSteven Rostedt (Red Hat) 
30690e792b89SLi Huafei out:
3070a4c35ed2SSteven Rostedt (Red Hat) 	/*
3071a4c35ed2SSteven Rostedt (Red Hat) 	 * Dynamic ops may be freed, we must make sure that all
3072a4c35ed2SSteven Rostedt (Red Hat) 	 * callers are done before leaving this function.
3073ba27f2bcSSteven Rostedt (Red Hat) 	 * The same goes for freeing the per_cpu data of the per_cpu
3074a4c35ed2SSteven Rostedt (Red Hat) 	 * ops.
30750598e4f0SSteven Rostedt (VMware) 	 */
3076b3a88803SPeter Zijlstra 	if (ops->flags & FTRACE_OPS_FL_DYNAMIC) {
30770598e4f0SSteven Rostedt (VMware) 		/*
3078a4c35ed2SSteven Rostedt (Red Hat) 		 * We need to do a hard force of sched synchronization.
3079a4c35ed2SSteven Rostedt (Red Hat) 		 * This is because we use preempt_disable() to do RCU, but
3080a4c35ed2SSteven Rostedt (Red Hat) 		 * the function tracers can be called where RCU is not watching
3081a4c35ed2SSteven Rostedt (Red Hat) 		 * (like before user_exit()). We can not rely on the RCU
3082a4c35ed2SSteven Rostedt (Red Hat) 		 * infrastructure to do the synchronization, thus we must do it
3083a4c35ed2SSteven Rostedt (Red Hat) 		 * ourselves.
3084a4c35ed2SSteven Rostedt (Red Hat) 		 */
3085e5a971d7SPaul E. McKenney 		synchronize_rcu_tasks_rude();
3086a4c35ed2SSteven Rostedt (Red Hat) 
30870598e4f0SSteven Rostedt (VMware) 		/*
3088fdda88d3SQiujun Huang 		 * When the kernel is preemptive, tasks can be preempted
30890598e4f0SSteven Rostedt (VMware) 		 * while on a ftrace trampoline. Just scheduling a task on
30900598e4f0SSteven Rostedt (VMware) 		 * a CPU is not good enough to flush them. Calling
3091f2cc020dSIngo Molnar 		 * synchronize_rcu_tasks() will wait for those tasks to
30920598e4f0SSteven Rostedt (VMware) 		 * execute and either schedule voluntarily or enter user space.
30930598e4f0SSteven Rostedt (VMware) 		 */
309430c93704SThomas Gleixner 		if (IS_ENABLED(CONFIG_PREEMPTION))
30950598e4f0SSteven Rostedt (VMware) 			synchronize_rcu_tasks();
30960598e4f0SSteven Rostedt (VMware) 
3097fc0ea795SAdrian Hunter 		ftrace_trampoline_free(ops);
3098a4c35ed2SSteven Rostedt (Red Hat) 	}
3099a4c35ed2SSteven Rostedt (Red Hat) 
31008a56d776SSteven Rostedt (Red Hat) 	return 0;
31013d083395SSteven Rostedt }
31023d083395SSteven Rostedt 
3103a5a1d1c2SThomas Gleixner static u64		ftrace_update_time;
31043d083395SSteven Rostedt unsigned long		ftrace_update_tot_cnt;
3105da537f0aSSteven Rostedt (VMware) unsigned long		ftrace_number_of_pages;
3106da537f0aSSteven Rostedt (VMware) unsigned long		ftrace_number_of_groups;
31073d083395SSteven Rostedt 
31088c4f3c3fSSteven Rostedt (Red Hat) static inline int ops_traces_mod(struct ftrace_ops *ops)
3109f7bc8b61SSteven Rostedt {
31108c4f3c3fSSteven Rostedt (Red Hat) 	/*
31118c4f3c3fSSteven Rostedt (Red Hat) 	 * Filter_hash being empty will default to trace module.
31128c4f3c3fSSteven Rostedt (Red Hat) 	 * But notrace hash requires a test of individual module functions.
31138c4f3c3fSSteven Rostedt (Red Hat) 	 */
311433b7f99cSSteven Rostedt (Red Hat) 	return ftrace_hash_empty(ops->func_hash->filter_hash) &&
311533b7f99cSSteven Rostedt (Red Hat) 		ftrace_hash_empty(ops->func_hash->notrace_hash);
31168c4f3c3fSSteven Rostedt (Red Hat) }
3117f7bc8b61SSteven Rostedt 
31181dc43cf0SJiri Slaby static int ftrace_update_code(struct module *mod, struct ftrace_page *new_pgs)
31193d083395SSteven Rostedt {
312067ccddf8SIlya Leoshkevich 	bool init_nop = ftrace_need_init_nop();
312185ae32aeSSteven Rostedt 	struct ftrace_page *pg;
3122e94142a6SLai Jiangshan 	struct dyn_ftrace *p;
3123a5a1d1c2SThomas Gleixner 	u64 start, stop;
31241dc43cf0SJiri Slaby 	unsigned long update_cnt = 0;
3125b7ffffbbSSteven Rostedt (Red Hat) 	unsigned long rec_flags = 0;
312685ae32aeSSteven Rostedt 	int i;
3127f7bc8b61SSteven Rostedt 
3128750ed1a4SIngo Molnar 	start = ftrace_now(raw_smp_processor_id());
31293d083395SSteven Rostedt 
3130b7ffffbbSSteven Rostedt (Red Hat) 	/*
3131b7ffffbbSSteven Rostedt (Red Hat) 	 * When a module is loaded, this function is called to convert
3132b7ffffbbSSteven Rostedt (Red Hat) 	 * the calls to mcount in its text to nops, and also to create
3133b7ffffbbSSteven Rostedt (Red Hat) 	 * an entry in the ftrace data. Now, if ftrace is activated
3134b7ffffbbSSteven Rostedt (Red Hat) 	 * after this call, but before the module sets its text to
3135b7ffffbbSSteven Rostedt (Red Hat) 	 * read-only, the modification of enabling ftrace can fail if
3136b7ffffbbSSteven Rostedt (Red Hat) 	 * the read-only is done while ftrace is converting the calls.
3137b7ffffbbSSteven Rostedt (Red Hat) 	 * To prevent this, the module's records are set as disabled
3138b7ffffbbSSteven Rostedt (Red Hat) 	 * and will be enabled after the call to set the module's text
3139b7ffffbbSSteven Rostedt (Red Hat) 	 * to read-only.
3140b7ffffbbSSteven Rostedt (Red Hat) 	 */
3141b7ffffbbSSteven Rostedt (Red Hat) 	if (mod)
3142b7ffffbbSSteven Rostedt (Red Hat) 		rec_flags |= FTRACE_FL_DISABLED;
3143b7ffffbbSSteven Rostedt (Red Hat) 
31441dc43cf0SJiri Slaby 	for (pg = new_pgs; pg; pg = pg->next) {
3145f22f9a89SAbhishek Sagar 
314685ae32aeSSteven Rostedt 		for (i = 0; i < pg->index; i++) {
31478c4f3c3fSSteven Rostedt (Red Hat) 
314808f5ac90SSteven Rostedt 			/* If something went wrong, bail without enabling anything */
314908f5ac90SSteven Rostedt 			if (unlikely(ftrace_disabled))
315008f5ac90SSteven Rostedt 				return -1;
31513d083395SSteven Rostedt 
315285ae32aeSSteven Rostedt 			p = &pg->records[i];
3153b7ffffbbSSteven Rostedt (Red Hat) 			p->flags = rec_flags;
3154f22f9a89SAbhishek Sagar 
31555cb084bbSJiri Olsa 			/*
315625985edcSLucas De Marchi 			 * Do the initial record conversion from mcount jump
31575cb084bbSJiri Olsa 			 * to the NOP instructions.
31585cb084bbSJiri Olsa 			 */
315967ccddf8SIlya Leoshkevich 			if (init_nop && !ftrace_nop_initialize(mod, p))
3160d2c8c3eaSSteven Rostedt 				break;
31615cb084bbSJiri Olsa 
31621dc43cf0SJiri Slaby 			update_cnt++;
31635cb084bbSJiri Olsa 		}
316485ae32aeSSteven Rostedt 	}
316585ae32aeSSteven Rostedt 
3166750ed1a4SIngo Molnar 	stop = ftrace_now(raw_smp_processor_id());
31673d083395SSteven Rostedt 	ftrace_update_time = stop - start;
31681dc43cf0SJiri Slaby 	ftrace_update_tot_cnt += update_cnt;
31693d083395SSteven Rostedt 
317016444a8aSArnaldo Carvalho de Melo 	return 0;
317116444a8aSArnaldo Carvalho de Melo }
317216444a8aSArnaldo Carvalho de Melo 
3173a7900875SSteven Rostedt static int ftrace_allocate_records(struct ftrace_page *pg, int count)
31743c1720f0SSteven Rostedt {
3175a7900875SSteven Rostedt 	int order;
31767ba031e8SSteven Rostedt (VMware) 	int pages;
31773c1720f0SSteven Rostedt 	int cnt;
31783c1720f0SSteven Rostedt 
3179a7900875SSteven Rostedt 	if (WARN_ON(!count))
3180a7900875SSteven Rostedt 		return -EINVAL;
3181a7900875SSteven Rostedt 
3182ceaaa129SSteven Rostedt (VMware) 	/* We want to fill as much as possible, with no empty pages */
3183b40c6eabSWei Yang 	pages = DIV_ROUND_UP(count, ENTRIES_PER_PAGE);
3184ceaaa129SSteven Rostedt (VMware) 	order = fls(pages) - 1;
31853c1720f0SSteven Rostedt 
3186a7900875SSteven Rostedt  again:
3187a7900875SSteven Rostedt 	pg->records = (void *)__get_free_pages(GFP_KERNEL | __GFP_ZERO, order);
3188a7900875SSteven Rostedt 
3189a7900875SSteven Rostedt 	if (!pg->records) {
3190a7900875SSteven Rostedt 		/* if we can't allocate this size, try something smaller */
3191a7900875SSteven Rostedt 		if (!order)
3192a7900875SSteven Rostedt 			return -ENOMEM;
3193*bcea02b0SWang Wensheng 		order--;
3194a7900875SSteven Rostedt 		goto again;
3195a7900875SSteven Rostedt 	}
3196a7900875SSteven Rostedt 
3197da537f0aSSteven Rostedt (VMware) 	ftrace_number_of_pages += 1 << order;
3198da537f0aSSteven Rostedt (VMware) 	ftrace_number_of_groups++;
3199da537f0aSSteven Rostedt (VMware) 
3200a7900875SSteven Rostedt 	cnt = (PAGE_SIZE << order) / ENTRY_SIZE;
3201db42523bSLinus Torvalds 	pg->order = order;
3202a7900875SSteven Rostedt 
3203a7900875SSteven Rostedt 	if (cnt > count)
3204a7900875SSteven Rostedt 		cnt = count;
3205a7900875SSteven Rostedt 
3206a7900875SSteven Rostedt 	return cnt;
3207a7900875SSteven Rostedt }
3208a7900875SSteven Rostedt 
3209a7900875SSteven Rostedt static struct ftrace_page *
3210a7900875SSteven Rostedt ftrace_allocate_pages(unsigned long num_to_init)
3211a7900875SSteven Rostedt {
3212a7900875SSteven Rostedt 	struct ftrace_page *start_pg;
3213a7900875SSteven Rostedt 	struct ftrace_page *pg;
3214a7900875SSteven Rostedt 	int cnt;
3215a7900875SSteven Rostedt 
3216a7900875SSteven Rostedt 	if (!num_to_init)
32179efb85c5SHariprasad Kelam 		return NULL;
3218a7900875SSteven Rostedt 
3219a7900875SSteven Rostedt 	start_pg = pg = kzalloc(sizeof(*pg), GFP_KERNEL);
3220a7900875SSteven Rostedt 	if (!pg)
3221a7900875SSteven Rostedt 		return NULL;
3222a7900875SSteven Rostedt 
3223a7900875SSteven Rostedt 	/*
3224a7900875SSteven Rostedt 	 * Try to allocate as much as possible in one continues
3225a7900875SSteven Rostedt 	 * location that fills in all of the space. We want to
3226a7900875SSteven Rostedt 	 * waste as little space as possible.
3227a7900875SSteven Rostedt 	 */
3228a7900875SSteven Rostedt 	for (;;) {
3229a7900875SSteven Rostedt 		cnt = ftrace_allocate_records(pg, num_to_init);
3230a7900875SSteven Rostedt 		if (cnt < 0)
3231a7900875SSteven Rostedt 			goto free_pages;
3232a7900875SSteven Rostedt 
3233a7900875SSteven Rostedt 		num_to_init -= cnt;
3234a7900875SSteven Rostedt 		if (!num_to_init)
3235a7900875SSteven Rostedt 			break;
3236a7900875SSteven Rostedt 
3237a7900875SSteven Rostedt 		pg->next = kzalloc(sizeof(*pg), GFP_KERNEL);
3238a7900875SSteven Rostedt 		if (!pg->next)
3239a7900875SSteven Rostedt 			goto free_pages;
3240a7900875SSteven Rostedt 
3241a7900875SSteven Rostedt 		pg = pg->next;
3242a7900875SSteven Rostedt 	}
3243a7900875SSteven Rostedt 
3244a7900875SSteven Rostedt 	return start_pg;
3245a7900875SSteven Rostedt 
3246a7900875SSteven Rostedt  free_pages:
32471f61be00SNamhyung Kim 	pg = start_pg;
32481f61be00SNamhyung Kim 	while (pg) {
3249db42523bSLinus Torvalds 		if (pg->records) {
3250db42523bSLinus Torvalds 			free_pages((unsigned long)pg->records, pg->order);
3251db42523bSLinus Torvalds 			ftrace_number_of_pages -= 1 << pg->order;
3252db42523bSLinus Torvalds 		}
3253a7900875SSteven Rostedt 		start_pg = pg->next;
3254a7900875SSteven Rostedt 		kfree(pg);
3255a7900875SSteven Rostedt 		pg = start_pg;
3256da537f0aSSteven Rostedt (VMware) 		ftrace_number_of_groups--;
3257a7900875SSteven Rostedt 	}
3258a7900875SSteven Rostedt 	pr_info("ftrace: FAILED to allocate memory for functions\n");
3259a7900875SSteven Rostedt 	return NULL;
3260a7900875SSteven Rostedt }
3261a7900875SSteven Rostedt 
32625072c59fSSteven Rostedt #define FTRACE_BUFF_MAX (KSYM_SYMBOL_LEN+4) /* room for wildcards */
32635072c59fSSteven Rostedt 
32645072c59fSSteven Rostedt struct ftrace_iterator {
326598c4fd04SSteven Rostedt 	loff_t				pos;
32662bccfffdSSteven Rostedt 	loff_t				func_pos;
32675985ea8bSSteven Rostedt (VMware) 	loff_t				mod_pos;
32685072c59fSSteven Rostedt 	struct ftrace_page		*pg;
32694aeb6967SSteven Rostedt 	struct dyn_ftrace		*func;
32704aeb6967SSteven Rostedt 	struct ftrace_func_probe	*probe;
3271eee8ded1SSteven Rostedt (VMware) 	struct ftrace_func_entry	*probe_entry;
32724aeb6967SSteven Rostedt 	struct trace_parser		parser;
32731cf41dd7SSteven Rostedt 	struct ftrace_hash		*hash;
327433dc9b12SSteven Rostedt 	struct ftrace_ops		*ops;
32755985ea8bSSteven Rostedt (VMware) 	struct trace_array		*tr;
32765985ea8bSSteven Rostedt (VMware) 	struct list_head		*mod_list;
3277eee8ded1SSteven Rostedt (VMware) 	int				pidx;
3278431aa3fbSSteven Rostedt 	int				idx;
32795072c59fSSteven Rostedt 	unsigned			flags;
32805072c59fSSteven Rostedt };
32815072c59fSSteven Rostedt 
3282e309b41dSIngo Molnar static void *
3283eee8ded1SSteven Rostedt (VMware) t_probe_next(struct seq_file *m, loff_t *pos)
32848fc0c701SSteven Rostedt {
32858fc0c701SSteven Rostedt 	struct ftrace_iterator *iter = m->private;
3286d2afd57aSSteven Rostedt (VMware) 	struct trace_array *tr = iter->ops->private;
328704ec7bb6SSteven Rostedt (VMware) 	struct list_head *func_probes;
3288eee8ded1SSteven Rostedt (VMware) 	struct ftrace_hash *hash;
3289eee8ded1SSteven Rostedt (VMware) 	struct list_head *next;
32904aeb6967SSteven Rostedt 	struct hlist_node *hnd = NULL;
32918fc0c701SSteven Rostedt 	struct hlist_head *hhd;
3292eee8ded1SSteven Rostedt (VMware) 	int size;
32938fc0c701SSteven Rostedt 
32948fc0c701SSteven Rostedt 	(*pos)++;
329598c4fd04SSteven Rostedt 	iter->pos = *pos;
32968fc0c701SSteven Rostedt 
329704ec7bb6SSteven Rostedt (VMware) 	if (!tr)
32988fc0c701SSteven Rostedt 		return NULL;
32998fc0c701SSteven Rostedt 
330004ec7bb6SSteven Rostedt (VMware) 	func_probes = &tr->func_probes;
330104ec7bb6SSteven Rostedt (VMware) 	if (list_empty(func_probes))
33028fc0c701SSteven Rostedt 		return NULL;
33038fc0c701SSteven Rostedt 
3304eee8ded1SSteven Rostedt (VMware) 	if (!iter->probe) {
330504ec7bb6SSteven Rostedt (VMware) 		next = func_probes->next;
33067b60f3d8SSteven Rostedt (VMware) 		iter->probe = list_entry(next, struct ftrace_func_probe, list);
3307eee8ded1SSteven Rostedt (VMware) 	}
3308eee8ded1SSteven Rostedt (VMware) 
3309eee8ded1SSteven Rostedt (VMware) 	if (iter->probe_entry)
3310eee8ded1SSteven Rostedt (VMware) 		hnd = &iter->probe_entry->hlist;
3311eee8ded1SSteven Rostedt (VMware) 
3312eee8ded1SSteven Rostedt (VMware) 	hash = iter->probe->ops.func_hash->filter_hash;
33137bd46644SNaveen N. Rao 
3314372e0d01SSteven Rostedt (VMware) 	/*
3315372e0d01SSteven Rostedt (VMware) 	 * A probe being registered may temporarily have an empty hash
3316372e0d01SSteven Rostedt (VMware) 	 * and it's at the end of the func_probes list.
3317372e0d01SSteven Rostedt (VMware) 	 */
3318372e0d01SSteven Rostedt (VMware) 	if (!hash || hash == EMPTY_HASH)
33197bd46644SNaveen N. Rao 		return NULL;
33207bd46644SNaveen N. Rao 
3321eee8ded1SSteven Rostedt (VMware) 	size = 1 << hash->size_bits;
3322eee8ded1SSteven Rostedt (VMware) 
3323eee8ded1SSteven Rostedt (VMware)  retry:
3324eee8ded1SSteven Rostedt (VMware) 	if (iter->pidx >= size) {
332504ec7bb6SSteven Rostedt (VMware) 		if (iter->probe->list.next == func_probes)
3326eee8ded1SSteven Rostedt (VMware) 			return NULL;
3327eee8ded1SSteven Rostedt (VMware) 		next = iter->probe->list.next;
33287b60f3d8SSteven Rostedt (VMware) 		iter->probe = list_entry(next, struct ftrace_func_probe, list);
3329eee8ded1SSteven Rostedt (VMware) 		hash = iter->probe->ops.func_hash->filter_hash;
3330eee8ded1SSteven Rostedt (VMware) 		size = 1 << hash->size_bits;
3331eee8ded1SSteven Rostedt (VMware) 		iter->pidx = 0;
3332eee8ded1SSteven Rostedt (VMware) 	}
3333eee8ded1SSteven Rostedt (VMware) 
3334eee8ded1SSteven Rostedt (VMware) 	hhd = &hash->buckets[iter->pidx];
33358fc0c701SSteven Rostedt 
33368fc0c701SSteven Rostedt 	if (hlist_empty(hhd)) {
3337eee8ded1SSteven Rostedt (VMware) 		iter->pidx++;
33388fc0c701SSteven Rostedt 		hnd = NULL;
33398fc0c701SSteven Rostedt 		goto retry;
33408fc0c701SSteven Rostedt 	}
33418fc0c701SSteven Rostedt 
33428fc0c701SSteven Rostedt 	if (!hnd)
33438fc0c701SSteven Rostedt 		hnd = hhd->first;
33448fc0c701SSteven Rostedt 	else {
33458fc0c701SSteven Rostedt 		hnd = hnd->next;
33468fc0c701SSteven Rostedt 		if (!hnd) {
3347eee8ded1SSteven Rostedt (VMware) 			iter->pidx++;
33488fc0c701SSteven Rostedt 			goto retry;
33498fc0c701SSteven Rostedt 		}
33508fc0c701SSteven Rostedt 	}
33518fc0c701SSteven Rostedt 
33524aeb6967SSteven Rostedt 	if (WARN_ON_ONCE(!hnd))
33534aeb6967SSteven Rostedt 		return NULL;
33544aeb6967SSteven Rostedt 
3355eee8ded1SSteven Rostedt (VMware) 	iter->probe_entry = hlist_entry(hnd, struct ftrace_func_entry, hlist);
33564aeb6967SSteven Rostedt 
33574aeb6967SSteven Rostedt 	return iter;
33588fc0c701SSteven Rostedt }
33598fc0c701SSteven Rostedt 
3360eee8ded1SSteven Rostedt (VMware) static void *t_probe_start(struct seq_file *m, loff_t *pos)
33618fc0c701SSteven Rostedt {
33628fc0c701SSteven Rostedt 	struct ftrace_iterator *iter = m->private;
33638fc0c701SSteven Rostedt 	void *p = NULL;
3364d82d6244SLi Zefan 	loff_t l;
3365d82d6244SLi Zefan 
3366eee8ded1SSteven Rostedt (VMware) 	if (!(iter->flags & FTRACE_ITER_DO_PROBES))
336769a3083cSSteven Rostedt 		return NULL;
336869a3083cSSteven Rostedt 
33695985ea8bSSteven Rostedt (VMware) 	if (iter->mod_pos > *pos)
33702bccfffdSSteven Rostedt 		return NULL;
33718fc0c701SSteven Rostedt 
3372eee8ded1SSteven Rostedt (VMware) 	iter->probe = NULL;
3373eee8ded1SSteven Rostedt (VMware) 	iter->probe_entry = NULL;
3374eee8ded1SSteven Rostedt (VMware) 	iter->pidx = 0;
33755985ea8bSSteven Rostedt (VMware) 	for (l = 0; l <= (*pos - iter->mod_pos); ) {
3376eee8ded1SSteven Rostedt (VMware) 		p = t_probe_next(m, &l);
3377d82d6244SLi Zefan 		if (!p)
3378d82d6244SLi Zefan 			break;
3379d82d6244SLi Zefan 	}
33804aeb6967SSteven Rostedt 	if (!p)
33814aeb6967SSteven Rostedt 		return NULL;
33824aeb6967SSteven Rostedt 
338398c4fd04SSteven Rostedt 	/* Only set this if we have an item */
3384eee8ded1SSteven Rostedt (VMware) 	iter->flags |= FTRACE_ITER_PROBE;
338598c4fd04SSteven Rostedt 
33864aeb6967SSteven Rostedt 	return iter;
33878fc0c701SSteven Rostedt }
33888fc0c701SSteven Rostedt 
33894aeb6967SSteven Rostedt static int
3390eee8ded1SSteven Rostedt (VMware) t_probe_show(struct seq_file *m, struct ftrace_iterator *iter)
33918fc0c701SSteven Rostedt {
3392eee8ded1SSteven Rostedt (VMware) 	struct ftrace_func_entry *probe_entry;
33937b60f3d8SSteven Rostedt (VMware) 	struct ftrace_probe_ops *probe_ops;
33947b60f3d8SSteven Rostedt (VMware) 	struct ftrace_func_probe *probe;
33958fc0c701SSteven Rostedt 
3396eee8ded1SSteven Rostedt (VMware) 	probe = iter->probe;
3397eee8ded1SSteven Rostedt (VMware) 	probe_entry = iter->probe_entry;
3398eee8ded1SSteven Rostedt (VMware) 
3399eee8ded1SSteven Rostedt (VMware) 	if (WARN_ON_ONCE(!probe || !probe_entry))
34004aeb6967SSteven Rostedt 		return -EIO;
34018fc0c701SSteven Rostedt 
34027b60f3d8SSteven Rostedt (VMware) 	probe_ops = probe->probe_ops;
3403809dcf29SSteven Rostedt 
34047b60f3d8SSteven Rostedt (VMware) 	if (probe_ops->print)
34056e444319SSteven Rostedt (VMware) 		return probe_ops->print(m, probe_entry->ip, probe_ops, probe->data);
34068fc0c701SSteven Rostedt 
34077b60f3d8SSteven Rostedt (VMware) 	seq_printf(m, "%ps:%ps\n", (void *)probe_entry->ip,
34087b60f3d8SSteven Rostedt (VMware) 		   (void *)probe_ops->func);
34098fc0c701SSteven Rostedt 
34108fc0c701SSteven Rostedt 	return 0;
34118fc0c701SSteven Rostedt }
34128fc0c701SSteven Rostedt 
34138fc0c701SSteven Rostedt static void *
34145985ea8bSSteven Rostedt (VMware) t_mod_next(struct seq_file *m, loff_t *pos)
34155985ea8bSSteven Rostedt (VMware) {
34165985ea8bSSteven Rostedt (VMware) 	struct ftrace_iterator *iter = m->private;
34175985ea8bSSteven Rostedt (VMware) 	struct trace_array *tr = iter->tr;
34185985ea8bSSteven Rostedt (VMware) 
34195985ea8bSSteven Rostedt (VMware) 	(*pos)++;
34205985ea8bSSteven Rostedt (VMware) 	iter->pos = *pos;
34215985ea8bSSteven Rostedt (VMware) 
34225985ea8bSSteven Rostedt (VMware) 	iter->mod_list = iter->mod_list->next;
34235985ea8bSSteven Rostedt (VMware) 
34245985ea8bSSteven Rostedt (VMware) 	if (iter->mod_list == &tr->mod_trace ||
34255985ea8bSSteven Rostedt (VMware) 	    iter->mod_list == &tr->mod_notrace) {
34265985ea8bSSteven Rostedt (VMware) 		iter->flags &= ~FTRACE_ITER_MOD;
34275985ea8bSSteven Rostedt (VMware) 		return NULL;
34285985ea8bSSteven Rostedt (VMware) 	}
34295985ea8bSSteven Rostedt (VMware) 
34305985ea8bSSteven Rostedt (VMware) 	iter->mod_pos = *pos;
34315985ea8bSSteven Rostedt (VMware) 
34325985ea8bSSteven Rostedt (VMware) 	return iter;
34335985ea8bSSteven Rostedt (VMware) }
34345985ea8bSSteven Rostedt (VMware) 
34355985ea8bSSteven Rostedt (VMware) static void *t_mod_start(struct seq_file *m, loff_t *pos)
34365985ea8bSSteven Rostedt (VMware) {
34375985ea8bSSteven Rostedt (VMware) 	struct ftrace_iterator *iter = m->private;
34385985ea8bSSteven Rostedt (VMware) 	void *p = NULL;
34395985ea8bSSteven Rostedt (VMware) 	loff_t l;
34405985ea8bSSteven Rostedt (VMware) 
34415985ea8bSSteven Rostedt (VMware) 	if (iter->func_pos > *pos)
34425985ea8bSSteven Rostedt (VMware) 		return NULL;
34435985ea8bSSteven Rostedt (VMware) 
34445985ea8bSSteven Rostedt (VMware) 	iter->mod_pos = iter->func_pos;
34455985ea8bSSteven Rostedt (VMware) 
34465985ea8bSSteven Rostedt (VMware) 	/* probes are only available if tr is set */
34475985ea8bSSteven Rostedt (VMware) 	if (!iter->tr)
34485985ea8bSSteven Rostedt (VMware) 		return NULL;
34495985ea8bSSteven Rostedt (VMware) 
34505985ea8bSSteven Rostedt (VMware) 	for (l = 0; l <= (*pos - iter->func_pos); ) {
34515985ea8bSSteven Rostedt (VMware) 		p = t_mod_next(m, &l);
34525985ea8bSSteven Rostedt (VMware) 		if (!p)
34535985ea8bSSteven Rostedt (VMware) 			break;
34545985ea8bSSteven Rostedt (VMware) 	}
34555985ea8bSSteven Rostedt (VMware) 	if (!p) {
34565985ea8bSSteven Rostedt (VMware) 		iter->flags &= ~FTRACE_ITER_MOD;
34575985ea8bSSteven Rostedt (VMware) 		return t_probe_start(m, pos);
34585985ea8bSSteven Rostedt (VMware) 	}
34595985ea8bSSteven Rostedt (VMware) 
34605985ea8bSSteven Rostedt (VMware) 	/* Only set this if we have an item */
34615985ea8bSSteven Rostedt (VMware) 	iter->flags |= FTRACE_ITER_MOD;
34625985ea8bSSteven Rostedt (VMware) 
34635985ea8bSSteven Rostedt (VMware) 	return iter;
34645985ea8bSSteven Rostedt (VMware) }
34655985ea8bSSteven Rostedt (VMware) 
34665985ea8bSSteven Rostedt (VMware) static int
34675985ea8bSSteven Rostedt (VMware) t_mod_show(struct seq_file *m, struct ftrace_iterator *iter)
34685985ea8bSSteven Rostedt (VMware) {
34695985ea8bSSteven Rostedt (VMware) 	struct ftrace_mod_load *ftrace_mod;
34705985ea8bSSteven Rostedt (VMware) 	struct trace_array *tr = iter->tr;
34715985ea8bSSteven Rostedt (VMware) 
34725985ea8bSSteven Rostedt (VMware) 	if (WARN_ON_ONCE(!iter->mod_list) ||
34735985ea8bSSteven Rostedt (VMware) 			 iter->mod_list == &tr->mod_trace ||
34745985ea8bSSteven Rostedt (VMware) 			 iter->mod_list == &tr->mod_notrace)
34755985ea8bSSteven Rostedt (VMware) 		return -EIO;
34765985ea8bSSteven Rostedt (VMware) 
34775985ea8bSSteven Rostedt (VMware) 	ftrace_mod = list_entry(iter->mod_list, struct ftrace_mod_load, list);
34785985ea8bSSteven Rostedt (VMware) 
34795985ea8bSSteven Rostedt (VMware) 	if (ftrace_mod->func)
34805985ea8bSSteven Rostedt (VMware) 		seq_printf(m, "%s", ftrace_mod->func);
34815985ea8bSSteven Rostedt (VMware) 	else
34825985ea8bSSteven Rostedt (VMware) 		seq_putc(m, '*');
34835985ea8bSSteven Rostedt (VMware) 
34845985ea8bSSteven Rostedt (VMware) 	seq_printf(m, ":mod:%s\n", ftrace_mod->module);
34855985ea8bSSteven Rostedt (VMware) 
34865985ea8bSSteven Rostedt (VMware) 	return 0;
34875985ea8bSSteven Rostedt (VMware) }
34885985ea8bSSteven Rostedt (VMware) 
34895985ea8bSSteven Rostedt (VMware) static void *
34905bd84629SSteven Rostedt (VMware) t_func_next(struct seq_file *m, loff_t *pos)
34915072c59fSSteven Rostedt {
34925072c59fSSteven Rostedt 	struct ftrace_iterator *iter = m->private;
34935072c59fSSteven Rostedt 	struct dyn_ftrace *rec = NULL;
34945072c59fSSteven Rostedt 
34955072c59fSSteven Rostedt 	(*pos)++;
34960c75a3edSSteven Rostedt 
34975072c59fSSteven Rostedt  retry:
34985072c59fSSteven Rostedt 	if (iter->idx >= iter->pg->index) {
34995072c59fSSteven Rostedt 		if (iter->pg->next) {
35005072c59fSSteven Rostedt 			iter->pg = iter->pg->next;
35015072c59fSSteven Rostedt 			iter->idx = 0;
35025072c59fSSteven Rostedt 			goto retry;
35035072c59fSSteven Rostedt 		}
35045072c59fSSteven Rostedt 	} else {
35055072c59fSSteven Rostedt 		rec = &iter->pg->records[iter->idx++];
3506c20489daSSteven Rostedt (VMware) 		if (((iter->flags & (FTRACE_ITER_FILTER | FTRACE_ITER_NOTRACE)) &&
3507c20489daSSteven Rostedt (VMware) 		     !ftrace_lookup_ip(iter->hash, rec->ip)) ||
3508647bcd03SSteven Rostedt 
3509647bcd03SSteven Rostedt 		    ((iter->flags & FTRACE_ITER_ENABLED) &&
351023ea9c4dSSteven Rostedt (Red Hat) 		     !(rec->flags & FTRACE_FL_ENABLED))) {
3511647bcd03SSteven Rostedt 
35125072c59fSSteven Rostedt 			rec = NULL;
35135072c59fSSteven Rostedt 			goto retry;
35145072c59fSSteven Rostedt 		}
35155072c59fSSteven Rostedt 	}
35165072c59fSSteven Rostedt 
35174aeb6967SSteven Rostedt 	if (!rec)
35185bd84629SSteven Rostedt (VMware) 		return NULL;
35194aeb6967SSteven Rostedt 
35205bd84629SSteven Rostedt (VMware) 	iter->pos = iter->func_pos = *pos;
35214aeb6967SSteven Rostedt 	iter->func = rec;
35224aeb6967SSteven Rostedt 
35234aeb6967SSteven Rostedt 	return iter;
35245072c59fSSteven Rostedt }
35255072c59fSSteven Rostedt 
35265bd84629SSteven Rostedt (VMware) static void *
35275bd84629SSteven Rostedt (VMware) t_next(struct seq_file *m, void *v, loff_t *pos)
35285bd84629SSteven Rostedt (VMware) {
35295bd84629SSteven Rostedt (VMware) 	struct ftrace_iterator *iter = m->private;
35305985ea8bSSteven Rostedt (VMware) 	loff_t l = *pos; /* t_probe_start() must use original pos */
35315bd84629SSteven Rostedt (VMware) 	void *ret;
35325bd84629SSteven Rostedt (VMware) 
35335bd84629SSteven Rostedt (VMware) 	if (unlikely(ftrace_disabled))
35345bd84629SSteven Rostedt (VMware) 		return NULL;
35355bd84629SSteven Rostedt (VMware) 
3536eee8ded1SSteven Rostedt (VMware) 	if (iter->flags & FTRACE_ITER_PROBE)
3537eee8ded1SSteven Rostedt (VMware) 		return t_probe_next(m, pos);
35385bd84629SSteven Rostedt (VMware) 
35395985ea8bSSteven Rostedt (VMware) 	if (iter->flags & FTRACE_ITER_MOD)
35405985ea8bSSteven Rostedt (VMware) 		return t_mod_next(m, pos);
35415985ea8bSSteven Rostedt (VMware) 
35425bd84629SSteven Rostedt (VMware) 	if (iter->flags & FTRACE_ITER_PRINTALL) {
3543eee8ded1SSteven Rostedt (VMware) 		/* next must increment pos, and t_probe_start does not */
35445bd84629SSteven Rostedt (VMware) 		(*pos)++;
35455985ea8bSSteven Rostedt (VMware) 		return t_mod_start(m, &l);
35465bd84629SSteven Rostedt (VMware) 	}
35475bd84629SSteven Rostedt (VMware) 
35485bd84629SSteven Rostedt (VMware) 	ret = t_func_next(m, pos);
35495bd84629SSteven Rostedt (VMware) 
35505bd84629SSteven Rostedt (VMware) 	if (!ret)
35515985ea8bSSteven Rostedt (VMware) 		return t_mod_start(m, &l);
35525bd84629SSteven Rostedt (VMware) 
35535bd84629SSteven Rostedt (VMware) 	return ret;
35545bd84629SSteven Rostedt (VMware) }
35555bd84629SSteven Rostedt (VMware) 
355698c4fd04SSteven Rostedt static void reset_iter_read(struct ftrace_iterator *iter)
355798c4fd04SSteven Rostedt {
355898c4fd04SSteven Rostedt 	iter->pos = 0;
355998c4fd04SSteven Rostedt 	iter->func_pos = 0;
35605985ea8bSSteven Rostedt (VMware) 	iter->flags &= ~(FTRACE_ITER_PRINTALL | FTRACE_ITER_PROBE | FTRACE_ITER_MOD);
35615072c59fSSteven Rostedt }
35625072c59fSSteven Rostedt 
35635072c59fSSteven Rostedt static void *t_start(struct seq_file *m, loff_t *pos)
35645072c59fSSteven Rostedt {
35655072c59fSSteven Rostedt 	struct ftrace_iterator *iter = m->private;
35665072c59fSSteven Rostedt 	void *p = NULL;
3567694ce0a5SLi Zefan 	loff_t l;
35685072c59fSSteven Rostedt 
35698fc0c701SSteven Rostedt 	mutex_lock(&ftrace_lock);
357045a4a237SSteven Rostedt 
357145a4a237SSteven Rostedt 	if (unlikely(ftrace_disabled))
357245a4a237SSteven Rostedt 		return NULL;
357345a4a237SSteven Rostedt 
35740c75a3edSSteven Rostedt 	/*
357598c4fd04SSteven Rostedt 	 * If an lseek was done, then reset and start from beginning.
357698c4fd04SSteven Rostedt 	 */
357798c4fd04SSteven Rostedt 	if (*pos < iter->pos)
357898c4fd04SSteven Rostedt 		reset_iter_read(iter);
357998c4fd04SSteven Rostedt 
358098c4fd04SSteven Rostedt 	/*
35810c75a3edSSteven Rostedt 	 * For set_ftrace_filter reading, if we have the filter
35820c75a3edSSteven Rostedt 	 * off, we can short cut and just print out that all
35830c75a3edSSteven Rostedt 	 * functions are enabled.
35840c75a3edSSteven Rostedt 	 */
3585c20489daSSteven Rostedt (VMware) 	if ((iter->flags & (FTRACE_ITER_FILTER | FTRACE_ITER_NOTRACE)) &&
3586c20489daSSteven Rostedt (VMware) 	    ftrace_hash_empty(iter->hash)) {
358743ff926aSSteven Rostedt (VMware) 		iter->func_pos = 1; /* Account for the message */
35880c75a3edSSteven Rostedt 		if (*pos > 0)
35895985ea8bSSteven Rostedt (VMware) 			return t_mod_start(m, pos);
35900c75a3edSSteven Rostedt 		iter->flags |= FTRACE_ITER_PRINTALL;
3591df091625SChris Wright 		/* reset in case of seek/pread */
3592eee8ded1SSteven Rostedt (VMware) 		iter->flags &= ~FTRACE_ITER_PROBE;
35930c75a3edSSteven Rostedt 		return iter;
35940c75a3edSSteven Rostedt 	}
35950c75a3edSSteven Rostedt 
35965985ea8bSSteven Rostedt (VMware) 	if (iter->flags & FTRACE_ITER_MOD)
35975985ea8bSSteven Rostedt (VMware) 		return t_mod_start(m, pos);
35988fc0c701SSteven Rostedt 
359998c4fd04SSteven Rostedt 	/*
360098c4fd04SSteven Rostedt 	 * Unfortunately, we need to restart at ftrace_pages_start
360198c4fd04SSteven Rostedt 	 * every time we let go of the ftrace_mutex. This is because
360298c4fd04SSteven Rostedt 	 * those pointers can change without the lock.
360398c4fd04SSteven Rostedt 	 */
3604694ce0a5SLi Zefan 	iter->pg = ftrace_pages_start;
3605694ce0a5SLi Zefan 	iter->idx = 0;
3606694ce0a5SLi Zefan 	for (l = 0; l <= *pos; ) {
36075bd84629SSteven Rostedt (VMware) 		p = t_func_next(m, &l);
3608694ce0a5SLi Zefan 		if (!p)
3609694ce0a5SLi Zefan 			break;
361050cdaf08SLiming Wang 	}
36115821e1b7Swalimis 
361269a3083cSSteven Rostedt 	if (!p)
36135985ea8bSSteven Rostedt (VMware) 		return t_mod_start(m, pos);
36148fc0c701SSteven Rostedt 
36154aeb6967SSteven Rostedt 	return iter;
36165072c59fSSteven Rostedt }
36175072c59fSSteven Rostedt 
36185072c59fSSteven Rostedt static void t_stop(struct seq_file *m, void *p)
36195072c59fSSteven Rostedt {
36208fc0c701SSteven Rostedt 	mutex_unlock(&ftrace_lock);
36215072c59fSSteven Rostedt }
36225072c59fSSteven Rostedt 
362315d5b02cSSteven Rostedt (Red Hat) void * __weak
362415d5b02cSSteven Rostedt (Red Hat) arch_ftrace_trampoline_func(struct ftrace_ops *ops, struct dyn_ftrace *rec)
362515d5b02cSSteven Rostedt (Red Hat) {
362615d5b02cSSteven Rostedt (Red Hat) 	return NULL;
362715d5b02cSSteven Rostedt (Red Hat) }
362815d5b02cSSteven Rostedt (Red Hat) 
362915d5b02cSSteven Rostedt (Red Hat) static void add_trampoline_func(struct seq_file *m, struct ftrace_ops *ops,
363015d5b02cSSteven Rostedt (Red Hat) 				struct dyn_ftrace *rec)
363115d5b02cSSteven Rostedt (Red Hat) {
363215d5b02cSSteven Rostedt (Red Hat) 	void *ptr;
363315d5b02cSSteven Rostedt (Red Hat) 
363415d5b02cSSteven Rostedt (Red Hat) 	ptr = arch_ftrace_trampoline_func(ops, rec);
363515d5b02cSSteven Rostedt (Red Hat) 	if (ptr)
363615d5b02cSSteven Rostedt (Red Hat) 		seq_printf(m, " ->%pS", ptr);
363715d5b02cSSteven Rostedt (Red Hat) }
363815d5b02cSSteven Rostedt (Red Hat) 
3639b39181f7SSteven Rostedt (Google) #ifdef FTRACE_MCOUNT_MAX_OFFSET
3640b39181f7SSteven Rostedt (Google) /*
3641b39181f7SSteven Rostedt (Google)  * Weak functions can still have an mcount/fentry that is saved in
3642b39181f7SSteven Rostedt (Google)  * the __mcount_loc section. These can be detected by having a
3643b39181f7SSteven Rostedt (Google)  * symbol offset of greater than FTRACE_MCOUNT_MAX_OFFSET, as the
3644b39181f7SSteven Rostedt (Google)  * symbol found by kallsyms is not the function that the mcount/fentry
3645b39181f7SSteven Rostedt (Google)  * is part of. The offset is much greater in these cases.
3646b39181f7SSteven Rostedt (Google)  *
3647b39181f7SSteven Rostedt (Google)  * Test the record to make sure that the ip points to a valid kallsyms
3648b39181f7SSteven Rostedt (Google)  * and if not, mark it disabled.
3649b39181f7SSteven Rostedt (Google)  */
3650b39181f7SSteven Rostedt (Google) static int test_for_valid_rec(struct dyn_ftrace *rec)
3651b39181f7SSteven Rostedt (Google) {
3652b39181f7SSteven Rostedt (Google) 	char str[KSYM_SYMBOL_LEN];
3653b39181f7SSteven Rostedt (Google) 	unsigned long offset;
3654b39181f7SSteven Rostedt (Google) 	const char *ret;
3655b39181f7SSteven Rostedt (Google) 
3656b39181f7SSteven Rostedt (Google) 	ret = kallsyms_lookup(rec->ip, NULL, &offset, NULL, str);
3657b39181f7SSteven Rostedt (Google) 
3658b39181f7SSteven Rostedt (Google) 	/* Weak functions can cause invalid addresses */
3659b39181f7SSteven Rostedt (Google) 	if (!ret || offset > FTRACE_MCOUNT_MAX_OFFSET) {
3660b39181f7SSteven Rostedt (Google) 		rec->flags |= FTRACE_FL_DISABLED;
3661b39181f7SSteven Rostedt (Google) 		return 0;
3662b39181f7SSteven Rostedt (Google) 	}
3663b39181f7SSteven Rostedt (Google) 	return 1;
3664b39181f7SSteven Rostedt (Google) }
3665b39181f7SSteven Rostedt (Google) 
3666b39181f7SSteven Rostedt (Google) static struct workqueue_struct *ftrace_check_wq __initdata;
3667b39181f7SSteven Rostedt (Google) static struct work_struct ftrace_check_work __initdata;
3668b39181f7SSteven Rostedt (Google) 
3669b39181f7SSteven Rostedt (Google) /*
3670b39181f7SSteven Rostedt (Google)  * Scan all the mcount/fentry entries to make sure they are valid.
3671b39181f7SSteven Rostedt (Google)  */
3672b39181f7SSteven Rostedt (Google) static __init void ftrace_check_work_func(struct work_struct *work)
3673b39181f7SSteven Rostedt (Google) {
3674b39181f7SSteven Rostedt (Google) 	struct ftrace_page *pg;
3675b39181f7SSteven Rostedt (Google) 	struct dyn_ftrace *rec;
3676b39181f7SSteven Rostedt (Google) 
3677b39181f7SSteven Rostedt (Google) 	mutex_lock(&ftrace_lock);
3678b39181f7SSteven Rostedt (Google) 	do_for_each_ftrace_rec(pg, rec) {
3679b39181f7SSteven Rostedt (Google) 		test_for_valid_rec(rec);
3680b39181f7SSteven Rostedt (Google) 	} while_for_each_ftrace_rec();
3681b39181f7SSteven Rostedt (Google) 	mutex_unlock(&ftrace_lock);
3682b39181f7SSteven Rostedt (Google) }
3683b39181f7SSteven Rostedt (Google) 
3684b39181f7SSteven Rostedt (Google) static int __init ftrace_check_for_weak_functions(void)
3685b39181f7SSteven Rostedt (Google) {
3686b39181f7SSteven Rostedt (Google) 	INIT_WORK(&ftrace_check_work, ftrace_check_work_func);
3687b39181f7SSteven Rostedt (Google) 
3688b39181f7SSteven Rostedt (Google) 	ftrace_check_wq = alloc_workqueue("ftrace_check_wq", WQ_UNBOUND, 0);
3689b39181f7SSteven Rostedt (Google) 
3690b39181f7SSteven Rostedt (Google) 	queue_work(ftrace_check_wq, &ftrace_check_work);
3691b39181f7SSteven Rostedt (Google) 	return 0;
3692b39181f7SSteven Rostedt (Google) }
3693b39181f7SSteven Rostedt (Google) 
3694b39181f7SSteven Rostedt (Google) static int __init ftrace_check_sync(void)
3695b39181f7SSteven Rostedt (Google) {
3696b39181f7SSteven Rostedt (Google) 	/* Make sure the ftrace_check updates are finished */
3697b39181f7SSteven Rostedt (Google) 	if (ftrace_check_wq)
3698b39181f7SSteven Rostedt (Google) 		destroy_workqueue(ftrace_check_wq);
3699b39181f7SSteven Rostedt (Google) 	return 0;
3700b39181f7SSteven Rostedt (Google) }
3701b39181f7SSteven Rostedt (Google) 
3702b39181f7SSteven Rostedt (Google) late_initcall_sync(ftrace_check_sync);
3703b39181f7SSteven Rostedt (Google) subsys_initcall(ftrace_check_for_weak_functions);
3704b39181f7SSteven Rostedt (Google) 
3705b39181f7SSteven Rostedt (Google) static int print_rec(struct seq_file *m, unsigned long ip)
3706b39181f7SSteven Rostedt (Google) {
3707b39181f7SSteven Rostedt (Google) 	unsigned long offset;
3708b39181f7SSteven Rostedt (Google) 	char str[KSYM_SYMBOL_LEN];
3709b39181f7SSteven Rostedt (Google) 	char *modname;
3710b39181f7SSteven Rostedt (Google) 	const char *ret;
3711b39181f7SSteven Rostedt (Google) 
3712b39181f7SSteven Rostedt (Google) 	ret = kallsyms_lookup(ip, NULL, &offset, &modname, str);
3713b39181f7SSteven Rostedt (Google) 	/* Weak functions can cause invalid addresses */
3714b39181f7SSteven Rostedt (Google) 	if (!ret || offset > FTRACE_MCOUNT_MAX_OFFSET) {
3715b39181f7SSteven Rostedt (Google) 		snprintf(str, KSYM_SYMBOL_LEN, "%s_%ld",
3716b39181f7SSteven Rostedt (Google) 			 FTRACE_INVALID_FUNCTION, offset);
3717b39181f7SSteven Rostedt (Google) 		ret = NULL;
3718b39181f7SSteven Rostedt (Google) 	}
3719b39181f7SSteven Rostedt (Google) 
3720b39181f7SSteven Rostedt (Google) 	seq_puts(m, str);
3721b39181f7SSteven Rostedt (Google) 	if (modname)
3722b39181f7SSteven Rostedt (Google) 		seq_printf(m, " [%s]", modname);
3723b39181f7SSteven Rostedt (Google) 	return ret == NULL ? -1 : 0;
3724b39181f7SSteven Rostedt (Google) }
3725b39181f7SSteven Rostedt (Google) #else
3726b39181f7SSteven Rostedt (Google) static inline int test_for_valid_rec(struct dyn_ftrace *rec)
3727b39181f7SSteven Rostedt (Google) {
3728b39181f7SSteven Rostedt (Google) 	return 1;
3729b39181f7SSteven Rostedt (Google) }
3730b39181f7SSteven Rostedt (Google) 
3731b39181f7SSteven Rostedt (Google) static inline int print_rec(struct seq_file *m, unsigned long ip)
3732b39181f7SSteven Rostedt (Google) {
3733b39181f7SSteven Rostedt (Google) 	seq_printf(m, "%ps", (void *)ip);
3734b39181f7SSteven Rostedt (Google) 	return 0;
3735b39181f7SSteven Rostedt (Google) }
3736b39181f7SSteven Rostedt (Google) #endif
3737b39181f7SSteven Rostedt (Google) 
37385072c59fSSteven Rostedt static int t_show(struct seq_file *m, void *v)
37395072c59fSSteven Rostedt {
37400c75a3edSSteven Rostedt 	struct ftrace_iterator *iter = m->private;
37414aeb6967SSteven Rostedt 	struct dyn_ftrace *rec;
37425072c59fSSteven Rostedt 
3743eee8ded1SSteven Rostedt (VMware) 	if (iter->flags & FTRACE_ITER_PROBE)
3744eee8ded1SSteven Rostedt (VMware) 		return t_probe_show(m, iter);
37458fc0c701SSteven Rostedt 
37465985ea8bSSteven Rostedt (VMware) 	if (iter->flags & FTRACE_ITER_MOD)
37475985ea8bSSteven Rostedt (VMware) 		return t_mod_show(m, iter);
37485985ea8bSSteven Rostedt (VMware) 
37490c75a3edSSteven Rostedt 	if (iter->flags & FTRACE_ITER_PRINTALL) {
37508c006cf7SNamhyung Kim 		if (iter->flags & FTRACE_ITER_NOTRACE)
3751fa6f0cc7SRasmus Villemoes 			seq_puts(m, "#### no functions disabled ####\n");
37528c006cf7SNamhyung Kim 		else
3753fa6f0cc7SRasmus Villemoes 			seq_puts(m, "#### all functions enabled ####\n");
37540c75a3edSSteven Rostedt 		return 0;
37550c75a3edSSteven Rostedt 	}
37560c75a3edSSteven Rostedt 
37574aeb6967SSteven Rostedt 	rec = iter->func;
37584aeb6967SSteven Rostedt 
37595072c59fSSteven Rostedt 	if (!rec)
37605072c59fSSteven Rostedt 		return 0;
37615072c59fSSteven Rostedt 
3762b39181f7SSteven Rostedt (Google) 	if (print_rec(m, rec->ip)) {
3763b39181f7SSteven Rostedt (Google) 		/* This should only happen when a rec is disabled */
3764b39181f7SSteven Rostedt (Google) 		WARN_ON_ONCE(!(rec->flags & FTRACE_FL_DISABLED));
3765b39181f7SSteven Rostedt (Google) 		seq_putc(m, '\n');
3766b39181f7SSteven Rostedt (Google) 		return 0;
3767b39181f7SSteven Rostedt (Google) 	}
3768b39181f7SSteven Rostedt (Google) 
37699674b2faSSteven Rostedt (Red Hat) 	if (iter->flags & FTRACE_ITER_ENABLED) {
3770030f4e1cSSteven Rostedt (Red Hat) 		struct ftrace_ops *ops;
377115d5b02cSSteven Rostedt (Red Hat) 
3772763e34e7SSteven Rostedt (VMware) 		seq_printf(m, " (%ld)%s%s%s",
37730376bde1SSteven Rostedt (Red Hat) 			   ftrace_rec_count(rec),
3774f8b8be8aSMasami Hiramatsu 			   rec->flags & FTRACE_FL_REGS ? " R" : "  ",
3775763e34e7SSteven Rostedt (VMware) 			   rec->flags & FTRACE_FL_IPMODIFY ? " I" : "  ",
3776763e34e7SSteven Rostedt (VMware) 			   rec->flags & FTRACE_FL_DIRECT ? " D" : "  ");
37779674b2faSSteven Rostedt (Red Hat) 		if (rec->flags & FTRACE_FL_TRAMP_EN) {
37785fecaa04SSteven Rostedt (Red Hat) 			ops = ftrace_find_tramp_ops_any(rec);
377939daa7b9SSteven Rostedt (Red Hat) 			if (ops) {
378039daa7b9SSteven Rostedt (Red Hat) 				do {
378139daa7b9SSteven Rostedt (Red Hat) 					seq_printf(m, "\ttramp: %pS (%pS)",
378239daa7b9SSteven Rostedt (Red Hat) 						   (void *)ops->trampoline,
378339daa7b9SSteven Rostedt (Red Hat) 						   (void *)ops->func);
3784030f4e1cSSteven Rostedt (Red Hat) 					add_trampoline_func(m, ops, rec);
378539daa7b9SSteven Rostedt (Red Hat) 					ops = ftrace_find_tramp_ops_next(rec, ops);
378639daa7b9SSteven Rostedt (Red Hat) 				} while (ops);
378739daa7b9SSteven Rostedt (Red Hat) 			} else
3788fa6f0cc7SRasmus Villemoes 				seq_puts(m, "\ttramp: ERROR!");
3789030f4e1cSSteven Rostedt (Red Hat) 		} else {
3790030f4e1cSSteven Rostedt (Red Hat) 			add_trampoline_func(m, NULL, rec);
37919674b2faSSteven Rostedt (Red Hat) 		}
3792763e34e7SSteven Rostedt (VMware) 		if (rec->flags & FTRACE_FL_DIRECT) {
3793763e34e7SSteven Rostedt (VMware) 			unsigned long direct;
3794763e34e7SSteven Rostedt (VMware) 
3795ff205766SAlexei Starovoitov 			direct = ftrace_find_rec_direct(rec->ip);
3796763e34e7SSteven Rostedt (VMware) 			if (direct)
3797763e34e7SSteven Rostedt (VMware) 				seq_printf(m, "\n\tdirect-->%pS", (void *)direct);
3798763e34e7SSteven Rostedt (VMware) 		}
37999674b2faSSteven Rostedt (Red Hat) 	}
38009674b2faSSteven Rostedt (Red Hat) 
3801fa6f0cc7SRasmus Villemoes 	seq_putc(m, '\n');
38025072c59fSSteven Rostedt 
38035072c59fSSteven Rostedt 	return 0;
38045072c59fSSteven Rostedt }
38055072c59fSSteven Rostedt 
380688e9d34cSJames Morris static const struct seq_operations show_ftrace_seq_ops = {
38075072c59fSSteven Rostedt 	.start = t_start,
38085072c59fSSteven Rostedt 	.next = t_next,
38095072c59fSSteven Rostedt 	.stop = t_stop,
38105072c59fSSteven Rostedt 	.show = t_show,
38115072c59fSSteven Rostedt };
38125072c59fSSteven Rostedt 
3813e309b41dSIngo Molnar static int
38145072c59fSSteven Rostedt ftrace_avail_open(struct inode *inode, struct file *file)
38155072c59fSSteven Rostedt {
38165072c59fSSteven Rostedt 	struct ftrace_iterator *iter;
381717911ff3SSteven Rostedt (VMware) 	int ret;
381817911ff3SSteven Rostedt (VMware) 
381917911ff3SSteven Rostedt (VMware) 	ret = security_locked_down(LOCKDOWN_TRACEFS);
382017911ff3SSteven Rostedt (VMware) 	if (ret)
382117911ff3SSteven Rostedt (VMware) 		return ret;
38225072c59fSSteven Rostedt 
38234eebcc81SSteven Rostedt 	if (unlikely(ftrace_disabled))
38244eebcc81SSteven Rostedt 		return -ENODEV;
38254eebcc81SSteven Rostedt 
382650e18b94SJiri Olsa 	iter = __seq_open_private(file, &show_ftrace_seq_ops, sizeof(*iter));
3827c1bc5919SSteven Rostedt (VMware) 	if (!iter)
3828c1bc5919SSteven Rostedt (VMware) 		return -ENOMEM;
3829c1bc5919SSteven Rostedt (VMware) 
38305072c59fSSteven Rostedt 	iter->pg = ftrace_pages_start;
3831fc13cb0cSSteven Rostedt 	iter->ops = &global_ops;
38325072c59fSSteven Rostedt 
3833c1bc5919SSteven Rostedt (VMware) 	return 0;
38345072c59fSSteven Rostedt }
38355072c59fSSteven Rostedt 
3836647bcd03SSteven Rostedt static int
3837647bcd03SSteven Rostedt ftrace_enabled_open(struct inode *inode, struct file *file)
3838647bcd03SSteven Rostedt {
3839647bcd03SSteven Rostedt 	struct ftrace_iterator *iter;
3840647bcd03SSteven Rostedt 
384117911ff3SSteven Rostedt (VMware) 	/*
384217911ff3SSteven Rostedt (VMware) 	 * This shows us what functions are currently being
384317911ff3SSteven Rostedt (VMware) 	 * traced and by what. Not sure if we want lockdown
384417911ff3SSteven Rostedt (VMware) 	 * to hide such critical information for an admin.
384517911ff3SSteven Rostedt (VMware) 	 * Although, perhaps it can show information we don't
384617911ff3SSteven Rostedt (VMware) 	 * want people to see, but if something is tracing
384717911ff3SSteven Rostedt (VMware) 	 * something, we probably want to know about it.
384817911ff3SSteven Rostedt (VMware) 	 */
384917911ff3SSteven Rostedt (VMware) 
385050e18b94SJiri Olsa 	iter = __seq_open_private(file, &show_ftrace_seq_ops, sizeof(*iter));
3851c1bc5919SSteven Rostedt (VMware) 	if (!iter)
3852c1bc5919SSteven Rostedt (VMware) 		return -ENOMEM;
3853c1bc5919SSteven Rostedt (VMware) 
3854647bcd03SSteven Rostedt 	iter->pg = ftrace_pages_start;
3855647bcd03SSteven Rostedt 	iter->flags = FTRACE_ITER_ENABLED;
3856fc13cb0cSSteven Rostedt 	iter->ops = &global_ops;
3857647bcd03SSteven Rostedt 
3858c1bc5919SSteven Rostedt (VMware) 	return 0;
3859647bcd03SSteven Rostedt }
3860647bcd03SSteven Rostedt 
3861fc13cb0cSSteven Rostedt /**
3862fc13cb0cSSteven Rostedt  * ftrace_regex_open - initialize function tracer filter files
3863fc13cb0cSSteven Rostedt  * @ops: The ftrace_ops that hold the hash filters
3864fc13cb0cSSteven Rostedt  * @flag: The type of filter to process
3865fc13cb0cSSteven Rostedt  * @inode: The inode, usually passed in to your open routine
3866fc13cb0cSSteven Rostedt  * @file: The file, usually passed in to your open routine
3867fc13cb0cSSteven Rostedt  *
3868fc13cb0cSSteven Rostedt  * ftrace_regex_open() initializes the filter files for the
3869fc13cb0cSSteven Rostedt  * @ops. Depending on @flag it may process the filter hash or
3870fc13cb0cSSteven Rostedt  * the notrace hash of @ops. With this called from the open
3871fc13cb0cSSteven Rostedt  * routine, you can use ftrace_filter_write() for the write
3872fc13cb0cSSteven Rostedt  * routine if @flag has FTRACE_ITER_FILTER set, or
3873fc13cb0cSSteven Rostedt  * ftrace_notrace_write() if @flag has FTRACE_ITER_NOTRACE set.
3874098c879eSSteven Rostedt (Red Hat)  * tracing_lseek() should be used as the lseek routine, and
3875fc13cb0cSSteven Rostedt  * release must call ftrace_regex_release().
3876fc13cb0cSSteven Rostedt  */
3877fc13cb0cSSteven Rostedt int
3878f45948e8SSteven Rostedt ftrace_regex_open(struct ftrace_ops *ops, int flag,
38791cf41dd7SSteven Rostedt 		  struct inode *inode, struct file *file)
38805072c59fSSteven Rostedt {
38815072c59fSSteven Rostedt 	struct ftrace_iterator *iter;
3882f45948e8SSteven Rostedt 	struct ftrace_hash *hash;
3883673feb9dSSteven Rostedt (VMware) 	struct list_head *mod_head;
3884673feb9dSSteven Rostedt (VMware) 	struct trace_array *tr = ops->private;
38859ef16693SSteven Rostedt (VMware) 	int ret = -ENOMEM;
38865072c59fSSteven Rostedt 
3887f04f24fbSMasami Hiramatsu 	ftrace_ops_init(ops);
3888f04f24fbSMasami Hiramatsu 
38894eebcc81SSteven Rostedt 	if (unlikely(ftrace_disabled))
38904eebcc81SSteven Rostedt 		return -ENODEV;
38914eebcc81SSteven Rostedt 
38928530dec6SSteven Rostedt (VMware) 	if (tracing_check_open_get_tr(tr))
38939ef16693SSteven Rostedt (VMware) 		return -ENODEV;
38949ef16693SSteven Rostedt (VMware) 
38955072c59fSSteven Rostedt 	iter = kzalloc(sizeof(*iter), GFP_KERNEL);
38965072c59fSSteven Rostedt 	if (!iter)
38979ef16693SSteven Rostedt (VMware) 		goto out;
38985072c59fSSteven Rostedt 
38999ef16693SSteven Rostedt (VMware) 	if (trace_parser_get_init(&iter->parser, FTRACE_BUFF_MAX))
39009ef16693SSteven Rostedt (VMware) 		goto out;
3901689fd8b6S[email protected] 
39023f2367baSMasami Hiramatsu 	iter->ops = ops;
39033f2367baSMasami Hiramatsu 	iter->flags = flag;
39045985ea8bSSteven Rostedt (VMware) 	iter->tr = tr;
39053f2367baSMasami Hiramatsu 
390633b7f99cSSteven Rostedt (Red Hat) 	mutex_lock(&ops->func_hash->regex_lock);
39073f2367baSMasami Hiramatsu 
3908673feb9dSSteven Rostedt (VMware) 	if (flag & FTRACE_ITER_NOTRACE) {
390933b7f99cSSteven Rostedt (Red Hat) 		hash = ops->func_hash->notrace_hash;
39105985ea8bSSteven Rostedt (VMware) 		mod_head = tr ? &tr->mod_notrace : NULL;
3911673feb9dSSteven Rostedt (VMware) 	} else {
391233b7f99cSSteven Rostedt (Red Hat) 		hash = ops->func_hash->filter_hash;
39135985ea8bSSteven Rostedt (VMware) 		mod_head = tr ? &tr->mod_trace : NULL;
3914673feb9dSSteven Rostedt (VMware) 	}
3915f45948e8SSteven Rostedt 
39165985ea8bSSteven Rostedt (VMware) 	iter->mod_list = mod_head;
39175985ea8bSSteven Rostedt (VMware) 
391833dc9b12SSteven Rostedt 	if (file->f_mode & FMODE_WRITE) {
3919ef2fbe16SNamhyung Kim 		const int size_bits = FTRACE_HASH_DEFAULT_BITS;
3920ef2fbe16SNamhyung Kim 
3921673feb9dSSteven Rostedt (VMware) 		if (file->f_flags & O_TRUNC) {
3922ef2fbe16SNamhyung Kim 			iter->hash = alloc_ftrace_hash(size_bits);
3923673feb9dSSteven Rostedt (VMware) 			clear_ftrace_mod_list(mod_head);
3924673feb9dSSteven Rostedt (VMware) 	        } else {
3925ef2fbe16SNamhyung Kim 			iter->hash = alloc_and_copy_ftrace_hash(size_bits, hash);
3926673feb9dSSteven Rostedt (VMware) 		}
3927ef2fbe16SNamhyung Kim 
392833dc9b12SSteven Rostedt 		if (!iter->hash) {
392933dc9b12SSteven Rostedt 			trace_parser_put(&iter->parser);
39303f2367baSMasami Hiramatsu 			goto out_unlock;
393133dc9b12SSteven Rostedt 		}
3932c20489daSSteven Rostedt (VMware) 	} else
3933c20489daSSteven Rostedt (VMware) 		iter->hash = hash;
39341cf41dd7SSteven Rostedt 
39359ef16693SSteven Rostedt (VMware) 	ret = 0;
39369ef16693SSteven Rostedt (VMware) 
39375072c59fSSteven Rostedt 	if (file->f_mode & FMODE_READ) {
39385072c59fSSteven Rostedt 		iter->pg = ftrace_pages_start;
39395072c59fSSteven Rostedt 
39405072c59fSSteven Rostedt 		ret = seq_open(file, &show_ftrace_seq_ops);
39415072c59fSSteven Rostedt 		if (!ret) {
39425072c59fSSteven Rostedt 			struct seq_file *m = file->private_data;
39435072c59fSSteven Rostedt 			m->private = iter;
394479fe249cSLi Zefan 		} else {
394533dc9b12SSteven Rostedt 			/* Failed */
394633dc9b12SSteven Rostedt 			free_ftrace_hash(iter->hash);
394779fe249cSLi Zefan 			trace_parser_put(&iter->parser);
394879fe249cSLi Zefan 		}
39495072c59fSSteven Rostedt 	} else
39505072c59fSSteven Rostedt 		file->private_data = iter;
39513f2367baSMasami Hiramatsu 
39523f2367baSMasami Hiramatsu  out_unlock:
395333b7f99cSSteven Rostedt (Red Hat) 	mutex_unlock(&ops->func_hash->regex_lock);
39545072c59fSSteven Rostedt 
39559ef16693SSteven Rostedt (VMware)  out:
39569ef16693SSteven Rostedt (VMware) 	if (ret) {
39579ef16693SSteven Rostedt (VMware) 		kfree(iter);
39589ef16693SSteven Rostedt (VMware) 		if (tr)
39599ef16693SSteven Rostedt (VMware) 			trace_array_put(tr);
39609ef16693SSteven Rostedt (VMware) 	}
39619ef16693SSteven Rostedt (VMware) 
39625072c59fSSteven Rostedt 	return ret;
39635072c59fSSteven Rostedt }
39645072c59fSSteven Rostedt 
396541c52c0dSSteven Rostedt static int
396641c52c0dSSteven Rostedt ftrace_filter_open(struct inode *inode, struct file *file)
396741c52c0dSSteven Rostedt {
3968e3b3e2e8SSteven Rostedt (Red Hat) 	struct ftrace_ops *ops = inode->i_private;
3969e3b3e2e8SSteven Rostedt (Red Hat) 
397017911ff3SSteven Rostedt (VMware) 	/* Checks for tracefs lockdown */
3971e3b3e2e8SSteven Rostedt (Red Hat) 	return ftrace_regex_open(ops,
3972eee8ded1SSteven Rostedt (VMware) 			FTRACE_ITER_FILTER | FTRACE_ITER_DO_PROBES,
39731cf41dd7SSteven Rostedt 			inode, file);
397441c52c0dSSteven Rostedt }
397541c52c0dSSteven Rostedt 
397641c52c0dSSteven Rostedt static int
397741c52c0dSSteven Rostedt ftrace_notrace_open(struct inode *inode, struct file *file)
397841c52c0dSSteven Rostedt {
3979e3b3e2e8SSteven Rostedt (Red Hat) 	struct ftrace_ops *ops = inode->i_private;
3980e3b3e2e8SSteven Rostedt (Red Hat) 
398117911ff3SSteven Rostedt (VMware) 	/* Checks for tracefs lockdown */
3982e3b3e2e8SSteven Rostedt (Red Hat) 	return ftrace_regex_open(ops, FTRACE_ITER_NOTRACE,
39831cf41dd7SSteven Rostedt 				 inode, file);
398441c52c0dSSteven Rostedt }
398541c52c0dSSteven Rostedt 
39863ba00929SDmitry Safonov /* Type for quick search ftrace basic regexes (globs) from filter_parse_regex */
39873ba00929SDmitry Safonov struct ftrace_glob {
39883ba00929SDmitry Safonov 	char *search;
39893ba00929SDmitry Safonov 	unsigned len;
39903ba00929SDmitry Safonov 	int type;
39913ba00929SDmitry Safonov };
39923ba00929SDmitry Safonov 
39937132e2d6SThiago Jung Bauermann /*
39947132e2d6SThiago Jung Bauermann  * If symbols in an architecture don't correspond exactly to the user-visible
39957132e2d6SThiago Jung Bauermann  * name of what they represent, it is possible to define this function to
39967132e2d6SThiago Jung Bauermann  * perform the necessary adjustments.
39977132e2d6SThiago Jung Bauermann */
39987132e2d6SThiago Jung Bauermann char * __weak arch_ftrace_match_adjust(char *str, const char *search)
39997132e2d6SThiago Jung Bauermann {
40007132e2d6SThiago Jung Bauermann 	return str;
40017132e2d6SThiago Jung Bauermann }
40027132e2d6SThiago Jung Bauermann 
40033ba00929SDmitry Safonov static int ftrace_match(char *str, struct ftrace_glob *g)
40049f4801e3SSteven Rostedt {
40059f4801e3SSteven Rostedt 	int matched = 0;
4006751e9983SLi Zefan 	int slen;
40079f4801e3SSteven Rostedt 
40087132e2d6SThiago Jung Bauermann 	str = arch_ftrace_match_adjust(str, g->search);
40097132e2d6SThiago Jung Bauermann 
40103ba00929SDmitry Safonov 	switch (g->type) {
40119f4801e3SSteven Rostedt 	case MATCH_FULL:
40123ba00929SDmitry Safonov 		if (strcmp(str, g->search) == 0)
40139f4801e3SSteven Rostedt 			matched = 1;
40149f4801e3SSteven Rostedt 		break;
40159f4801e3SSteven Rostedt 	case MATCH_FRONT_ONLY:
40163ba00929SDmitry Safonov 		if (strncmp(str, g->search, g->len) == 0)
40179f4801e3SSteven Rostedt 			matched = 1;
40189f4801e3SSteven Rostedt 		break;
40199f4801e3SSteven Rostedt 	case MATCH_MIDDLE_ONLY:
40203ba00929SDmitry Safonov 		if (strstr(str, g->search))
40219f4801e3SSteven Rostedt 			matched = 1;
40229f4801e3SSteven Rostedt 		break;
40239f4801e3SSteven Rostedt 	case MATCH_END_ONLY:
4024751e9983SLi Zefan 		slen = strlen(str);
40253ba00929SDmitry Safonov 		if (slen >= g->len &&
40263ba00929SDmitry Safonov 		    memcmp(str + slen - g->len, g->search, g->len) == 0)
40279f4801e3SSteven Rostedt 			matched = 1;
40289f4801e3SSteven Rostedt 		break;
402960f1d5e3SMasami Hiramatsu 	case MATCH_GLOB:
403060f1d5e3SMasami Hiramatsu 		if (glob_match(g->search, str))
403160f1d5e3SMasami Hiramatsu 			matched = 1;
403260f1d5e3SMasami Hiramatsu 		break;
40339f4801e3SSteven Rostedt 	}
40349f4801e3SSteven Rostedt 
40359f4801e3SSteven Rostedt 	return matched;
40369f4801e3SSteven Rostedt }
40379f4801e3SSteven Rostedt 
4038b448c4e3SSteven Rostedt static int
4039f0a3b154SDmitry Safonov enter_record(struct ftrace_hash *hash, struct dyn_ftrace *rec, int clear_filter)
404064e7c440SSteven Rostedt {
4041b448c4e3SSteven Rostedt 	struct ftrace_func_entry *entry;
4042b448c4e3SSteven Rostedt 	int ret = 0;
4043b448c4e3SSteven Rostedt 
40441cf41dd7SSteven Rostedt 	entry = ftrace_lookup_ip(hash, rec->ip);
4045f0a3b154SDmitry Safonov 	if (clear_filter) {
4046b448c4e3SSteven Rostedt 		/* Do nothing if it doesn't exist */
4047b448c4e3SSteven Rostedt 		if (!entry)
4048b448c4e3SSteven Rostedt 			return 0;
4049b448c4e3SSteven Rostedt 
405033dc9b12SSteven Rostedt 		free_hash_entry(hash, entry);
4051b448c4e3SSteven Rostedt 	} else {
4052b448c4e3SSteven Rostedt 		/* Do nothing if it exists */
4053b448c4e3SSteven Rostedt 		if (entry)
4054b448c4e3SSteven Rostedt 			return 0;
4055b448c4e3SSteven Rostedt 
4056b448c4e3SSteven Rostedt 		ret = add_hash_entry(hash, rec->ip);
4057b448c4e3SSteven Rostedt 	}
4058b448c4e3SSteven Rostedt 	return ret;
4059996e87beSSteven Rostedt }
4060996e87beSSteven Rostedt 
406164e7c440SSteven Rostedt static int
4062f79b3f33SSteven Rostedt (VMware) add_rec_by_index(struct ftrace_hash *hash, struct ftrace_glob *func_g,
4063f79b3f33SSteven Rostedt (VMware) 		 int clear_filter)
4064f79b3f33SSteven Rostedt (VMware) {
4065f79b3f33SSteven Rostedt (VMware) 	long index = simple_strtoul(func_g->search, NULL, 0);
4066f79b3f33SSteven Rostedt (VMware) 	struct ftrace_page *pg;
4067f79b3f33SSteven Rostedt (VMware) 	struct dyn_ftrace *rec;
4068f79b3f33SSteven Rostedt (VMware) 
4069f79b3f33SSteven Rostedt (VMware) 	/* The index starts at 1 */
4070f79b3f33SSteven Rostedt (VMware) 	if (--index < 0)
4071f79b3f33SSteven Rostedt (VMware) 		return 0;
4072f79b3f33SSteven Rostedt (VMware) 
4073f79b3f33SSteven Rostedt (VMware) 	do_for_each_ftrace_rec(pg, rec) {
4074f79b3f33SSteven Rostedt (VMware) 		if (pg->index <= index) {
4075f79b3f33SSteven Rostedt (VMware) 			index -= pg->index;
4076f79b3f33SSteven Rostedt (VMware) 			/* this is a double loop, break goes to the next page */
4077f79b3f33SSteven Rostedt (VMware) 			break;
4078f79b3f33SSteven Rostedt (VMware) 		}
4079f79b3f33SSteven Rostedt (VMware) 		rec = &pg->records[index];
4080f79b3f33SSteven Rostedt (VMware) 		enter_record(hash, rec, clear_filter);
4081f79b3f33SSteven Rostedt (VMware) 		return 1;
4082f79b3f33SSteven Rostedt (VMware) 	} while_for_each_ftrace_rec();
4083f79b3f33SSteven Rostedt (VMware) 	return 0;
4084f79b3f33SSteven Rostedt (VMware) }
4085f79b3f33SSteven Rostedt (VMware) 
4086b39181f7SSteven Rostedt (Google) #ifdef FTRACE_MCOUNT_MAX_OFFSET
4087b39181f7SSteven Rostedt (Google) static int lookup_ip(unsigned long ip, char **modname, char *str)
4088b39181f7SSteven Rostedt (Google) {
4089b39181f7SSteven Rostedt (Google) 	unsigned long offset;
4090b39181f7SSteven Rostedt (Google) 
4091b39181f7SSteven Rostedt (Google) 	kallsyms_lookup(ip, NULL, &offset, modname, str);
4092b39181f7SSteven Rostedt (Google) 	if (offset > FTRACE_MCOUNT_MAX_OFFSET)
4093b39181f7SSteven Rostedt (Google) 		return -1;
4094b39181f7SSteven Rostedt (Google) 	return 0;
4095b39181f7SSteven Rostedt (Google) }
4096b39181f7SSteven Rostedt (Google) #else
4097b39181f7SSteven Rostedt (Google) static int lookup_ip(unsigned long ip, char **modname, char *str)
4098b39181f7SSteven Rostedt (Google) {
4099b39181f7SSteven Rostedt (Google) 	kallsyms_lookup(ip, NULL, NULL, modname, str);
4100b39181f7SSteven Rostedt (Google) 	return 0;
4101b39181f7SSteven Rostedt (Google) }
4102b39181f7SSteven Rostedt (Google) #endif
4103b39181f7SSteven Rostedt (Google) 
4104f79b3f33SSteven Rostedt (VMware) static int
41050b507e1eSDmitry Safonov ftrace_match_record(struct dyn_ftrace *rec, struct ftrace_glob *func_g,
41060b507e1eSDmitry Safonov 		struct ftrace_glob *mod_g, int exclude_mod)
410764e7c440SSteven Rostedt {
410864e7c440SSteven Rostedt 	char str[KSYM_SYMBOL_LEN];
4109b9df92d2SSteven Rostedt 	char *modname;
411064e7c440SSteven Rostedt 
4111b39181f7SSteven Rostedt (Google) 	if (lookup_ip(rec->ip, &modname, str)) {
4112b39181f7SSteven Rostedt (Google) 		/* This should only happen when a rec is disabled */
4113b39181f7SSteven Rostedt (Google) 		WARN_ON_ONCE(system_state == SYSTEM_RUNNING &&
4114b39181f7SSteven Rostedt (Google) 			     !(rec->flags & FTRACE_FL_DISABLED));
4115b39181f7SSteven Rostedt (Google) 		return 0;
4116b39181f7SSteven Rostedt (Google) 	}
4117b9df92d2SSteven Rostedt 
41180b507e1eSDmitry Safonov 	if (mod_g) {
41190b507e1eSDmitry Safonov 		int mod_matches = (modname) ? ftrace_match(modname, mod_g) : 0;
41200b507e1eSDmitry Safonov 
41210b507e1eSDmitry Safonov 		/* blank module name to match all modules */
41220b507e1eSDmitry Safonov 		if (!mod_g->len) {
41230b507e1eSDmitry Safonov 			/* blank module globbing: modname xor exclude_mod */
412477c0eddeSSteven Rostedt (VMware) 			if (!exclude_mod != !modname)
41250b507e1eSDmitry Safonov 				goto func_match;
41260b507e1eSDmitry Safonov 			return 0;
41270b507e1eSDmitry Safonov 		}
41280b507e1eSDmitry Safonov 
412977c0eddeSSteven Rostedt (VMware) 		/*
413077c0eddeSSteven Rostedt (VMware) 		 * exclude_mod is set to trace everything but the given
413177c0eddeSSteven Rostedt (VMware) 		 * module. If it is set and the module matches, then
413277c0eddeSSteven Rostedt (VMware) 		 * return 0. If it is not set, and the module doesn't match
413377c0eddeSSteven Rostedt (VMware) 		 * also return 0. Otherwise, check the function to see if
413477c0eddeSSteven Rostedt (VMware) 		 * that matches.
413577c0eddeSSteven Rostedt (VMware) 		 */
413677c0eddeSSteven Rostedt (VMware) 		if (!mod_matches == !exclude_mod)
41370b507e1eSDmitry Safonov 			return 0;
41380b507e1eSDmitry Safonov func_match:
4139b9df92d2SSteven Rostedt 		/* blank search means to match all funcs in the mod */
41403ba00929SDmitry Safonov 		if (!func_g->len)
4141b9df92d2SSteven Rostedt 			return 1;
4142b9df92d2SSteven Rostedt 	}
4143b9df92d2SSteven Rostedt 
41443ba00929SDmitry Safonov 	return ftrace_match(str, func_g);
414564e7c440SSteven Rostedt }
414664e7c440SSteven Rostedt 
41471cf41dd7SSteven Rostedt static int
41483ba00929SDmitry Safonov match_records(struct ftrace_hash *hash, char *func, int len, char *mod)
41499f4801e3SSteven Rostedt {
41509f4801e3SSteven Rostedt 	struct ftrace_page *pg;
41519f4801e3SSteven Rostedt 	struct dyn_ftrace *rec;
41523ba00929SDmitry Safonov 	struct ftrace_glob func_g = { .type = MATCH_FULL };
41530b507e1eSDmitry Safonov 	struct ftrace_glob mod_g = { .type = MATCH_FULL };
41540b507e1eSDmitry Safonov 	struct ftrace_glob *mod_match = (mod) ? &mod_g : NULL;
41550b507e1eSDmitry Safonov 	int exclude_mod = 0;
4156311d16daSLi Zefan 	int found = 0;
4157b448c4e3SSteven Rostedt 	int ret;
41582e028c4fSDan Carpenter 	int clear_filter = 0;
41599f4801e3SSteven Rostedt 
41600b507e1eSDmitry Safonov 	if (func) {
41613ba00929SDmitry Safonov 		func_g.type = filter_parse_regex(func, len, &func_g.search,
41623ba00929SDmitry Safonov 						 &clear_filter);
41633ba00929SDmitry Safonov 		func_g.len = strlen(func_g.search);
4164b9df92d2SSteven Rostedt 	}
4165b9df92d2SSteven Rostedt 
41660b507e1eSDmitry Safonov 	if (mod) {
41670b507e1eSDmitry Safonov 		mod_g.type = filter_parse_regex(mod, strlen(mod),
41680b507e1eSDmitry Safonov 				&mod_g.search, &exclude_mod);
41690b507e1eSDmitry Safonov 		mod_g.len = strlen(mod_g.search);
4170b9df92d2SSteven Rostedt 	}
4171b9df92d2SSteven Rostedt 
417252baf119SSteven Rostedt 	mutex_lock(&ftrace_lock);
4173b9df92d2SSteven Rostedt 
4174b9df92d2SSteven Rostedt 	if (unlikely(ftrace_disabled))
4175b9df92d2SSteven Rostedt 		goto out_unlock;
4176b9df92d2SSteven Rostedt 
4177f79b3f33SSteven Rostedt (VMware) 	if (func_g.type == MATCH_INDEX) {
4178f79b3f33SSteven Rostedt (VMware) 		found = add_rec_by_index(hash, &func_g, clear_filter);
4179f79b3f33SSteven Rostedt (VMware) 		goto out_unlock;
4180f79b3f33SSteven Rostedt (VMware) 	}
4181f79b3f33SSteven Rostedt (VMware) 
4182265c831cSSteven Rostedt 	do_for_each_ftrace_rec(pg, rec) {
4183546fece4SSteven Rostedt (Red Hat) 
4184546fece4SSteven Rostedt (Red Hat) 		if (rec->flags & FTRACE_FL_DISABLED)
4185546fece4SSteven Rostedt (Red Hat) 			continue;
4186546fece4SSteven Rostedt (Red Hat) 
41870b507e1eSDmitry Safonov 		if (ftrace_match_record(rec, &func_g, mod_match, exclude_mod)) {
4188f0a3b154SDmitry Safonov 			ret = enter_record(hash, rec, clear_filter);
4189b448c4e3SSteven Rostedt 			if (ret < 0) {
4190b448c4e3SSteven Rostedt 				found = ret;
4191b448c4e3SSteven Rostedt 				goto out_unlock;
4192b448c4e3SSteven Rostedt 			}
4193311d16daSLi Zefan 			found = 1;
41945072c59fSSteven Rostedt 		}
4195265c831cSSteven Rostedt 	} while_for_each_ftrace_rec();
4196b9df92d2SSteven Rostedt  out_unlock:
419752baf119SSteven Rostedt 	mutex_unlock(&ftrace_lock);
4198311d16daSLi Zefan 
4199311d16daSLi Zefan 	return found;
42005072c59fSSteven Rostedt }
42015072c59fSSteven Rostedt 
420264e7c440SSteven Rostedt static int
42031cf41dd7SSteven Rostedt ftrace_match_records(struct ftrace_hash *hash, char *buff, int len)
420464e7c440SSteven Rostedt {
4205f0a3b154SDmitry Safonov 	return match_records(hash, buff, len, NULL);
420664e7c440SSteven Rostedt }
420764e7c440SSteven Rostedt 
4208e16b35ddSSteven Rostedt (VMware) static void ftrace_ops_update_code(struct ftrace_ops *ops,
4209e16b35ddSSteven Rostedt (VMware) 				   struct ftrace_ops_hash *old_hash)
4210e16b35ddSSteven Rostedt (VMware) {
4211e16b35ddSSteven Rostedt (VMware) 	struct ftrace_ops *op;
4212e16b35ddSSteven Rostedt (VMware) 
4213e16b35ddSSteven Rostedt (VMware) 	if (!ftrace_enabled)
4214e16b35ddSSteven Rostedt (VMware) 		return;
4215e16b35ddSSteven Rostedt (VMware) 
4216e16b35ddSSteven Rostedt (VMware) 	if (ops->flags & FTRACE_OPS_FL_ENABLED) {
4217e16b35ddSSteven Rostedt (VMware) 		ftrace_run_modify_code(ops, FTRACE_UPDATE_CALLS, old_hash);
4218e16b35ddSSteven Rostedt (VMware) 		return;
4219e16b35ddSSteven Rostedt (VMware) 	}
4220e16b35ddSSteven Rostedt (VMware) 
4221e16b35ddSSteven Rostedt (VMware) 	/*
4222e16b35ddSSteven Rostedt (VMware) 	 * If this is the shared global_ops filter, then we need to
4223e16b35ddSSteven Rostedt (VMware) 	 * check if there is another ops that shares it, is enabled.
4224e16b35ddSSteven Rostedt (VMware) 	 * If so, we still need to run the modify code.
4225e16b35ddSSteven Rostedt (VMware) 	 */
4226e16b35ddSSteven Rostedt (VMware) 	if (ops->func_hash != &global_ops.local_hash)
4227e16b35ddSSteven Rostedt (VMware) 		return;
4228e16b35ddSSteven Rostedt (VMware) 
4229e16b35ddSSteven Rostedt (VMware) 	do_for_each_ftrace_op(op, ftrace_ops_list) {
4230e16b35ddSSteven Rostedt (VMware) 		if (op->func_hash == &global_ops.local_hash &&
4231e16b35ddSSteven Rostedt (VMware) 		    op->flags & FTRACE_OPS_FL_ENABLED) {
4232e16b35ddSSteven Rostedt (VMware) 			ftrace_run_modify_code(op, FTRACE_UPDATE_CALLS, old_hash);
4233e16b35ddSSteven Rostedt (VMware) 			/* Only need to do this once */
4234e16b35ddSSteven Rostedt (VMware) 			return;
4235e16b35ddSSteven Rostedt (VMware) 		}
4236e16b35ddSSteven Rostedt (VMware) 	} while_for_each_ftrace_op(op);
4237e16b35ddSSteven Rostedt (VMware) }
4238e16b35ddSSteven Rostedt (VMware) 
4239e16b35ddSSteven Rostedt (VMware) static int ftrace_hash_move_and_update_ops(struct ftrace_ops *ops,
4240e16b35ddSSteven Rostedt (VMware) 					   struct ftrace_hash **orig_hash,
4241e16b35ddSSteven Rostedt (VMware) 					   struct ftrace_hash *hash,
4242e16b35ddSSteven Rostedt (VMware) 					   int enable)
4243e16b35ddSSteven Rostedt (VMware) {
4244e16b35ddSSteven Rostedt (VMware) 	struct ftrace_ops_hash old_hash_ops;
4245e16b35ddSSteven Rostedt (VMware) 	struct ftrace_hash *old_hash;
4246e16b35ddSSteven Rostedt (VMware) 	int ret;
4247e16b35ddSSteven Rostedt (VMware) 
4248e16b35ddSSteven Rostedt (VMware) 	old_hash = *orig_hash;
4249e16b35ddSSteven Rostedt (VMware) 	old_hash_ops.filter_hash = ops->func_hash->filter_hash;
4250e16b35ddSSteven Rostedt (VMware) 	old_hash_ops.notrace_hash = ops->func_hash->notrace_hash;
4251e16b35ddSSteven Rostedt (VMware) 	ret = ftrace_hash_move(ops, enable, orig_hash, hash);
4252e16b35ddSSteven Rostedt (VMware) 	if (!ret) {
4253e16b35ddSSteven Rostedt (VMware) 		ftrace_ops_update_code(ops, &old_hash_ops);
4254e16b35ddSSteven Rostedt (VMware) 		free_ftrace_hash_rcu(old_hash);
4255e16b35ddSSteven Rostedt (VMware) 	}
4256e16b35ddSSteven Rostedt (VMware) 	return ret;
4257e16b35ddSSteven Rostedt (VMware) }
425864e7c440SSteven Rostedt 
4259673feb9dSSteven Rostedt (VMware) static bool module_exists(const char *module)
4260673feb9dSSteven Rostedt (VMware) {
4261673feb9dSSteven Rostedt (VMware) 	/* All modules have the symbol __this_module */
42620f5e5a3aSRasmus Villemoes 	static const char this_mod[] = "__this_module";
4263419e9fe5SSalvatore Mesoraca 	char modname[MAX_PARAM_PREFIX_LEN + sizeof(this_mod) + 2];
4264673feb9dSSteven Rostedt (VMware) 	unsigned long val;
4265673feb9dSSteven Rostedt (VMware) 	int n;
4266673feb9dSSteven Rostedt (VMware) 
4267419e9fe5SSalvatore Mesoraca 	n = snprintf(modname, sizeof(modname), "%s:%s", module, this_mod);
4268673feb9dSSteven Rostedt (VMware) 
4269419e9fe5SSalvatore Mesoraca 	if (n > sizeof(modname) - 1)
4270673feb9dSSteven Rostedt (VMware) 		return false;
4271673feb9dSSteven Rostedt (VMware) 
4272673feb9dSSteven Rostedt (VMware) 	val = module_kallsyms_lookup_name(modname);
4273673feb9dSSteven Rostedt (VMware) 	return val != 0;
4274673feb9dSSteven Rostedt (VMware) }
4275673feb9dSSteven Rostedt (VMware) 
4276673feb9dSSteven Rostedt (VMware) static int cache_mod(struct trace_array *tr,
4277673feb9dSSteven Rostedt (VMware) 		     const char *func, char *module, int enable)
4278673feb9dSSteven Rostedt (VMware) {
4279673feb9dSSteven Rostedt (VMware) 	struct ftrace_mod_load *ftrace_mod, *n;
4280673feb9dSSteven Rostedt (VMware) 	struct list_head *head = enable ? &tr->mod_trace : &tr->mod_notrace;
4281673feb9dSSteven Rostedt (VMware) 	int ret;
4282673feb9dSSteven Rostedt (VMware) 
4283673feb9dSSteven Rostedt (VMware) 	mutex_lock(&ftrace_lock);
4284673feb9dSSteven Rostedt (VMware) 
4285673feb9dSSteven Rostedt (VMware) 	/* We do not cache inverse filters */
4286673feb9dSSteven Rostedt (VMware) 	if (func[0] == '!') {
4287673feb9dSSteven Rostedt (VMware) 		func++;
4288673feb9dSSteven Rostedt (VMware) 		ret = -EINVAL;
4289673feb9dSSteven Rostedt (VMware) 
4290673feb9dSSteven Rostedt (VMware) 		/* Look to remove this hash */
4291673feb9dSSteven Rostedt (VMware) 		list_for_each_entry_safe(ftrace_mod, n, head, list) {
4292673feb9dSSteven Rostedt (VMware) 			if (strcmp(ftrace_mod->module, module) != 0)
4293673feb9dSSteven Rostedt (VMware) 				continue;
4294673feb9dSSteven Rostedt (VMware) 
4295673feb9dSSteven Rostedt (VMware) 			/* no func matches all */
429644925dffSDan Carpenter 			if (strcmp(func, "*") == 0 ||
4297673feb9dSSteven Rostedt (VMware) 			    (ftrace_mod->func &&
4298673feb9dSSteven Rostedt (VMware) 			     strcmp(ftrace_mod->func, func) == 0)) {
4299673feb9dSSteven Rostedt (VMware) 				ret = 0;
4300673feb9dSSteven Rostedt (VMware) 				free_ftrace_mod(ftrace_mod);
4301673feb9dSSteven Rostedt (VMware) 				continue;
4302673feb9dSSteven Rostedt (VMware) 			}
4303673feb9dSSteven Rostedt (VMware) 		}
4304673feb9dSSteven Rostedt (VMware) 		goto out;
4305673feb9dSSteven Rostedt (VMware) 	}
4306673feb9dSSteven Rostedt (VMware) 
4307673feb9dSSteven Rostedt (VMware) 	ret = -EINVAL;
4308673feb9dSSteven Rostedt (VMware) 	/* We only care about modules that have not been loaded yet */
4309673feb9dSSteven Rostedt (VMware) 	if (module_exists(module))
4310673feb9dSSteven Rostedt (VMware) 		goto out;
4311673feb9dSSteven Rostedt (VMware) 
4312673feb9dSSteven Rostedt (VMware) 	/* Save this string off, and execute it when the module is loaded */
4313673feb9dSSteven Rostedt (VMware) 	ret = ftrace_add_mod(tr, func, module, enable);
4314673feb9dSSteven Rostedt (VMware)  out:
4315673feb9dSSteven Rostedt (VMware) 	mutex_unlock(&ftrace_lock);
4316673feb9dSSteven Rostedt (VMware) 
4317673feb9dSSteven Rostedt (VMware) 	return ret;
4318673feb9dSSteven Rostedt (VMware) }
4319673feb9dSSteven Rostedt (VMware) 
4320d7fbf8dfSSteven Rostedt (VMware) static int
4321d7fbf8dfSSteven Rostedt (VMware) ftrace_set_regex(struct ftrace_ops *ops, unsigned char *buf, int len,
4322d7fbf8dfSSteven Rostedt (VMware) 		 int reset, int enable);
4323d7fbf8dfSSteven Rostedt (VMware) 
432469449bbdSArnd Bergmann #ifdef CONFIG_MODULES
4325d7fbf8dfSSteven Rostedt (VMware) static void process_mod_list(struct list_head *head, struct ftrace_ops *ops,
4326d7fbf8dfSSteven Rostedt (VMware) 			     char *mod, bool enable)
4327d7fbf8dfSSteven Rostedt (VMware) {
4328d7fbf8dfSSteven Rostedt (VMware) 	struct ftrace_mod_load *ftrace_mod, *n;
4329d7fbf8dfSSteven Rostedt (VMware) 	struct ftrace_hash **orig_hash, *new_hash;
4330d7fbf8dfSSteven Rostedt (VMware) 	LIST_HEAD(process_mods);
4331d7fbf8dfSSteven Rostedt (VMware) 	char *func;
4332d7fbf8dfSSteven Rostedt (VMware) 
4333d7fbf8dfSSteven Rostedt (VMware) 	mutex_lock(&ops->func_hash->regex_lock);
4334d7fbf8dfSSteven Rostedt (VMware) 
4335d7fbf8dfSSteven Rostedt (VMware) 	if (enable)
4336d7fbf8dfSSteven Rostedt (VMware) 		orig_hash = &ops->func_hash->filter_hash;
4337d7fbf8dfSSteven Rostedt (VMware) 	else
4338d7fbf8dfSSteven Rostedt (VMware) 		orig_hash = &ops->func_hash->notrace_hash;
4339d7fbf8dfSSteven Rostedt (VMware) 
4340d7fbf8dfSSteven Rostedt (VMware) 	new_hash = alloc_and_copy_ftrace_hash(FTRACE_HASH_DEFAULT_BITS,
4341d7fbf8dfSSteven Rostedt (VMware) 					      *orig_hash);
4342d7fbf8dfSSteven Rostedt (VMware) 	if (!new_hash)
43433b58a3c7SSteven Rostedt (VMware) 		goto out; /* warn? */
4344d7fbf8dfSSteven Rostedt (VMware) 
4345d7fbf8dfSSteven Rostedt (VMware) 	mutex_lock(&ftrace_lock);
4346d7fbf8dfSSteven Rostedt (VMware) 
4347d7fbf8dfSSteven Rostedt (VMware) 	list_for_each_entry_safe(ftrace_mod, n, head, list) {
4348d7fbf8dfSSteven Rostedt (VMware) 
4349d7fbf8dfSSteven Rostedt (VMware) 		if (strcmp(ftrace_mod->module, mod) != 0)
4350d7fbf8dfSSteven Rostedt (VMware) 			continue;
4351d7fbf8dfSSteven Rostedt (VMware) 
4352d7fbf8dfSSteven Rostedt (VMware) 		if (ftrace_mod->func)
4353d7fbf8dfSSteven Rostedt (VMware) 			func = kstrdup(ftrace_mod->func, GFP_KERNEL);
4354d7fbf8dfSSteven Rostedt (VMware) 		else
4355d7fbf8dfSSteven Rostedt (VMware) 			func = kstrdup("*", GFP_KERNEL);
4356d7fbf8dfSSteven Rostedt (VMware) 
4357d7fbf8dfSSteven Rostedt (VMware) 		if (!func) /* warn? */
4358d7fbf8dfSSteven Rostedt (VMware) 			continue;
4359d7fbf8dfSSteven Rostedt (VMware) 
43603ecda644SBaokun Li 		list_move(&ftrace_mod->list, &process_mods);
4361d7fbf8dfSSteven Rostedt (VMware) 
4362d7fbf8dfSSteven Rostedt (VMware) 		/* Use the newly allocated func, as it may be "*" */
4363d7fbf8dfSSteven Rostedt (VMware) 		kfree(ftrace_mod->func);
4364d7fbf8dfSSteven Rostedt (VMware) 		ftrace_mod->func = func;
4365d7fbf8dfSSteven Rostedt (VMware) 	}
4366d7fbf8dfSSteven Rostedt (VMware) 
4367d7fbf8dfSSteven Rostedt (VMware) 	mutex_unlock(&ftrace_lock);
4368d7fbf8dfSSteven Rostedt (VMware) 
4369d7fbf8dfSSteven Rostedt (VMware) 	list_for_each_entry_safe(ftrace_mod, n, &process_mods, list) {
4370d7fbf8dfSSteven Rostedt (VMware) 
4371d7fbf8dfSSteven Rostedt (VMware) 		func = ftrace_mod->func;
4372d7fbf8dfSSteven Rostedt (VMware) 
4373d7fbf8dfSSteven Rostedt (VMware) 		/* Grabs ftrace_lock, which is why we have this extra step */
4374d7fbf8dfSSteven Rostedt (VMware) 		match_records(new_hash, func, strlen(func), mod);
4375d7fbf8dfSSteven Rostedt (VMware) 		free_ftrace_mod(ftrace_mod);
4376d7fbf8dfSSteven Rostedt (VMware) 	}
4377d7fbf8dfSSteven Rostedt (VMware) 
43788c08f0d5SSteven Rostedt (VMware) 	if (enable && list_empty(head))
43798c08f0d5SSteven Rostedt (VMware) 		new_hash->flags &= ~FTRACE_HASH_FL_MOD;
43808c08f0d5SSteven Rostedt (VMware) 
4381d7fbf8dfSSteven Rostedt (VMware) 	mutex_lock(&ftrace_lock);
4382d7fbf8dfSSteven Rostedt (VMware) 
4383045e269cSAlex Shi 	ftrace_hash_move_and_update_ops(ops, orig_hash,
4384d7fbf8dfSSteven Rostedt (VMware) 					      new_hash, enable);
4385d7fbf8dfSSteven Rostedt (VMware) 	mutex_unlock(&ftrace_lock);
4386d7fbf8dfSSteven Rostedt (VMware) 
43873b58a3c7SSteven Rostedt (VMware)  out:
4388d7fbf8dfSSteven Rostedt (VMware) 	mutex_unlock(&ops->func_hash->regex_lock);
4389d7fbf8dfSSteven Rostedt (VMware) 
4390d7fbf8dfSSteven Rostedt (VMware) 	free_ftrace_hash(new_hash);
4391d7fbf8dfSSteven Rostedt (VMware) }
4392d7fbf8dfSSteven Rostedt (VMware) 
4393d7fbf8dfSSteven Rostedt (VMware) static void process_cached_mods(const char *mod_name)
4394d7fbf8dfSSteven Rostedt (VMware) {
4395d7fbf8dfSSteven Rostedt (VMware) 	struct trace_array *tr;
4396d7fbf8dfSSteven Rostedt (VMware) 	char *mod;
4397d7fbf8dfSSteven Rostedt (VMware) 
4398d7fbf8dfSSteven Rostedt (VMware) 	mod = kstrdup(mod_name, GFP_KERNEL);
4399d7fbf8dfSSteven Rostedt (VMware) 	if (!mod)
4400d7fbf8dfSSteven Rostedt (VMware) 		return;
4401d7fbf8dfSSteven Rostedt (VMware) 
4402d7fbf8dfSSteven Rostedt (VMware) 	mutex_lock(&trace_types_lock);
4403d7fbf8dfSSteven Rostedt (VMware) 	list_for_each_entry(tr, &ftrace_trace_arrays, list) {
4404d7fbf8dfSSteven Rostedt (VMware) 		if (!list_empty(&tr->mod_trace))
4405d7fbf8dfSSteven Rostedt (VMware) 			process_mod_list(&tr->mod_trace, tr->ops, mod, true);
4406d7fbf8dfSSteven Rostedt (VMware) 		if (!list_empty(&tr->mod_notrace))
4407d7fbf8dfSSteven Rostedt (VMware) 			process_mod_list(&tr->mod_notrace, tr->ops, mod, false);
4408d7fbf8dfSSteven Rostedt (VMware) 	}
4409d7fbf8dfSSteven Rostedt (VMware) 	mutex_unlock(&trace_types_lock);
4410d7fbf8dfSSteven Rostedt (VMware) 
4411d7fbf8dfSSteven Rostedt (VMware) 	kfree(mod);
4412d7fbf8dfSSteven Rostedt (VMware) }
441369449bbdSArnd Bergmann #endif
4414d7fbf8dfSSteven Rostedt (VMware) 
4415f6180773SSteven Rostedt /*
4416f6180773SSteven Rostedt  * We register the module command as a template to show others how
4417f6180773SSteven Rostedt  * to register the a command as well.
4418f6180773SSteven Rostedt  */
4419f6180773SSteven Rostedt 
4420f6180773SSteven Rostedt static int
442104ec7bb6SSteven Rostedt (VMware) ftrace_mod_callback(struct trace_array *tr, struct ftrace_hash *hash,
4422673feb9dSSteven Rostedt (VMware) 		    char *func_orig, char *cmd, char *module, int enable)
4423f6180773SSteven Rostedt {
4424673feb9dSSteven Rostedt (VMware) 	char *func;
44255e3949f0SDmitry Safonov 	int ret;
4426f6180773SSteven Rostedt 
4427673feb9dSSteven Rostedt (VMware) 	/* match_records() modifies func, and we need the original */
4428673feb9dSSteven Rostedt (VMware) 	func = kstrdup(func_orig, GFP_KERNEL);
4429673feb9dSSteven Rostedt (VMware) 	if (!func)
4430673feb9dSSteven Rostedt (VMware) 		return -ENOMEM;
4431673feb9dSSteven Rostedt (VMware) 
4432f6180773SSteven Rostedt 	/*
4433f6180773SSteven Rostedt 	 * cmd == 'mod' because we only registered this func
4434f6180773SSteven Rostedt 	 * for the 'mod' ftrace_func_command.
4435f6180773SSteven Rostedt 	 * But if you register one func with multiple commands,
4436f6180773SSteven Rostedt 	 * you can tell which command was used by the cmd
4437f6180773SSteven Rostedt 	 * parameter.
4438f6180773SSteven Rostedt 	 */
4439f0a3b154SDmitry Safonov 	ret = match_records(hash, func, strlen(func), module);
4440673feb9dSSteven Rostedt (VMware) 	kfree(func);
4441673feb9dSSteven Rostedt (VMware) 
4442b448c4e3SSteven Rostedt 	if (!ret)
4443673feb9dSSteven Rostedt (VMware) 		return cache_mod(tr, func_orig, module, enable);
4444b448c4e3SSteven Rostedt 	if (ret < 0)
4445b448c4e3SSteven Rostedt 		return ret;
4446f6180773SSteven Rostedt 	return 0;
4447f6180773SSteven Rostedt }
4448f6180773SSteven Rostedt 
4449f6180773SSteven Rostedt static struct ftrace_func_command ftrace_mod_cmd = {
4450f6180773SSteven Rostedt 	.name			= "mod",
4451f6180773SSteven Rostedt 	.func			= ftrace_mod_callback,
4452f6180773SSteven Rostedt };
4453f6180773SSteven Rostedt 
4454f6180773SSteven Rostedt static int __init ftrace_mod_cmd_init(void)
4455f6180773SSteven Rostedt {
4456f6180773SSteven Rostedt 	return register_ftrace_command(&ftrace_mod_cmd);
4457f6180773SSteven Rostedt }
44586f415672SSteven Rostedt core_initcall(ftrace_mod_cmd_init);
4459f6180773SSteven Rostedt 
44602f5f6ad9SSteven Rostedt static void function_trace_probe_call(unsigned long ip, unsigned long parent_ip,
4461d19ad077SSteven Rostedt (VMware) 				      struct ftrace_ops *op, struct ftrace_regs *fregs)
446259df055fSSteven Rostedt {
4463eee8ded1SSteven Rostedt (VMware) 	struct ftrace_probe_ops *probe_ops;
44647b60f3d8SSteven Rostedt (VMware) 	struct ftrace_func_probe *probe;
446559df055fSSteven Rostedt 
44667b60f3d8SSteven Rostedt (VMware) 	probe = container_of(op, struct ftrace_func_probe, ops);
44677b60f3d8SSteven Rostedt (VMware) 	probe_ops = probe->probe_ops;
446859df055fSSteven Rostedt 
446959df055fSSteven Rostedt 	/*
447059df055fSSteven Rostedt 	 * Disable preemption for these calls to prevent a RCU grace
447159df055fSSteven Rostedt 	 * period. This syncs the hash iteration and freeing of items
447259df055fSSteven Rostedt 	 * on the hash. rcu_read_lock is too dangerous here.
447359df055fSSteven Rostedt 	 */
44745168ae50SSteven Rostedt 	preempt_disable_notrace();
44756e444319SSteven Rostedt (VMware) 	probe_ops->func(ip, parent_ip, probe->tr, probe_ops, probe->data);
44765168ae50SSteven Rostedt 	preempt_enable_notrace();
447759df055fSSteven Rostedt }
447859df055fSSteven Rostedt 
447941794f19SSteven Rostedt (VMware) struct ftrace_func_map {
448041794f19SSteven Rostedt (VMware) 	struct ftrace_func_entry	entry;
448141794f19SSteven Rostedt (VMware) 	void				*data;
448259df055fSSteven Rostedt };
448359df055fSSteven Rostedt 
448441794f19SSteven Rostedt (VMware) struct ftrace_func_mapper {
448541794f19SSteven Rostedt (VMware) 	struct ftrace_hash		hash;
448641794f19SSteven Rostedt (VMware) };
448759df055fSSteven Rostedt 
448841794f19SSteven Rostedt (VMware) /**
448941794f19SSteven Rostedt (VMware)  * allocate_ftrace_func_mapper - allocate a new ftrace_func_mapper
449041794f19SSteven Rostedt (VMware)  *
449141794f19SSteven Rostedt (VMware)  * Returns a ftrace_func_mapper descriptor that can be used to map ips to data.
449241794f19SSteven Rostedt (VMware)  */
449341794f19SSteven Rostedt (VMware) struct ftrace_func_mapper *allocate_ftrace_func_mapper(void)
449459df055fSSteven Rostedt {
4495e1df4cb6SSteven Rostedt (Red Hat) 	struct ftrace_hash *hash;
449659df055fSSteven Rostedt 
449741794f19SSteven Rostedt (VMware) 	/*
449841794f19SSteven Rostedt (VMware) 	 * The mapper is simply a ftrace_hash, but since the entries
449941794f19SSteven Rostedt (VMware) 	 * in the hash are not ftrace_func_entry type, we define it
450041794f19SSteven Rostedt (VMware) 	 * as a separate structure.
450141794f19SSteven Rostedt (VMware) 	 */
450241794f19SSteven Rostedt (VMware) 	hash = alloc_ftrace_hash(FTRACE_HASH_DEFAULT_BITS);
450341794f19SSteven Rostedt (VMware) 	return (struct ftrace_func_mapper *)hash;
4504e1df4cb6SSteven Rostedt (Red Hat) }
4505e1df4cb6SSteven Rostedt (Red Hat) 
450641794f19SSteven Rostedt (VMware) /**
450741794f19SSteven Rostedt (VMware)  * ftrace_func_mapper_find_ip - Find some data mapped to an ip
450841794f19SSteven Rostedt (VMware)  * @mapper: The mapper that has the ip maps
450941794f19SSteven Rostedt (VMware)  * @ip: the instruction pointer to find the data for
451041794f19SSteven Rostedt (VMware)  *
451141794f19SSteven Rostedt (VMware)  * Returns the data mapped to @ip if found otherwise NULL. The return
451241794f19SSteven Rostedt (VMware)  * is actually the address of the mapper data pointer. The address is
451341794f19SSteven Rostedt (VMware)  * returned for use cases where the data is no bigger than a long, and
451441794f19SSteven Rostedt (VMware)  * the user can use the data pointer as its data instead of having to
451541794f19SSteven Rostedt (VMware)  * allocate more memory for the reference.
451641794f19SSteven Rostedt (VMware)  */
451741794f19SSteven Rostedt (VMware) void **ftrace_func_mapper_find_ip(struct ftrace_func_mapper *mapper,
451841794f19SSteven Rostedt (VMware) 				  unsigned long ip)
451941794f19SSteven Rostedt (VMware) {
452041794f19SSteven Rostedt (VMware) 	struct ftrace_func_entry *entry;
452141794f19SSteven Rostedt (VMware) 	struct ftrace_func_map *map;
452241794f19SSteven Rostedt (VMware) 
452341794f19SSteven Rostedt (VMware) 	entry = ftrace_lookup_ip(&mapper->hash, ip);
452441794f19SSteven Rostedt (VMware) 	if (!entry)
452541794f19SSteven Rostedt (VMware) 		return NULL;
452641794f19SSteven Rostedt (VMware) 
452741794f19SSteven Rostedt (VMware) 	map = (struct ftrace_func_map *)entry;
452841794f19SSteven Rostedt (VMware) 	return &map->data;
4529e1df4cb6SSteven Rostedt (Red Hat) }
453045a4a237SSteven Rostedt 
453141794f19SSteven Rostedt (VMware) /**
453241794f19SSteven Rostedt (VMware)  * ftrace_func_mapper_add_ip - Map some data to an ip
453341794f19SSteven Rostedt (VMware)  * @mapper: The mapper that has the ip maps
453441794f19SSteven Rostedt (VMware)  * @ip: The instruction pointer address to map @data to
453541794f19SSteven Rostedt (VMware)  * @data: The data to map to @ip
453641794f19SSteven Rostedt (VMware)  *
4537fdda88d3SQiujun Huang  * Returns 0 on success otherwise an error.
453841794f19SSteven Rostedt (VMware)  */
453941794f19SSteven Rostedt (VMware) int ftrace_func_mapper_add_ip(struct ftrace_func_mapper *mapper,
454041794f19SSteven Rostedt (VMware) 			      unsigned long ip, void *data)
454141794f19SSteven Rostedt (VMware) {
454241794f19SSteven Rostedt (VMware) 	struct ftrace_func_entry *entry;
454341794f19SSteven Rostedt (VMware) 	struct ftrace_func_map *map;
454441794f19SSteven Rostedt (VMware) 
454541794f19SSteven Rostedt (VMware) 	entry = ftrace_lookup_ip(&mapper->hash, ip);
454641794f19SSteven Rostedt (VMware) 	if (entry)
454741794f19SSteven Rostedt (VMware) 		return -EBUSY;
454841794f19SSteven Rostedt (VMware) 
454941794f19SSteven Rostedt (VMware) 	map = kmalloc(sizeof(*map), GFP_KERNEL);
455041794f19SSteven Rostedt (VMware) 	if (!map)
455141794f19SSteven Rostedt (VMware) 		return -ENOMEM;
455241794f19SSteven Rostedt (VMware) 
455341794f19SSteven Rostedt (VMware) 	map->entry.ip = ip;
455441794f19SSteven Rostedt (VMware) 	map->data = data;
455541794f19SSteven Rostedt (VMware) 
455641794f19SSteven Rostedt (VMware) 	__add_hash_entry(&mapper->hash, &map->entry);
455741794f19SSteven Rostedt (VMware) 
455841794f19SSteven Rostedt (VMware) 	return 0;
455941794f19SSteven Rostedt (VMware) }
456041794f19SSteven Rostedt (VMware) 
456141794f19SSteven Rostedt (VMware) /**
456241794f19SSteven Rostedt (VMware)  * ftrace_func_mapper_remove_ip - Remove an ip from the mapping
456341794f19SSteven Rostedt (VMware)  * @mapper: The mapper that has the ip maps
456441794f19SSteven Rostedt (VMware)  * @ip: The instruction pointer address to remove the data from
456541794f19SSteven Rostedt (VMware)  *
456641794f19SSteven Rostedt (VMware)  * Returns the data if it is found, otherwise NULL.
456741794f19SSteven Rostedt (VMware)  * Note, if the data pointer is used as the data itself, (see
456841794f19SSteven Rostedt (VMware)  * ftrace_func_mapper_find_ip(), then the return value may be meaningless,
456941794f19SSteven Rostedt (VMware)  * if the data pointer was set to zero.
457041794f19SSteven Rostedt (VMware)  */
457141794f19SSteven Rostedt (VMware) void *ftrace_func_mapper_remove_ip(struct ftrace_func_mapper *mapper,
457241794f19SSteven Rostedt (VMware) 				   unsigned long ip)
457341794f19SSteven Rostedt (VMware) {
457441794f19SSteven Rostedt (VMware) 	struct ftrace_func_entry *entry;
457541794f19SSteven Rostedt (VMware) 	struct ftrace_func_map *map;
457641794f19SSteven Rostedt (VMware) 	void *data;
457741794f19SSteven Rostedt (VMware) 
457841794f19SSteven Rostedt (VMware) 	entry = ftrace_lookup_ip(&mapper->hash, ip);
457941794f19SSteven Rostedt (VMware) 	if (!entry)
458041794f19SSteven Rostedt (VMware) 		return NULL;
458141794f19SSteven Rostedt (VMware) 
458241794f19SSteven Rostedt (VMware) 	map = (struct ftrace_func_map *)entry;
458341794f19SSteven Rostedt (VMware) 	data = map->data;
458441794f19SSteven Rostedt (VMware) 
458541794f19SSteven Rostedt (VMware) 	remove_hash_entry(&mapper->hash, entry);
458641794f19SSteven Rostedt (VMware) 	kfree(entry);
458741794f19SSteven Rostedt (VMware) 
458841794f19SSteven Rostedt (VMware) 	return data;
458941794f19SSteven Rostedt (VMware) }
459041794f19SSteven Rostedt (VMware) 
459141794f19SSteven Rostedt (VMware) /**
459241794f19SSteven Rostedt (VMware)  * free_ftrace_func_mapper - free a mapping of ips and data
459341794f19SSteven Rostedt (VMware)  * @mapper: The mapper that has the ip maps
459441794f19SSteven Rostedt (VMware)  * @free_func: A function to be called on each data item.
459541794f19SSteven Rostedt (VMware)  *
459641794f19SSteven Rostedt (VMware)  * This is used to free the function mapper. The @free_func is optional
459741794f19SSteven Rostedt (VMware)  * and can be used if the data needs to be freed as well.
459841794f19SSteven Rostedt (VMware)  */
459941794f19SSteven Rostedt (VMware) void free_ftrace_func_mapper(struct ftrace_func_mapper *mapper,
460041794f19SSteven Rostedt (VMware) 			     ftrace_mapper_func free_func)
460141794f19SSteven Rostedt (VMware) {
460241794f19SSteven Rostedt (VMware) 	struct ftrace_func_entry *entry;
460341794f19SSteven Rostedt (VMware) 	struct ftrace_func_map *map;
460441794f19SSteven Rostedt (VMware) 	struct hlist_head *hhd;
460504e03d9aSWei Li 	int size, i;
460604e03d9aSWei Li 
460704e03d9aSWei Li 	if (!mapper)
460804e03d9aSWei Li 		return;
460941794f19SSteven Rostedt (VMware) 
461041794f19SSteven Rostedt (VMware) 	if (free_func && mapper->hash.count) {
461104e03d9aSWei Li 		size = 1 << mapper->hash.size_bits;
461241794f19SSteven Rostedt (VMware) 		for (i = 0; i < size; i++) {
461341794f19SSteven Rostedt (VMware) 			hhd = &mapper->hash.buckets[i];
461441794f19SSteven Rostedt (VMware) 			hlist_for_each_entry(entry, hhd, hlist) {
461541794f19SSteven Rostedt (VMware) 				map = (struct ftrace_func_map *)entry;
461641794f19SSteven Rostedt (VMware) 				free_func(map);
461741794f19SSteven Rostedt (VMware) 			}
461841794f19SSteven Rostedt (VMware) 		}
461941794f19SSteven Rostedt (VMware) 	}
462041794f19SSteven Rostedt (VMware) 	free_ftrace_hash(&mapper->hash);
462141794f19SSteven Rostedt (VMware) }
462241794f19SSteven Rostedt (VMware) 
46237b60f3d8SSteven Rostedt (VMware) static void release_probe(struct ftrace_func_probe *probe)
46247b60f3d8SSteven Rostedt (VMware) {
46257b60f3d8SSteven Rostedt (VMware) 	struct ftrace_probe_ops *probe_ops;
46267b60f3d8SSteven Rostedt (VMware) 
46275ae0bf59SSteven Rostedt (Red Hat) 	mutex_lock(&ftrace_lock);
46285ae0bf59SSteven Rostedt (Red Hat) 
46297b60f3d8SSteven Rostedt (VMware) 	WARN_ON(probe->ref <= 0);
463059df055fSSteven Rostedt 
46317b60f3d8SSteven Rostedt (VMware) 	/* Subtract the ref that was used to protect this instance */
46327b60f3d8SSteven Rostedt (VMware) 	probe->ref--;
4633546fece4SSteven Rostedt (Red Hat) 
46347b60f3d8SSteven Rostedt (VMware) 	if (!probe->ref) {
46357b60f3d8SSteven Rostedt (VMware) 		probe_ops = probe->probe_ops;
46366e444319SSteven Rostedt (VMware) 		/*
46376e444319SSteven Rostedt (VMware) 		 * Sending zero as ip tells probe_ops to free
46386e444319SSteven Rostedt (VMware) 		 * the probe->data itself
46396e444319SSteven Rostedt (VMware) 		 */
46406e444319SSteven Rostedt (VMware) 		if (probe_ops->free)
46416e444319SSteven Rostedt (VMware) 			probe_ops->free(probe_ops, probe->tr, 0, probe->data);
46427b60f3d8SSteven Rostedt (VMware) 		list_del(&probe->list);
46437b60f3d8SSteven Rostedt (VMware) 		kfree(probe);
46447b60f3d8SSteven Rostedt (VMware) 	}
46457b60f3d8SSteven Rostedt (VMware) 	mutex_unlock(&ftrace_lock);
464659df055fSSteven Rostedt }
464759df055fSSteven Rostedt 
46487b60f3d8SSteven Rostedt (VMware) static void acquire_probe_locked(struct ftrace_func_probe *probe)
46497b60f3d8SSteven Rostedt (VMware) {
46507b60f3d8SSteven Rostedt (VMware) 	/*
46517b60f3d8SSteven Rostedt (VMware) 	 * Add one ref to keep it from being freed when releasing the
46527b60f3d8SSteven Rostedt (VMware) 	 * ftrace_lock mutex.
46537b60f3d8SSteven Rostedt (VMware) 	 */
46547b60f3d8SSteven Rostedt (VMware) 	probe->ref++;
46557b60f3d8SSteven Rostedt (VMware) }
465659df055fSSteven Rostedt 
465759df055fSSteven Rostedt int
465804ec7bb6SSteven Rostedt (VMware) register_ftrace_function_probe(char *glob, struct trace_array *tr,
46597b60f3d8SSteven Rostedt (VMware) 			       struct ftrace_probe_ops *probe_ops,
46607b60f3d8SSteven Rostedt (VMware) 			       void *data)
466159df055fSSteven Rostedt {
4662ba27d855SJakob Koschel 	struct ftrace_func_probe *probe = NULL, *iter;
46631ec3a81aSSteven Rostedt (VMware) 	struct ftrace_func_entry *entry;
46641ec3a81aSSteven Rostedt (VMware) 	struct ftrace_hash **orig_hash;
46651ec3a81aSSteven Rostedt (VMware) 	struct ftrace_hash *old_hash;
466659df055fSSteven Rostedt 	struct ftrace_hash *hash;
466759df055fSSteven Rostedt 	int count = 0;
46681ec3a81aSSteven Rostedt (VMware) 	int size;
466959df055fSSteven Rostedt 	int ret;
46701ec3a81aSSteven Rostedt (VMware) 	int i;
467159df055fSSteven Rostedt 
467204ec7bb6SSteven Rostedt (VMware) 	if (WARN_ON(!tr))
467304ec7bb6SSteven Rostedt (VMware) 		return -EINVAL;
467404ec7bb6SSteven Rostedt (VMware) 
46751ec3a81aSSteven Rostedt (VMware) 	/* We do not support '!' for function probes */
46761ec3a81aSSteven Rostedt (VMware) 	if (WARN_ON(glob[0] == '!'))
467759df055fSSteven Rostedt 		return -EINVAL;
467859df055fSSteven Rostedt 
46797b60f3d8SSteven Rostedt (VMware) 
46807b60f3d8SSteven Rostedt (VMware) 	mutex_lock(&ftrace_lock);
46817b60f3d8SSteven Rostedt (VMware) 	/* Check if the probe_ops is already registered */
4682ba27d855SJakob Koschel 	list_for_each_entry(iter, &tr->func_probes, list) {
4683ba27d855SJakob Koschel 		if (iter->probe_ops == probe_ops) {
4684ba27d855SJakob Koschel 			probe = iter;
46857b60f3d8SSteven Rostedt (VMware) 			break;
46867b60f3d8SSteven Rostedt (VMware) 		}
4687ba27d855SJakob Koschel 	}
4688ba27d855SJakob Koschel 	if (!probe) {
46897b60f3d8SSteven Rostedt (VMware) 		probe = kzalloc(sizeof(*probe), GFP_KERNEL);
46907b60f3d8SSteven Rostedt (VMware) 		if (!probe) {
46917b60f3d8SSteven Rostedt (VMware) 			mutex_unlock(&ftrace_lock);
46927b60f3d8SSteven Rostedt (VMware) 			return -ENOMEM;
46937b60f3d8SSteven Rostedt (VMware) 		}
46947b60f3d8SSteven Rostedt (VMware) 		probe->probe_ops = probe_ops;
46957b60f3d8SSteven Rostedt (VMware) 		probe->ops.func = function_trace_probe_call;
46967b60f3d8SSteven Rostedt (VMware) 		probe->tr = tr;
46977b60f3d8SSteven Rostedt (VMware) 		ftrace_ops_init(&probe->ops);
46987b60f3d8SSteven Rostedt (VMware) 		list_add(&probe->list, &tr->func_probes);
46991ec3a81aSSteven Rostedt (VMware) 	}
470059df055fSSteven Rostedt 
47017b60f3d8SSteven Rostedt (VMware) 	acquire_probe_locked(probe);
470259df055fSSteven Rostedt 
47037b60f3d8SSteven Rostedt (VMware) 	mutex_unlock(&ftrace_lock);
47047b60f3d8SSteven Rostedt (VMware) 
4705372e0d01SSteven Rostedt (VMware) 	/*
4706372e0d01SSteven Rostedt (VMware) 	 * Note, there's a small window here that the func_hash->filter_hash
4707fdda88d3SQiujun Huang 	 * may be NULL or empty. Need to be careful when reading the loop.
4708372e0d01SSteven Rostedt (VMware) 	 */
47097b60f3d8SSteven Rostedt (VMware) 	mutex_lock(&probe->ops.func_hash->regex_lock);
47107b60f3d8SSteven Rostedt (VMware) 
47117b60f3d8SSteven Rostedt (VMware) 	orig_hash = &probe->ops.func_hash->filter_hash;
47121ec3a81aSSteven Rostedt (VMware) 	old_hash = *orig_hash;
471359df055fSSteven Rostedt 	hash = alloc_and_copy_ftrace_hash(FTRACE_HASH_DEFAULT_BITS, old_hash);
47141ec3a81aSSteven Rostedt (VMware) 
47155b0022ddSNaveen N. Rao 	if (!hash) {
47165b0022ddSNaveen N. Rao 		ret = -ENOMEM;
47175b0022ddSNaveen N. Rao 		goto out;
47185b0022ddSNaveen N. Rao 	}
47195b0022ddSNaveen N. Rao 
47201ec3a81aSSteven Rostedt (VMware) 	ret = ftrace_match_records(hash, glob, strlen(glob));
47211ec3a81aSSteven Rostedt (VMware) 
47221ec3a81aSSteven Rostedt (VMware) 	/* Nothing found? */
47231ec3a81aSSteven Rostedt (VMware) 	if (!ret)
47241ec3a81aSSteven Rostedt (VMware) 		ret = -EINVAL;
47251ec3a81aSSteven Rostedt (VMware) 
47261ec3a81aSSteven Rostedt (VMware) 	if (ret < 0)
472759df055fSSteven Rostedt 		goto out;
472859df055fSSteven Rostedt 
47291ec3a81aSSteven Rostedt (VMware) 	size = 1 << hash->size_bits;
47301ec3a81aSSteven Rostedt (VMware) 	for (i = 0; i < size; i++) {
47311ec3a81aSSteven Rostedt (VMware) 		hlist_for_each_entry(entry, &hash->buckets[i], hlist) {
47321ec3a81aSSteven Rostedt (VMware) 			if (ftrace_lookup_ip(old_hash, entry->ip))
473359df055fSSteven Rostedt 				continue;
473459df055fSSteven Rostedt 			/*
473559df055fSSteven Rostedt 			 * The caller might want to do something special
473659df055fSSteven Rostedt 			 * for each function we find. We call the callback
473759df055fSSteven Rostedt 			 * to give the caller an opportunity to do so.
473859df055fSSteven Rostedt 			 */
47397b60f3d8SSteven Rostedt (VMware) 			if (probe_ops->init) {
47407b60f3d8SSteven Rostedt (VMware) 				ret = probe_ops->init(probe_ops, tr,
47416e444319SSteven Rostedt (VMware) 						      entry->ip, data,
47426e444319SSteven Rostedt (VMware) 						      &probe->data);
47436e444319SSteven Rostedt (VMware) 				if (ret < 0) {
47446e444319SSteven Rostedt (VMware) 					if (probe_ops->free && count)
47456e444319SSteven Rostedt (VMware) 						probe_ops->free(probe_ops, tr,
47466e444319SSteven Rostedt (VMware) 								0, probe->data);
47476e444319SSteven Rostedt (VMware) 					probe->data = NULL;
4748eee8ded1SSteven Rostedt (VMware) 					goto out;
47491ec3a81aSSteven Rostedt (VMware) 				}
47506e444319SSteven Rostedt (VMware) 			}
47511ec3a81aSSteven Rostedt (VMware) 			count++;
475259df055fSSteven Rostedt 		}
475359df055fSSteven Rostedt 	}
475459df055fSSteven Rostedt 
47551ec3a81aSSteven Rostedt (VMware) 	mutex_lock(&ftrace_lock);
47561ec3a81aSSteven Rostedt (VMware) 
47577b60f3d8SSteven Rostedt (VMware) 	if (!count) {
47587b60f3d8SSteven Rostedt (VMware) 		/* Nothing was added? */
47597b60f3d8SSteven Rostedt (VMware) 		ret = -EINVAL;
4760e1df4cb6SSteven Rostedt (Red Hat) 		goto out_unlock;
4761e1df4cb6SSteven Rostedt (Red Hat) 	}
4762e1df4cb6SSteven Rostedt (Red Hat) 
47637b60f3d8SSteven Rostedt (VMware) 	ret = ftrace_hash_move_and_update_ops(&probe->ops, orig_hash,
47641ec3a81aSSteven Rostedt (VMware) 					      hash, 1);
47651ec3a81aSSteven Rostedt (VMware) 	if (ret < 0)
47668d70725eSSteven Rostedt (VMware) 		goto err_unlock;
476759df055fSSteven Rostedt 
47687b60f3d8SSteven Rostedt (VMware) 	/* One ref for each new function traced */
47697b60f3d8SSteven Rostedt (VMware) 	probe->ref += count;
477059df055fSSteven Rostedt 
47717b60f3d8SSteven Rostedt (VMware) 	if (!(probe->ops.flags & FTRACE_OPS_FL_ENABLED))
47727b60f3d8SSteven Rostedt (VMware) 		ret = ftrace_startup(&probe->ops, 0);
4773e1df4cb6SSteven Rostedt (Red Hat) 
477459df055fSSteven Rostedt  out_unlock:
47755ae0bf59SSteven Rostedt (Red Hat) 	mutex_unlock(&ftrace_lock);
477659df055fSSteven Rostedt 
477759df055fSSteven Rostedt 	if (!ret)
47781ec3a81aSSteven Rostedt (VMware) 		ret = count;
47795ae0bf59SSteven Rostedt (Red Hat)  out:
47807b60f3d8SSteven Rostedt (VMware) 	mutex_unlock(&probe->ops.func_hash->regex_lock);
4781e1df4cb6SSteven Rostedt (Red Hat) 	free_ftrace_hash(hash);
478259df055fSSteven Rostedt 
47837b60f3d8SSteven Rostedt (VMware) 	release_probe(probe);
47847b60f3d8SSteven Rostedt (VMware) 
47851ec3a81aSSteven Rostedt (VMware) 	return ret;
47868d70725eSSteven Rostedt (VMware) 
47878d70725eSSteven Rostedt (VMware)  err_unlock:
47887b60f3d8SSteven Rostedt (VMware) 	if (!probe_ops->free || !count)
47898d70725eSSteven Rostedt (VMware) 		goto out_unlock;
47908d70725eSSteven Rostedt (VMware) 
47918d70725eSSteven Rostedt (VMware) 	/* Failed to do the move, need to call the free functions */
47928d70725eSSteven Rostedt (VMware) 	for (i = 0; i < size; i++) {
47938d70725eSSteven Rostedt (VMware) 		hlist_for_each_entry(entry, &hash->buckets[i], hlist) {
47948d70725eSSteven Rostedt (VMware) 			if (ftrace_lookup_ip(old_hash, entry->ip))
47958d70725eSSteven Rostedt (VMware) 				continue;
47966e444319SSteven Rostedt (VMware) 			probe_ops->free(probe_ops, tr, entry->ip, probe->data);
47978d70725eSSteven Rostedt (VMware) 		}
47988d70725eSSteven Rostedt (VMware) 	}
47998d70725eSSteven Rostedt (VMware) 	goto out_unlock;
480059df055fSSteven Rostedt }
480159df055fSSteven Rostedt 
4802d3d532d7SSteven Rostedt (VMware) int
48037b60f3d8SSteven Rostedt (VMware) unregister_ftrace_function_probe_func(char *glob, struct trace_array *tr,
48047b60f3d8SSteven Rostedt (VMware) 				      struct ftrace_probe_ops *probe_ops)
480559df055fSSteven Rostedt {
4806ba27d855SJakob Koschel 	struct ftrace_func_probe *probe = NULL, *iter;
480782cc4fc2SSteven Rostedt (VMware) 	struct ftrace_ops_hash old_hash_ops;
4808eee8ded1SSteven Rostedt (VMware) 	struct ftrace_func_entry *entry;
48093ba00929SDmitry Safonov 	struct ftrace_glob func_g;
48101ec3a81aSSteven Rostedt (VMware) 	struct ftrace_hash **orig_hash;
48111ec3a81aSSteven Rostedt (VMware) 	struct ftrace_hash *old_hash;
48121ec3a81aSSteven Rostedt (VMware) 	struct ftrace_hash *hash = NULL;
4813b67bfe0dSSasha Levin 	struct hlist_node *tmp;
4814eee8ded1SSteven Rostedt (VMware) 	struct hlist_head hhd;
481559df055fSSteven Rostedt 	char str[KSYM_SYMBOL_LEN];
48167b60f3d8SSteven Rostedt (VMware) 	int count = 0;
48177b60f3d8SSteven Rostedt (VMware) 	int i, ret = -ENODEV;
4818eee8ded1SSteven Rostedt (VMware) 	int size;
481959df055fSSteven Rostedt 
4820cbab567cSNaveen N. Rao 	if (!glob || !strlen(glob) || !strcmp(glob, "*"))
48213ba00929SDmitry Safonov 		func_g.search = NULL;
4822cbab567cSNaveen N. Rao 	else {
482359df055fSSteven Rostedt 		int not;
482459df055fSSteven Rostedt 
48253ba00929SDmitry Safonov 		func_g.type = filter_parse_regex(glob, strlen(glob),
48263ba00929SDmitry Safonov 						 &func_g.search, &not);
48273ba00929SDmitry Safonov 		func_g.len = strlen(func_g.search);
482859df055fSSteven Rostedt 
4829b6887d79SSteven Rostedt 		/* we do not support '!' for function probes */
483059df055fSSteven Rostedt 		if (WARN_ON(not))
4831d3d532d7SSteven Rostedt (VMware) 			return -EINVAL;
483259df055fSSteven Rostedt 	}
483359df055fSSteven Rostedt 
48347b60f3d8SSteven Rostedt (VMware) 	mutex_lock(&ftrace_lock);
48357b60f3d8SSteven Rostedt (VMware) 	/* Check if the probe_ops is already registered */
4836ba27d855SJakob Koschel 	list_for_each_entry(iter, &tr->func_probes, list) {
4837ba27d855SJakob Koschel 		if (iter->probe_ops == probe_ops) {
4838ba27d855SJakob Koschel 			probe = iter;
48397b60f3d8SSteven Rostedt (VMware) 			break;
48407b60f3d8SSteven Rostedt (VMware) 		}
4841ba27d855SJakob Koschel 	}
4842ba27d855SJakob Koschel 	if (!probe)
48437b60f3d8SSteven Rostedt (VMware) 		goto err_unlock_ftrace;
48441ec3a81aSSteven Rostedt (VMware) 
48451ec3a81aSSteven Rostedt (VMware) 	ret = -EINVAL;
48467b60f3d8SSteven Rostedt (VMware) 	if (!(probe->ops.flags & FTRACE_OPS_FL_INITIALIZED))
48477b60f3d8SSteven Rostedt (VMware) 		goto err_unlock_ftrace;
48487b60f3d8SSteven Rostedt (VMware) 
48497b60f3d8SSteven Rostedt (VMware) 	acquire_probe_locked(probe);
48507b60f3d8SSteven Rostedt (VMware) 
48517b60f3d8SSteven Rostedt (VMware) 	mutex_unlock(&ftrace_lock);
48527b60f3d8SSteven Rostedt (VMware) 
48537b60f3d8SSteven Rostedt (VMware) 	mutex_lock(&probe->ops.func_hash->regex_lock);
48547b60f3d8SSteven Rostedt (VMware) 
48557b60f3d8SSteven Rostedt (VMware) 	orig_hash = &probe->ops.func_hash->filter_hash;
48567b60f3d8SSteven Rostedt (VMware) 	old_hash = *orig_hash;
48577b60f3d8SSteven Rostedt (VMware) 
48581ec3a81aSSteven Rostedt (VMware) 	if (ftrace_hash_empty(old_hash))
48591ec3a81aSSteven Rostedt (VMware) 		goto out_unlock;
4860e1df4cb6SSteven Rostedt (Red Hat) 
486182cc4fc2SSteven Rostedt (VMware) 	old_hash_ops.filter_hash = old_hash;
486282cc4fc2SSteven Rostedt (VMware) 	/* Probes only have filters */
486382cc4fc2SSteven Rostedt (VMware) 	old_hash_ops.notrace_hash = NULL;
486482cc4fc2SSteven Rostedt (VMware) 
4865d3d532d7SSteven Rostedt (VMware) 	ret = -ENOMEM;
48661ec3a81aSSteven Rostedt (VMware) 	hash = alloc_and_copy_ftrace_hash(FTRACE_HASH_DEFAULT_BITS, old_hash);
4867e1df4cb6SSteven Rostedt (Red Hat) 	if (!hash)
4868e1df4cb6SSteven Rostedt (Red Hat) 		goto out_unlock;
4869e1df4cb6SSteven Rostedt (Red Hat) 
4870eee8ded1SSteven Rostedt (VMware) 	INIT_HLIST_HEAD(&hhd);
48717818b388SSteven Rostedt (Red Hat) 
4872eee8ded1SSteven Rostedt (VMware) 	size = 1 << hash->size_bits;
4873eee8ded1SSteven Rostedt (VMware) 	for (i = 0; i < size; i++) {
4874eee8ded1SSteven Rostedt (VMware) 		hlist_for_each_entry_safe(entry, tmp, &hash->buckets[i], hlist) {
487559df055fSSteven Rostedt 
48763ba00929SDmitry Safonov 			if (func_g.search) {
487759df055fSSteven Rostedt 				kallsyms_lookup(entry->ip, NULL, NULL,
487859df055fSSteven Rostedt 						NULL, str);
48793ba00929SDmitry Safonov 				if (!ftrace_match(str, &func_g))
488059df055fSSteven Rostedt 					continue;
488159df055fSSteven Rostedt 			}
48827b60f3d8SSteven Rostedt (VMware) 			count++;
4883eee8ded1SSteven Rostedt (VMware) 			remove_hash_entry(hash, entry);
4884eee8ded1SSteven Rostedt (VMware) 			hlist_add_head(&entry->hlist, &hhd);
488559df055fSSteven Rostedt 		}
488659df055fSSteven Rostedt 	}
4887d3d532d7SSteven Rostedt (VMware) 
4888d3d532d7SSteven Rostedt (VMware) 	/* Nothing found? */
48897b60f3d8SSteven Rostedt (VMware) 	if (!count) {
4890d3d532d7SSteven Rostedt (VMware) 		ret = -EINVAL;
4891d3d532d7SSteven Rostedt (VMware) 		goto out_unlock;
4892d3d532d7SSteven Rostedt (VMware) 	}
4893d3d532d7SSteven Rostedt (VMware) 
48943f2367baSMasami Hiramatsu 	mutex_lock(&ftrace_lock);
48951ec3a81aSSteven Rostedt (VMware) 
48967b60f3d8SSteven Rostedt (VMware) 	WARN_ON(probe->ref < count);
4897eee8ded1SSteven Rostedt (VMware) 
48987b60f3d8SSteven Rostedt (VMware) 	probe->ref -= count;
48991ec3a81aSSteven Rostedt (VMware) 
49007b60f3d8SSteven Rostedt (VMware) 	if (ftrace_hash_empty(hash))
49017b60f3d8SSteven Rostedt (VMware) 		ftrace_shutdown(&probe->ops, 0);
49027b60f3d8SSteven Rostedt (VMware) 
49037b60f3d8SSteven Rostedt (VMware) 	ret = ftrace_hash_move_and_update_ops(&probe->ops, orig_hash,
49041ec3a81aSSteven Rostedt (VMware) 					      hash, 1);
490582cc4fc2SSteven Rostedt (VMware) 
490682cc4fc2SSteven Rostedt (VMware) 	/* still need to update the function call sites */
49071ec3a81aSSteven Rostedt (VMware) 	if (ftrace_enabled && !ftrace_hash_empty(hash))
49087b60f3d8SSteven Rostedt (VMware) 		ftrace_run_modify_code(&probe->ops, FTRACE_UPDATE_CALLS,
490982cc4fc2SSteven Rostedt (VMware) 				       &old_hash_ops);
491074401729SPaul E. McKenney 	synchronize_rcu();
49113296fc4eSSteven Rostedt (Red Hat) 
4912eee8ded1SSteven Rostedt (VMware) 	hlist_for_each_entry_safe(entry, tmp, &hhd, hlist) {
4913eee8ded1SSteven Rostedt (VMware) 		hlist_del(&entry->hlist);
49147b60f3d8SSteven Rostedt (VMware) 		if (probe_ops->free)
49156e444319SSteven Rostedt (VMware) 			probe_ops->free(probe_ops, tr, entry->ip, probe->data);
4916eee8ded1SSteven Rostedt (VMware) 		kfree(entry);
49177818b388SSteven Rostedt (Red Hat) 	}
49183f2367baSMasami Hiramatsu 	mutex_unlock(&ftrace_lock);
49197818b388SSteven Rostedt (Red Hat) 
4920e1df4cb6SSteven Rostedt (Red Hat)  out_unlock:
49217b60f3d8SSteven Rostedt (VMware) 	mutex_unlock(&probe->ops.func_hash->regex_lock);
4922e1df4cb6SSteven Rostedt (Red Hat) 	free_ftrace_hash(hash);
492359df055fSSteven Rostedt 
49247b60f3d8SSteven Rostedt (VMware) 	release_probe(probe);
492559df055fSSteven Rostedt 
49267b60f3d8SSteven Rostedt (VMware) 	return ret;
492759df055fSSteven Rostedt 
49287b60f3d8SSteven Rostedt (VMware)  err_unlock_ftrace:
49297b60f3d8SSteven Rostedt (VMware) 	mutex_unlock(&ftrace_lock);
4930d3d532d7SSteven Rostedt (VMware) 	return ret;
493159df055fSSteven Rostedt }
493259df055fSSteven Rostedt 
4933a0e6369eSNaveen N. Rao void clear_ftrace_function_probes(struct trace_array *tr)
4934a0e6369eSNaveen N. Rao {
4935a0e6369eSNaveen N. Rao 	struct ftrace_func_probe *probe, *n;
4936a0e6369eSNaveen N. Rao 
4937a0e6369eSNaveen N. Rao 	list_for_each_entry_safe(probe, n, &tr->func_probes, list)
4938a0e6369eSNaveen N. Rao 		unregister_ftrace_function_probe_func(NULL, tr, probe->probe_ops);
4939a0e6369eSNaveen N. Rao }
4940a0e6369eSNaveen N. Rao 
4941f6180773SSteven Rostedt static LIST_HEAD(ftrace_commands);
4942f6180773SSteven Rostedt static DEFINE_MUTEX(ftrace_cmd_mutex);
4943f6180773SSteven Rostedt 
494438de93abSTom Zanussi /*
494538de93abSTom Zanussi  * Currently we only register ftrace commands from __init, so mark this
494638de93abSTom Zanussi  * __init too.
494738de93abSTom Zanussi  */
494838de93abSTom Zanussi __init int register_ftrace_command(struct ftrace_func_command *cmd)
4949f6180773SSteven Rostedt {
4950f6180773SSteven Rostedt 	struct ftrace_func_command *p;
4951f6180773SSteven Rostedt 	int ret = 0;
4952f6180773SSteven Rostedt 
4953f6180773SSteven Rostedt 	mutex_lock(&ftrace_cmd_mutex);
4954f6180773SSteven Rostedt 	list_for_each_entry(p, &ftrace_commands, list) {
4955f6180773SSteven Rostedt 		if (strcmp(cmd->name, p->name) == 0) {
4956f6180773SSteven Rostedt 			ret = -EBUSY;
4957f6180773SSteven Rostedt 			goto out_unlock;
4958f6180773SSteven Rostedt 		}
4959f6180773SSteven Rostedt 	}
4960f6180773SSteven Rostedt 	list_add(&cmd->list, &ftrace_commands);
4961f6180773SSteven Rostedt  out_unlock:
4962f6180773SSteven Rostedt 	mutex_unlock(&ftrace_cmd_mutex);
4963f6180773SSteven Rostedt 
4964f6180773SSteven Rostedt 	return ret;
4965f6180773SSteven Rostedt }
4966f6180773SSteven Rostedt 
496738de93abSTom Zanussi /*
496838de93abSTom Zanussi  * Currently we only unregister ftrace commands from __init, so mark
496938de93abSTom Zanussi  * this __init too.
497038de93abSTom Zanussi  */
497138de93abSTom Zanussi __init int unregister_ftrace_command(struct ftrace_func_command *cmd)
4972f6180773SSteven Rostedt {
4973f6180773SSteven Rostedt 	struct ftrace_func_command *p, *n;
4974f6180773SSteven Rostedt 	int ret = -ENODEV;
4975f6180773SSteven Rostedt 
4976f6180773SSteven Rostedt 	mutex_lock(&ftrace_cmd_mutex);
4977f6180773SSteven Rostedt 	list_for_each_entry_safe(p, n, &ftrace_commands, list) {
4978f6180773SSteven Rostedt 		if (strcmp(cmd->name, p->name) == 0) {
4979f6180773SSteven Rostedt 			ret = 0;
4980f6180773SSteven Rostedt 			list_del_init(&p->list);
4981f6180773SSteven Rostedt 			goto out_unlock;
4982f6180773SSteven Rostedt 		}
4983f6180773SSteven Rostedt 	}
4984f6180773SSteven Rostedt  out_unlock:
4985f6180773SSteven Rostedt 	mutex_unlock(&ftrace_cmd_mutex);
4986f6180773SSteven Rostedt 
4987f6180773SSteven Rostedt 	return ret;
4988f6180773SSteven Rostedt }
4989f6180773SSteven Rostedt 
499004ec7bb6SSteven Rostedt (VMware) static int ftrace_process_regex(struct ftrace_iterator *iter,
499133dc9b12SSteven Rostedt 				char *buff, int len, int enable)
499264e7c440SSteven Rostedt {
499304ec7bb6SSteven Rostedt (VMware) 	struct ftrace_hash *hash = iter->hash;
4994d2afd57aSSteven Rostedt (VMware) 	struct trace_array *tr = iter->ops->private;
4995f6180773SSteven Rostedt 	char *func, *command, *next = buff;
49966a24a244SSteven Rostedt 	struct ftrace_func_command *p;
49970aff1c0cSGuoWen Li 	int ret = -EINVAL;
499864e7c440SSteven Rostedt 
499964e7c440SSteven Rostedt 	func = strsep(&next, ":");
500064e7c440SSteven Rostedt 
500164e7c440SSteven Rostedt 	if (!next) {
50021cf41dd7SSteven Rostedt 		ret = ftrace_match_records(hash, func, len);
5003b448c4e3SSteven Rostedt 		if (!ret)
5004b448c4e3SSteven Rostedt 			ret = -EINVAL;
5005b448c4e3SSteven Rostedt 		if (ret < 0)
5006311d16daSLi Zefan 			return ret;
5007b448c4e3SSteven Rostedt 		return 0;
500864e7c440SSteven Rostedt 	}
500964e7c440SSteven Rostedt 
5010f6180773SSteven Rostedt 	/* command found */
501164e7c440SSteven Rostedt 
501264e7c440SSteven Rostedt 	command = strsep(&next, ":");
501364e7c440SSteven Rostedt 
5014f6180773SSteven Rostedt 	mutex_lock(&ftrace_cmd_mutex);
5015f6180773SSteven Rostedt 	list_for_each_entry(p, &ftrace_commands, list) {
5016f6180773SSteven Rostedt 		if (strcmp(p->name, command) == 0) {
501704ec7bb6SSteven Rostedt (VMware) 			ret = p->func(tr, hash, func, command, next, enable);
5018f6180773SSteven Rostedt 			goto out_unlock;
501964e7c440SSteven Rostedt 		}
5020f6180773SSteven Rostedt 	}
5021f6180773SSteven Rostedt  out_unlock:
5022f6180773SSteven Rostedt 	mutex_unlock(&ftrace_cmd_mutex);
502364e7c440SSteven Rostedt 
5024f6180773SSteven Rostedt 	return ret;
502564e7c440SSteven Rostedt }
502664e7c440SSteven Rostedt 
5027e309b41dSIngo Molnar static ssize_t
502841c52c0dSSteven Rostedt ftrace_regex_write(struct file *file, const char __user *ubuf,
502941c52c0dSSteven Rostedt 		   size_t cnt, loff_t *ppos, int enable)
50305072c59fSSteven Rostedt {
50315072c59fSSteven Rostedt 	struct ftrace_iterator *iter;
5032689fd8b6S[email protected] 	struct trace_parser *parser;
5033689fd8b6S[email protected] 	ssize_t ret, read;
50345072c59fSSteven Rostedt 
50354ba7978eSLi Zefan 	if (!cnt)
50365072c59fSSteven Rostedt 		return 0;
50375072c59fSSteven Rostedt 
50385072c59fSSteven Rostedt 	if (file->f_mode & FMODE_READ) {
50395072c59fSSteven Rostedt 		struct seq_file *m = file->private_data;
50405072c59fSSteven Rostedt 		iter = m->private;
50415072c59fSSteven Rostedt 	} else
50425072c59fSSteven Rostedt 		iter = file->private_data;
50435072c59fSSteven Rostedt 
5044f04f24fbSMasami Hiramatsu 	if (unlikely(ftrace_disabled))
50453f2367baSMasami Hiramatsu 		return -ENODEV;
50463f2367baSMasami Hiramatsu 
50473f2367baSMasami Hiramatsu 	/* iter->hash is a local copy, so we don't need regex_lock */
5048f04f24fbSMasami Hiramatsu 
5049689fd8b6S[email protected] 	parser = &iter->parser;
5050689fd8b6S[email protected] 	read = trace_get_user(parser, ubuf, cnt, ppos);
50515072c59fSSteven Rostedt 
50524ba7978eSLi Zefan 	if (read >= 0 && trace_parser_loaded(parser) &&
5053689fd8b6S[email protected] 	    !trace_parser_cont(parser)) {
505404ec7bb6SSteven Rostedt (VMware) 		ret = ftrace_process_regex(iter, parser->buffer,
5055689fd8b6S[email protected] 					   parser->idx, enable);
5056313254a9SLi Zefan 		trace_parser_clear(parser);
50577c088b51SSteven Rostedt (Red Hat) 		if (ret < 0)
50583f2367baSMasami Hiramatsu 			goto out;
50595072c59fSSteven Rostedt 	}
50605072c59fSSteven Rostedt 
50615072c59fSSteven Rostedt 	ret = read;
50623f2367baSMasami Hiramatsu  out:
50635072c59fSSteven Rostedt 	return ret;
50645072c59fSSteven Rostedt }
50655072c59fSSteven Rostedt 
5066fc13cb0cSSteven Rostedt ssize_t
506741c52c0dSSteven Rostedt ftrace_filter_write(struct file *file, const char __user *ubuf,
506841c52c0dSSteven Rostedt 		    size_t cnt, loff_t *ppos)
506941c52c0dSSteven Rostedt {
507041c52c0dSSteven Rostedt 	return ftrace_regex_write(file, ubuf, cnt, ppos, 1);
507141c52c0dSSteven Rostedt }
507241c52c0dSSteven Rostedt 
5073fc13cb0cSSteven Rostedt ssize_t
507441c52c0dSSteven Rostedt ftrace_notrace_write(struct file *file, const char __user *ubuf,
507541c52c0dSSteven Rostedt 		     size_t cnt, loff_t *ppos)
507641c52c0dSSteven Rostedt {
507741c52c0dSSteven Rostedt 	return ftrace_regex_write(file, ubuf, cnt, ppos, 0);
507841c52c0dSSteven Rostedt }
507941c52c0dSSteven Rostedt 
508033dc9b12SSteven Rostedt static int
50814f554e95SJiri Olsa __ftrace_match_addr(struct ftrace_hash *hash, unsigned long ip, int remove)
5082647664eaSMasami Hiramatsu {
5083647664eaSMasami Hiramatsu 	struct ftrace_func_entry *entry;
5084647664eaSMasami Hiramatsu 
5085aebfd125SPeter Zijlstra 	ip = ftrace_location(ip);
5086aebfd125SPeter Zijlstra 	if (!ip)
5087647664eaSMasami Hiramatsu 		return -EINVAL;
5088647664eaSMasami Hiramatsu 
5089647664eaSMasami Hiramatsu 	if (remove) {
5090647664eaSMasami Hiramatsu 		entry = ftrace_lookup_ip(hash, ip);
5091647664eaSMasami Hiramatsu 		if (!entry)
5092647664eaSMasami Hiramatsu 			return -ENOENT;
5093647664eaSMasami Hiramatsu 		free_hash_entry(hash, entry);
5094647664eaSMasami Hiramatsu 		return 0;
5095647664eaSMasami Hiramatsu 	}
5096647664eaSMasami Hiramatsu 
5097647664eaSMasami Hiramatsu 	return add_hash_entry(hash, ip);
5098647664eaSMasami Hiramatsu }
5099647664eaSMasami Hiramatsu 
5100647664eaSMasami Hiramatsu static int
51014f554e95SJiri Olsa ftrace_match_addr(struct ftrace_hash *hash, unsigned long *ips,
51024f554e95SJiri Olsa 		  unsigned int cnt, int remove)
51034f554e95SJiri Olsa {
51044f554e95SJiri Olsa 	unsigned int i;
51054f554e95SJiri Olsa 	int err;
51064f554e95SJiri Olsa 
51074f554e95SJiri Olsa 	for (i = 0; i < cnt; i++) {
51084f554e95SJiri Olsa 		err = __ftrace_match_addr(hash, ips[i], remove);
51094f554e95SJiri Olsa 		if (err) {
51104f554e95SJiri Olsa 			/*
51114f554e95SJiri Olsa 			 * This expects the @hash is a temporary hash and if this
51124f554e95SJiri Olsa 			 * fails the caller must free the @hash.
51134f554e95SJiri Olsa 			 */
51144f554e95SJiri Olsa 			return err;
51154f554e95SJiri Olsa 		}
51164f554e95SJiri Olsa 	}
51174f554e95SJiri Olsa 	return 0;
51184f554e95SJiri Olsa }
51194f554e95SJiri Olsa 
51204f554e95SJiri Olsa static int
5121647664eaSMasami Hiramatsu ftrace_set_hash(struct ftrace_ops *ops, unsigned char *buf, int len,
51224f554e95SJiri Olsa 		unsigned long *ips, unsigned int cnt,
51234f554e95SJiri Olsa 		int remove, int reset, int enable)
512441c52c0dSSteven Rostedt {
512533dc9b12SSteven Rostedt 	struct ftrace_hash **orig_hash;
5126f45948e8SSteven Rostedt 	struct ftrace_hash *hash;
512733dc9b12SSteven Rostedt 	int ret;
5128f45948e8SSteven Rostedt 
512941c52c0dSSteven Rostedt 	if (unlikely(ftrace_disabled))
513033dc9b12SSteven Rostedt 		return -ENODEV;
513141c52c0dSSteven Rostedt 
513233b7f99cSSteven Rostedt (Red Hat) 	mutex_lock(&ops->func_hash->regex_lock);
51333f2367baSMasami Hiramatsu 
5134f45948e8SSteven Rostedt 	if (enable)
513533b7f99cSSteven Rostedt (Red Hat) 		orig_hash = &ops->func_hash->filter_hash;
5136f45948e8SSteven Rostedt 	else
513733b7f99cSSteven Rostedt (Red Hat) 		orig_hash = &ops->func_hash->notrace_hash;
513833dc9b12SSteven Rostedt 
5139b972cc58SWang Nan 	if (reset)
5140b972cc58SWang Nan 		hash = alloc_ftrace_hash(FTRACE_HASH_DEFAULT_BITS);
5141b972cc58SWang Nan 	else
514233dc9b12SSteven Rostedt 		hash = alloc_and_copy_ftrace_hash(FTRACE_HASH_DEFAULT_BITS, *orig_hash);
5143b972cc58SWang Nan 
51443f2367baSMasami Hiramatsu 	if (!hash) {
51453f2367baSMasami Hiramatsu 		ret = -ENOMEM;
51463f2367baSMasami Hiramatsu 		goto out_regex_unlock;
51473f2367baSMasami Hiramatsu 	}
5148f45948e8SSteven Rostedt 
5149ac483c44SJiri Olsa 	if (buf && !ftrace_match_records(hash, buf, len)) {
5150ac483c44SJiri Olsa 		ret = -EINVAL;
5151ac483c44SJiri Olsa 		goto out_regex_unlock;
5152ac483c44SJiri Olsa 	}
51534f554e95SJiri Olsa 	if (ips) {
51544f554e95SJiri Olsa 		ret = ftrace_match_addr(hash, ips, cnt, remove);
5155647664eaSMasami Hiramatsu 		if (ret < 0)
5156647664eaSMasami Hiramatsu 			goto out_regex_unlock;
5157647664eaSMasami Hiramatsu 	}
515833dc9b12SSteven Rostedt 
515933dc9b12SSteven Rostedt 	mutex_lock(&ftrace_lock);
5160e16b35ddSSteven Rostedt (VMware) 	ret = ftrace_hash_move_and_update_ops(ops, orig_hash, hash, enable);
516133dc9b12SSteven Rostedt 	mutex_unlock(&ftrace_lock);
516233dc9b12SSteven Rostedt 
5163ac483c44SJiri Olsa  out_regex_unlock:
516433b7f99cSSteven Rostedt (Red Hat) 	mutex_unlock(&ops->func_hash->regex_lock);
516533dc9b12SSteven Rostedt 
516633dc9b12SSteven Rostedt 	free_ftrace_hash(hash);
516733dc9b12SSteven Rostedt 	return ret;
516841c52c0dSSteven Rostedt }
516941c52c0dSSteven Rostedt 
5170647664eaSMasami Hiramatsu static int
51714f554e95SJiri Olsa ftrace_set_addr(struct ftrace_ops *ops, unsigned long *ips, unsigned int cnt,
51724f554e95SJiri Olsa 		int remove, int reset, int enable)
5173647664eaSMasami Hiramatsu {
51744f554e95SJiri Olsa 	return ftrace_set_hash(ops, NULL, 0, ips, cnt, remove, reset, enable);
5175647664eaSMasami Hiramatsu }
5176647664eaSMasami Hiramatsu 
5177763e34e7SSteven Rostedt (VMware) #ifdef CONFIG_DYNAMIC_FTRACE_WITH_DIRECT_CALLS
5178013bf0daSSteven Rostedt (VMware) 
5179013bf0daSSteven Rostedt (VMware) struct ftrace_direct_func {
5180013bf0daSSteven Rostedt (VMware) 	struct list_head	next;
5181013bf0daSSteven Rostedt (VMware) 	unsigned long		addr;
5182013bf0daSSteven Rostedt (VMware) 	int			count;
5183013bf0daSSteven Rostedt (VMware) };
5184013bf0daSSteven Rostedt (VMware) 
5185013bf0daSSteven Rostedt (VMware) static LIST_HEAD(ftrace_direct_funcs);
5186013bf0daSSteven Rostedt (VMware) 
5187013bf0daSSteven Rostedt (VMware) /**
5188013bf0daSSteven Rostedt (VMware)  * ftrace_find_direct_func - test an address if it is a registered direct caller
5189013bf0daSSteven Rostedt (VMware)  * @addr: The address of a registered direct caller
5190013bf0daSSteven Rostedt (VMware)  *
5191013bf0daSSteven Rostedt (VMware)  * This searches to see if a ftrace direct caller has been registered
5192013bf0daSSteven Rostedt (VMware)  * at a specific address, and if so, it returns a descriptor for it.
5193013bf0daSSteven Rostedt (VMware)  *
5194013bf0daSSteven Rostedt (VMware)  * This can be used by architecture code to see if an address is
5195013bf0daSSteven Rostedt (VMware)  * a direct caller (trampoline) attached to a fentry/mcount location.
5196013bf0daSSteven Rostedt (VMware)  * This is useful for the function_graph tracer, as it may need to
5197013bf0daSSteven Rostedt (VMware)  * do adjustments if it traced a location that also has a direct
5198013bf0daSSteven Rostedt (VMware)  * trampoline attached to it.
5199013bf0daSSteven Rostedt (VMware)  */
5200013bf0daSSteven Rostedt (VMware) struct ftrace_direct_func *ftrace_find_direct_func(unsigned long addr)
5201013bf0daSSteven Rostedt (VMware) {
5202013bf0daSSteven Rostedt (VMware) 	struct ftrace_direct_func *entry;
5203013bf0daSSteven Rostedt (VMware) 	bool found = false;
5204013bf0daSSteven Rostedt (VMware) 
5205013bf0daSSteven Rostedt (VMware) 	/* May be called by fgraph trampoline (protected by rcu tasks) */
5206013bf0daSSteven Rostedt (VMware) 	list_for_each_entry_rcu(entry, &ftrace_direct_funcs, next) {
5207013bf0daSSteven Rostedt (VMware) 		if (entry->addr == addr) {
5208013bf0daSSteven Rostedt (VMware) 			found = true;
5209013bf0daSSteven Rostedt (VMware) 			break;
5210013bf0daSSteven Rostedt (VMware) 		}
5211013bf0daSSteven Rostedt (VMware) 	}
5212013bf0daSSteven Rostedt (VMware) 	if (found)
5213013bf0daSSteven Rostedt (VMware) 		return entry;
5214013bf0daSSteven Rostedt (VMware) 
5215013bf0daSSteven Rostedt (VMware) 	return NULL;
5216013bf0daSSteven Rostedt (VMware) }
5217013bf0daSSteven Rostedt (VMware) 
52188a141dd7SAlexei Starovoitov static struct ftrace_direct_func *ftrace_alloc_direct_func(unsigned long addr)
52198a141dd7SAlexei Starovoitov {
52208a141dd7SAlexei Starovoitov 	struct ftrace_direct_func *direct;
52218a141dd7SAlexei Starovoitov 
52228a141dd7SAlexei Starovoitov 	direct = kmalloc(sizeof(*direct), GFP_KERNEL);
52238a141dd7SAlexei Starovoitov 	if (!direct)
52248a141dd7SAlexei Starovoitov 		return NULL;
52258a141dd7SAlexei Starovoitov 	direct->addr = addr;
52268a141dd7SAlexei Starovoitov 	direct->count = 0;
52278a141dd7SAlexei Starovoitov 	list_add_rcu(&direct->next, &ftrace_direct_funcs);
52288a141dd7SAlexei Starovoitov 	ftrace_direct_func_count++;
52298a141dd7SAlexei Starovoitov 	return direct;
52308a141dd7SAlexei Starovoitov }
52318a141dd7SAlexei Starovoitov 
523253cd885bSSong Liu static int register_ftrace_function_nolock(struct ftrace_ops *ops);
523353cd885bSSong Liu 
5234763e34e7SSteven Rostedt (VMware) /**
5235763e34e7SSteven Rostedt (VMware)  * register_ftrace_direct - Call a custom trampoline directly
5236763e34e7SSteven Rostedt (VMware)  * @ip: The address of the nop at the beginning of a function
5237763e34e7SSteven Rostedt (VMware)  * @addr: The address of the trampoline to call at @ip
5238763e34e7SSteven Rostedt (VMware)  *
5239763e34e7SSteven Rostedt (VMware)  * This is used to connect a direct call from the nop location (@ip)
5240763e34e7SSteven Rostedt (VMware)  * at the start of ftrace traced functions. The location that it calls
5241763e34e7SSteven Rostedt (VMware)  * (@addr) must be able to handle a direct call, and save the parameters
5242763e34e7SSteven Rostedt (VMware)  * of the function being traced, and restore them (or inject new ones
5243763e34e7SSteven Rostedt (VMware)  * if needed), before returning.
5244763e34e7SSteven Rostedt (VMware)  *
5245763e34e7SSteven Rostedt (VMware)  * Returns:
5246763e34e7SSteven Rostedt (VMware)  *  0 on success
5247763e34e7SSteven Rostedt (VMware)  *  -EBUSY - Another direct function is already attached (there can be only one)
5248763e34e7SSteven Rostedt (VMware)  *  -ENODEV - @ip does not point to a ftrace nop location (or not supported)
5249763e34e7SSteven Rostedt (VMware)  *  -ENOMEM - There was an allocation failure.
5250763e34e7SSteven Rostedt (VMware)  */
5251763e34e7SSteven Rostedt (VMware) int register_ftrace_direct(unsigned long ip, unsigned long addr)
5252763e34e7SSteven Rostedt (VMware) {
5253013bf0daSSteven Rostedt (VMware) 	struct ftrace_direct_func *direct;
5254763e34e7SSteven Rostedt (VMware) 	struct ftrace_func_entry *entry;
5255763e34e7SSteven Rostedt (VMware) 	struct ftrace_hash *free_hash = NULL;
5256763e34e7SSteven Rostedt (VMware) 	struct dyn_ftrace *rec;
5257aebfd125SPeter Zijlstra 	int ret = -ENODEV;
5258763e34e7SSteven Rostedt (VMware) 
5259763e34e7SSteven Rostedt (VMware) 	mutex_lock(&direct_mutex);
5260763e34e7SSteven Rostedt (VMware) 
5261aebfd125SPeter Zijlstra 	ip = ftrace_location(ip);
5262aebfd125SPeter Zijlstra 	if (!ip)
5263aebfd125SPeter Zijlstra 		goto out_unlock;
5264aebfd125SPeter Zijlstra 
5265763e34e7SSteven Rostedt (VMware) 	/* See if there's a direct function at @ip already */
5266aebfd125SPeter Zijlstra 	ret = -EBUSY;
5267ff205766SAlexei Starovoitov 	if (ftrace_find_rec_direct(ip))
5268763e34e7SSteven Rostedt (VMware) 		goto out_unlock;
5269763e34e7SSteven Rostedt (VMware) 
5270763e34e7SSteven Rostedt (VMware) 	ret = -ENODEV;
5271763e34e7SSteven Rostedt (VMware) 	rec = lookup_rec(ip, ip);
5272763e34e7SSteven Rostedt (VMware) 	if (!rec)
5273763e34e7SSteven Rostedt (VMware) 		goto out_unlock;
5274763e34e7SSteven Rostedt (VMware) 
5275763e34e7SSteven Rostedt (VMware) 	/*
5276763e34e7SSteven Rostedt (VMware) 	 * Check if the rec says it has a direct call but we didn't
5277763e34e7SSteven Rostedt (VMware) 	 * find one earlier?
5278763e34e7SSteven Rostedt (VMware) 	 */
5279763e34e7SSteven Rostedt (VMware) 	if (WARN_ON(rec->flags & FTRACE_FL_DIRECT))
5280763e34e7SSteven Rostedt (VMware) 		goto out_unlock;
5281763e34e7SSteven Rostedt (VMware) 
5282763e34e7SSteven Rostedt (VMware) 	/* Make sure the ip points to the exact record */
5283406acdd3SSteven Rostedt (VMware) 	if (ip != rec->ip) {
5284763e34e7SSteven Rostedt (VMware) 		ip = rec->ip;
5285406acdd3SSteven Rostedt (VMware) 		/* Need to check this ip for a direct. */
5286ff205766SAlexei Starovoitov 		if (ftrace_find_rec_direct(ip))
5287406acdd3SSteven Rostedt (VMware) 			goto out_unlock;
5288406acdd3SSteven Rostedt (VMware) 	}
5289763e34e7SSteven Rostedt (VMware) 
5290763e34e7SSteven Rostedt (VMware) 	ret = -ENOMEM;
5291013bf0daSSteven Rostedt (VMware) 	direct = ftrace_find_direct_func(addr);
5292013bf0daSSteven Rostedt (VMware) 	if (!direct) {
52938a141dd7SAlexei Starovoitov 		direct = ftrace_alloc_direct_func(addr);
52941904a814SJiri Olsa 		if (!direct)
5295013bf0daSSteven Rostedt (VMware) 			goto out_unlock;
5296013bf0daSSteven Rostedt (VMware) 	}
5297013bf0daSSteven Rostedt (VMware) 
52981904a814SJiri Olsa 	entry = ftrace_add_rec_direct(ip, addr, &free_hash);
52991904a814SJiri Olsa 	if (!entry)
53001904a814SJiri Olsa 		goto out_unlock;
5301763e34e7SSteven Rostedt (VMware) 
5302763e34e7SSteven Rostedt (VMware) 	ret = ftrace_set_filter_ip(&direct_ops, ip, 0, 0);
5303763e34e7SSteven Rostedt (VMware) 
5304763e34e7SSteven Rostedt (VMware) 	if (!ret && !(direct_ops.flags & FTRACE_OPS_FL_ENABLED)) {
530553cd885bSSong Liu 		ret = register_ftrace_function_nolock(&direct_ops);
5306763e34e7SSteven Rostedt (VMware) 		if (ret)
5307763e34e7SSteven Rostedt (VMware) 			ftrace_set_filter_ip(&direct_ops, ip, 1, 0);
5308763e34e7SSteven Rostedt (VMware) 	}
5309763e34e7SSteven Rostedt (VMware) 
5310013bf0daSSteven Rostedt (VMware) 	if (ret) {
53117d54c15cSSong Liu 		remove_hash_entry(direct_functions, entry);
5312763e34e7SSteven Rostedt (VMware) 		kfree(entry);
5313013bf0daSSteven Rostedt (VMware) 		if (!direct->count) {
5314013bf0daSSteven Rostedt (VMware) 			list_del_rcu(&direct->next);
5315013bf0daSSteven Rostedt (VMware) 			synchronize_rcu_tasks();
5316013bf0daSSteven Rostedt (VMware) 			kfree(direct);
5317013bf0daSSteven Rostedt (VMware) 			if (free_hash)
5318013bf0daSSteven Rostedt (VMware) 				free_ftrace_hash(free_hash);
5319013bf0daSSteven Rostedt (VMware) 			free_hash = NULL;
5320a3ad1a7eSSteven Rostedt (VMware) 			ftrace_direct_func_count--;
5321013bf0daSSteven Rostedt (VMware) 		}
5322013bf0daSSteven Rostedt (VMware) 	} else {
5323013bf0daSSteven Rostedt (VMware) 		direct->count++;
5324013bf0daSSteven Rostedt (VMware) 	}
5325763e34e7SSteven Rostedt (VMware)  out_unlock:
5326763e34e7SSteven Rostedt (VMware) 	mutex_unlock(&direct_mutex);
5327763e34e7SSteven Rostedt (VMware) 
5328763e34e7SSteven Rostedt (VMware) 	if (free_hash) {
5329763e34e7SSteven Rostedt (VMware) 		synchronize_rcu_tasks();
5330763e34e7SSteven Rostedt (VMware) 		free_ftrace_hash(free_hash);
5331763e34e7SSteven Rostedt (VMware) 	}
5332763e34e7SSteven Rostedt (VMware) 
5333763e34e7SSteven Rostedt (VMware) 	return ret;
5334763e34e7SSteven Rostedt (VMware) }
5335763e34e7SSteven Rostedt (VMware) EXPORT_SYMBOL_GPL(register_ftrace_direct);
5336763e34e7SSteven Rostedt (VMware) 
5337ea806eb3SSteven Rostedt (VMware) static struct ftrace_func_entry *find_direct_entry(unsigned long *ip,
5338ea806eb3SSteven Rostedt (VMware) 						   struct dyn_ftrace **recp)
5339763e34e7SSteven Rostedt (VMware) {
5340763e34e7SSteven Rostedt (VMware) 	struct ftrace_func_entry *entry;
5341763e34e7SSteven Rostedt (VMware) 	struct dyn_ftrace *rec;
5342763e34e7SSteven Rostedt (VMware) 
5343128161f4SSteven Rostedt (VMware) 	rec = lookup_rec(*ip, *ip);
5344128161f4SSteven Rostedt (VMware) 	if (!rec)
5345128161f4SSteven Rostedt (VMware) 		return NULL;
5346763e34e7SSteven Rostedt (VMware) 
5347763e34e7SSteven Rostedt (VMware) 	entry = __ftrace_lookup_ip(direct_functions, rec->ip);
5348763e34e7SSteven Rostedt (VMware) 	if (!entry) {
5349763e34e7SSteven Rostedt (VMware) 		WARN_ON(rec->flags & FTRACE_FL_DIRECT);
5350128161f4SSteven Rostedt (VMware) 		return NULL;
5351763e34e7SSteven Rostedt (VMware) 	}
5352763e34e7SSteven Rostedt (VMware) 
5353763e34e7SSteven Rostedt (VMware) 	WARN_ON(!(rec->flags & FTRACE_FL_DIRECT));
5354128161f4SSteven Rostedt (VMware) 
5355128161f4SSteven Rostedt (VMware) 	/* Passed in ip just needs to be on the call site */
5356128161f4SSteven Rostedt (VMware) 	*ip = rec->ip;
5357128161f4SSteven Rostedt (VMware) 
5358ea806eb3SSteven Rostedt (VMware) 	if (recp)
5359ea806eb3SSteven Rostedt (VMware) 		*recp = rec;
5360ea806eb3SSteven Rostedt (VMware) 
5361128161f4SSteven Rostedt (VMware) 	return entry;
5362763e34e7SSteven Rostedt (VMware) }
5363763e34e7SSteven Rostedt (VMware) 
5364128161f4SSteven Rostedt (VMware) int unregister_ftrace_direct(unsigned long ip, unsigned long addr)
5365128161f4SSteven Rostedt (VMware) {
5366128161f4SSteven Rostedt (VMware) 	struct ftrace_direct_func *direct;
5367128161f4SSteven Rostedt (VMware) 	struct ftrace_func_entry *entry;
53687d5b7cadSJiri Olsa 	struct ftrace_hash *hash;
5369128161f4SSteven Rostedt (VMware) 	int ret = -ENODEV;
5370128161f4SSteven Rostedt (VMware) 
5371128161f4SSteven Rostedt (VMware) 	mutex_lock(&direct_mutex);
5372128161f4SSteven Rostedt (VMware) 
5373aebfd125SPeter Zijlstra 	ip = ftrace_location(ip);
5374aebfd125SPeter Zijlstra 	if (!ip)
5375aebfd125SPeter Zijlstra 		goto out_unlock;
5376aebfd125SPeter Zijlstra 
5377ea806eb3SSteven Rostedt (VMware) 	entry = find_direct_entry(&ip, NULL);
5378128161f4SSteven Rostedt (VMware) 	if (!entry)
5379128161f4SSteven Rostedt (VMware) 		goto out_unlock;
5380128161f4SSteven Rostedt (VMware) 
53817d5b7cadSJiri Olsa 	hash = direct_ops.func_hash->filter_hash;
53827d5b7cadSJiri Olsa 	if (hash->count == 1)
5383763e34e7SSteven Rostedt (VMware) 		unregister_ftrace_function(&direct_ops);
5384763e34e7SSteven Rostedt (VMware) 
5385763e34e7SSteven Rostedt (VMware) 	ret = ftrace_set_filter_ip(&direct_ops, ip, 1, 0);
5386763e34e7SSteven Rostedt (VMware) 
5387763e34e7SSteven Rostedt (VMware) 	WARN_ON(ret);
5388763e34e7SSteven Rostedt (VMware) 
5389763e34e7SSteven Rostedt (VMware) 	remove_hash_entry(direct_functions, entry);
5390763e34e7SSteven Rostedt (VMware) 
5391013bf0daSSteven Rostedt (VMware) 	direct = ftrace_find_direct_func(addr);
5392013bf0daSSteven Rostedt (VMware) 	if (!WARN_ON(!direct)) {
5393013bf0daSSteven Rostedt (VMware) 		/* This is the good path (see the ! before WARN) */
5394013bf0daSSteven Rostedt (VMware) 		direct->count--;
5395013bf0daSSteven Rostedt (VMware) 		WARN_ON(direct->count < 0);
5396013bf0daSSteven Rostedt (VMware) 		if (!direct->count) {
5397013bf0daSSteven Rostedt (VMware) 			list_del_rcu(&direct->next);
5398013bf0daSSteven Rostedt (VMware) 			synchronize_rcu_tasks();
5399013bf0daSSteven Rostedt (VMware) 			kfree(direct);
5400353da879SSteven Rostedt (VMware) 			kfree(entry);
5401a3ad1a7eSSteven Rostedt (VMware) 			ftrace_direct_func_count--;
5402013bf0daSSteven Rostedt (VMware) 		}
5403013bf0daSSteven Rostedt (VMware) 	}
5404763e34e7SSteven Rostedt (VMware)  out_unlock:
5405763e34e7SSteven Rostedt (VMware) 	mutex_unlock(&direct_mutex);
5406763e34e7SSteven Rostedt (VMware) 
5407763e34e7SSteven Rostedt (VMware) 	return ret;
5408763e34e7SSteven Rostedt (VMware) }
5409763e34e7SSteven Rostedt (VMware) EXPORT_SYMBOL_GPL(unregister_ftrace_direct);
54100567d680SSteven Rostedt (VMware) 
54110567d680SSteven Rostedt (VMware) static struct ftrace_ops stub_ops = {
54120567d680SSteven Rostedt (VMware) 	.func		= ftrace_stub,
54130567d680SSteven Rostedt (VMware) };
54140567d680SSteven Rostedt (VMware) 
54150567d680SSteven Rostedt (VMware) /**
5416ea806eb3SSteven Rostedt (VMware)  * ftrace_modify_direct_caller - modify ftrace nop directly
5417ea806eb3SSteven Rostedt (VMware)  * @entry: The ftrace hash entry of the direct helper for @rec
5418ea806eb3SSteven Rostedt (VMware)  * @rec: The record representing the function site to patch
5419ea806eb3SSteven Rostedt (VMware)  * @old_addr: The location that the site at @rec->ip currently calls
5420ea806eb3SSteven Rostedt (VMware)  * @new_addr: The location that the site at @rec->ip should call
5421ea806eb3SSteven Rostedt (VMware)  *
5422ea806eb3SSteven Rostedt (VMware)  * An architecture may overwrite this function to optimize the
5423ea806eb3SSteven Rostedt (VMware)  * changing of the direct callback on an ftrace nop location.
5424ea806eb3SSteven Rostedt (VMware)  * This is called with the ftrace_lock mutex held, and no other
5425ea806eb3SSteven Rostedt (VMware)  * ftrace callbacks are on the associated record (@rec). Thus,
5426ea806eb3SSteven Rostedt (VMware)  * it is safe to modify the ftrace record, where it should be
5427ea806eb3SSteven Rostedt (VMware)  * currently calling @old_addr directly, to call @new_addr.
5428ea806eb3SSteven Rostedt (VMware)  *
54299d2ce78dSSong Liu  * This is called with direct_mutex locked.
54309d2ce78dSSong Liu  *
5431ea806eb3SSteven Rostedt (VMware)  * Safety checks should be made to make sure that the code at
5432ea806eb3SSteven Rostedt (VMware)  * @rec->ip is currently calling @old_addr. And this must
5433ea806eb3SSteven Rostedt (VMware)  * also update entry->direct to @new_addr.
5434ea806eb3SSteven Rostedt (VMware)  */
5435ea806eb3SSteven Rostedt (VMware) int __weak ftrace_modify_direct_caller(struct ftrace_func_entry *entry,
5436ea806eb3SSteven Rostedt (VMware) 				       struct dyn_ftrace *rec,
5437ea806eb3SSteven Rostedt (VMware) 				       unsigned long old_addr,
5438ea806eb3SSteven Rostedt (VMware) 				       unsigned long new_addr)
5439ea806eb3SSteven Rostedt (VMware) {
5440ea806eb3SSteven Rostedt (VMware) 	unsigned long ip = rec->ip;
5441ea806eb3SSteven Rostedt (VMware) 	int ret;
5442ea806eb3SSteven Rostedt (VMware) 
54439d2ce78dSSong Liu 	lockdep_assert_held(&direct_mutex);
54449d2ce78dSSong Liu 
5445ea806eb3SSteven Rostedt (VMware) 	/*
5446ea806eb3SSteven Rostedt (VMware) 	 * The ftrace_lock was used to determine if the record
5447ea806eb3SSteven Rostedt (VMware) 	 * had more than one registered user to it. If it did,
5448ea806eb3SSteven Rostedt (VMware) 	 * we needed to prevent that from changing to do the quick
5449ea806eb3SSteven Rostedt (VMware) 	 * switch. But if it did not (only a direct caller was attached)
5450ea806eb3SSteven Rostedt (VMware) 	 * then this function is called. But this function can deal
5451ea806eb3SSteven Rostedt (VMware) 	 * with attached callers to the rec that we care about, and
5452ea806eb3SSteven Rostedt (VMware) 	 * since this function uses standard ftrace calls that take
5453ea806eb3SSteven Rostedt (VMware) 	 * the ftrace_lock mutex, we need to release it.
5454ea806eb3SSteven Rostedt (VMware) 	 */
5455ea806eb3SSteven Rostedt (VMware) 	mutex_unlock(&ftrace_lock);
5456ea806eb3SSteven Rostedt (VMware) 
5457ea806eb3SSteven Rostedt (VMware) 	/*
5458ea806eb3SSteven Rostedt (VMware) 	 * By setting a stub function at the same address, we force
5459ea806eb3SSteven Rostedt (VMware) 	 * the code to call the iterator and the direct_ops helper.
5460ea806eb3SSteven Rostedt (VMware) 	 * This means that @ip does not call the direct call, and
5461ea806eb3SSteven Rostedt (VMware) 	 * we can simply modify it.
5462ea806eb3SSteven Rostedt (VMware) 	 */
5463ea806eb3SSteven Rostedt (VMware) 	ret = ftrace_set_filter_ip(&stub_ops, ip, 0, 0);
5464ea806eb3SSteven Rostedt (VMware) 	if (ret)
5465ea806eb3SSteven Rostedt (VMware) 		goto out_lock;
5466ea806eb3SSteven Rostedt (VMware) 
54679d2ce78dSSong Liu 	ret = register_ftrace_function_nolock(&stub_ops);
5468ea806eb3SSteven Rostedt (VMware) 	if (ret) {
5469ea806eb3SSteven Rostedt (VMware) 		ftrace_set_filter_ip(&stub_ops, ip, 1, 0);
5470ea806eb3SSteven Rostedt (VMware) 		goto out_lock;
5471ea806eb3SSteven Rostedt (VMware) 	}
5472ea806eb3SSteven Rostedt (VMware) 
5473ea806eb3SSteven Rostedt (VMware) 	entry->direct = new_addr;
5474ea806eb3SSteven Rostedt (VMware) 
5475ea806eb3SSteven Rostedt (VMware) 	/*
5476ea806eb3SSteven Rostedt (VMware) 	 * By removing the stub, we put back the direct call, calling
5477ea806eb3SSteven Rostedt (VMware) 	 * the @new_addr.
5478ea806eb3SSteven Rostedt (VMware) 	 */
5479ea806eb3SSteven Rostedt (VMware) 	unregister_ftrace_function(&stub_ops);
5480ea806eb3SSteven Rostedt (VMware) 	ftrace_set_filter_ip(&stub_ops, ip, 1, 0);
5481ea806eb3SSteven Rostedt (VMware) 
5482ea806eb3SSteven Rostedt (VMware)  out_lock:
5483ea806eb3SSteven Rostedt (VMware) 	mutex_lock(&ftrace_lock);
5484ea806eb3SSteven Rostedt (VMware) 
5485ea806eb3SSteven Rostedt (VMware) 	return ret;
5486ea806eb3SSteven Rostedt (VMware) }
5487ea806eb3SSteven Rostedt (VMware) 
5488ea806eb3SSteven Rostedt (VMware) /**
54890567d680SSteven Rostedt (VMware)  * modify_ftrace_direct - Modify an existing direct call to call something else
54900567d680SSteven Rostedt (VMware)  * @ip: The instruction pointer to modify
54910567d680SSteven Rostedt (VMware)  * @old_addr: The address that the current @ip calls directly
54920567d680SSteven Rostedt (VMware)  * @new_addr: The address that the @ip should call
54930567d680SSteven Rostedt (VMware)  *
54940567d680SSteven Rostedt (VMware)  * This modifies a ftrace direct caller at an instruction pointer without
54950567d680SSteven Rostedt (VMware)  * having to disable it first. The direct call will switch over to the
54960567d680SSteven Rostedt (VMware)  * @new_addr without missing anything.
54970567d680SSteven Rostedt (VMware)  *
54980567d680SSteven Rostedt (VMware)  * Returns: zero on success. Non zero on error, which includes:
54990567d680SSteven Rostedt (VMware)  *  -ENODEV : the @ip given has no direct caller attached
55000567d680SSteven Rostedt (VMware)  *  -EINVAL : the @old_addr does not match the current direct caller
55010567d680SSteven Rostedt (VMware)  */
55020567d680SSteven Rostedt (VMware) int modify_ftrace_direct(unsigned long ip,
55030567d680SSteven Rostedt (VMware) 			 unsigned long old_addr, unsigned long new_addr)
55040567d680SSteven Rostedt (VMware) {
55058a141dd7SAlexei Starovoitov 	struct ftrace_direct_func *direct, *new_direct = NULL;
55060567d680SSteven Rostedt (VMware) 	struct ftrace_func_entry *entry;
5507ea806eb3SSteven Rostedt (VMware) 	struct dyn_ftrace *rec;
55080567d680SSteven Rostedt (VMware) 	int ret = -ENODEV;
55090567d680SSteven Rostedt (VMware) 
55100567d680SSteven Rostedt (VMware) 	mutex_lock(&direct_mutex);
55110567d680SSteven Rostedt (VMware) 
5512ea806eb3SSteven Rostedt (VMware) 	mutex_lock(&ftrace_lock);
5513aebfd125SPeter Zijlstra 
5514aebfd125SPeter Zijlstra 	ip = ftrace_location(ip);
5515aebfd125SPeter Zijlstra 	if (!ip)
5516aebfd125SPeter Zijlstra 		goto out_unlock;
5517aebfd125SPeter Zijlstra 
5518ea806eb3SSteven Rostedt (VMware) 	entry = find_direct_entry(&ip, &rec);
55190567d680SSteven Rostedt (VMware) 	if (!entry)
55200567d680SSteven Rostedt (VMware) 		goto out_unlock;
55210567d680SSteven Rostedt (VMware) 
55220567d680SSteven Rostedt (VMware) 	ret = -EINVAL;
55230567d680SSteven Rostedt (VMware) 	if (entry->direct != old_addr)
55240567d680SSteven Rostedt (VMware) 		goto out_unlock;
55250567d680SSteven Rostedt (VMware) 
55268a141dd7SAlexei Starovoitov 	direct = ftrace_find_direct_func(old_addr);
55278a141dd7SAlexei Starovoitov 	if (WARN_ON(!direct))
55288a141dd7SAlexei Starovoitov 		goto out_unlock;
55298a141dd7SAlexei Starovoitov 	if (direct->count > 1) {
55308a141dd7SAlexei Starovoitov 		ret = -ENOMEM;
55318a141dd7SAlexei Starovoitov 		new_direct = ftrace_alloc_direct_func(new_addr);
55328a141dd7SAlexei Starovoitov 		if (!new_direct)
55338a141dd7SAlexei Starovoitov 			goto out_unlock;
55348a141dd7SAlexei Starovoitov 		direct->count--;
55358a141dd7SAlexei Starovoitov 		new_direct->count++;
55368a141dd7SAlexei Starovoitov 	} else {
55378a141dd7SAlexei Starovoitov 		direct->addr = new_addr;
55388a141dd7SAlexei Starovoitov 	}
55398a141dd7SAlexei Starovoitov 
55400567d680SSteven Rostedt (VMware) 	/*
5541ea806eb3SSteven Rostedt (VMware) 	 * If there's no other ftrace callback on the rec->ip location,
5542ea806eb3SSteven Rostedt (VMware) 	 * then it can be changed directly by the architecture.
5543ea806eb3SSteven Rostedt (VMware) 	 * If there is another caller, then we just need to change the
5544ea806eb3SSteven Rostedt (VMware) 	 * direct caller helper to point to @new_addr.
55450567d680SSteven Rostedt (VMware) 	 */
5546ea806eb3SSteven Rostedt (VMware) 	if (ftrace_rec_count(rec) == 1) {
5547ea806eb3SSteven Rostedt (VMware) 		ret = ftrace_modify_direct_caller(entry, rec, old_addr, new_addr);
5548ea806eb3SSteven Rostedt (VMware) 	} else {
5549ea806eb3SSteven Rostedt (VMware) 		entry->direct = new_addr;
5550ea806eb3SSteven Rostedt (VMware) 		ret = 0;
55510567d680SSteven Rostedt (VMware) 	}
55520567d680SSteven Rostedt (VMware) 
55538a141dd7SAlexei Starovoitov 	if (unlikely(ret && new_direct)) {
55548a141dd7SAlexei Starovoitov 		direct->count++;
55558a141dd7SAlexei Starovoitov 		list_del_rcu(&new_direct->next);
55568a141dd7SAlexei Starovoitov 		synchronize_rcu_tasks();
55578a141dd7SAlexei Starovoitov 		kfree(new_direct);
55588a141dd7SAlexei Starovoitov 		ftrace_direct_func_count--;
55598a141dd7SAlexei Starovoitov 	}
55608a141dd7SAlexei Starovoitov 
55610567d680SSteven Rostedt (VMware)  out_unlock:
5562ea806eb3SSteven Rostedt (VMware) 	mutex_unlock(&ftrace_lock);
55630567d680SSteven Rostedt (VMware) 	mutex_unlock(&direct_mutex);
55640567d680SSteven Rostedt (VMware) 	return ret;
55650567d680SSteven Rostedt (VMware) }
55660567d680SSteven Rostedt (VMware) EXPORT_SYMBOL_GPL(modify_ftrace_direct);
5567f64dd462SJiri Olsa 
556853cd885bSSong Liu #define MULTI_FLAGS (FTRACE_OPS_FL_DIRECT | FTRACE_OPS_FL_SAVE_REGS)
5569f64dd462SJiri Olsa 
5570f64dd462SJiri Olsa static int check_direct_multi(struct ftrace_ops *ops)
5571f64dd462SJiri Olsa {
5572f64dd462SJiri Olsa 	if (!(ops->flags & FTRACE_OPS_FL_INITIALIZED))
5573f64dd462SJiri Olsa 		return -EINVAL;
5574f64dd462SJiri Olsa 	if ((ops->flags & MULTI_FLAGS) != MULTI_FLAGS)
5575f64dd462SJiri Olsa 		return -EINVAL;
5576f64dd462SJiri Olsa 	return 0;
5577f64dd462SJiri Olsa }
5578f64dd462SJiri Olsa 
5579f64dd462SJiri Olsa static void remove_direct_functions_hash(struct ftrace_hash *hash, unsigned long addr)
5580f64dd462SJiri Olsa {
5581f64dd462SJiri Olsa 	struct ftrace_func_entry *entry, *del;
5582f64dd462SJiri Olsa 	int size, i;
5583f64dd462SJiri Olsa 
5584f64dd462SJiri Olsa 	size = 1 << hash->size_bits;
5585f64dd462SJiri Olsa 	for (i = 0; i < size; i++) {
5586f64dd462SJiri Olsa 		hlist_for_each_entry(entry, &hash->buckets[i], hlist) {
5587f64dd462SJiri Olsa 			del = __ftrace_lookup_ip(direct_functions, entry->ip);
5588f64dd462SJiri Olsa 			if (del && del->direct == addr) {
5589f64dd462SJiri Olsa 				remove_hash_entry(direct_functions, del);
5590f64dd462SJiri Olsa 				kfree(del);
5591f64dd462SJiri Olsa 			}
5592f64dd462SJiri Olsa 		}
5593f64dd462SJiri Olsa 	}
5594f64dd462SJiri Olsa }
5595f64dd462SJiri Olsa 
5596f64dd462SJiri Olsa /**
5597f64dd462SJiri Olsa  * register_ftrace_direct_multi - Call a custom trampoline directly
5598f64dd462SJiri Olsa  * for multiple functions registered in @ops
5599f64dd462SJiri Olsa  * @ops: The address of the struct ftrace_ops object
5600f64dd462SJiri Olsa  * @addr: The address of the trampoline to call at @ops functions
5601f64dd462SJiri Olsa  *
5602f64dd462SJiri Olsa  * This is used to connect a direct calls to @addr from the nop locations
5603f64dd462SJiri Olsa  * of the functions registered in @ops (with by ftrace_set_filter_ip
5604f64dd462SJiri Olsa  * function).
5605f64dd462SJiri Olsa  *
5606f64dd462SJiri Olsa  * The location that it calls (@addr) must be able to handle a direct call,
5607f64dd462SJiri Olsa  * and save the parameters of the function being traced, and restore them
5608f64dd462SJiri Olsa  * (or inject new ones if needed), before returning.
5609f64dd462SJiri Olsa  *
5610f64dd462SJiri Olsa  * Returns:
5611f64dd462SJiri Olsa  *  0 on success
5612f64dd462SJiri Olsa  *  -EINVAL  - The @ops object was already registered with this call or
5613f64dd462SJiri Olsa  *             when there are no functions in @ops object.
5614f64dd462SJiri Olsa  *  -EBUSY   - Another direct function is already attached (there can be only one)
5615f64dd462SJiri Olsa  *  -ENODEV  - @ip does not point to a ftrace nop location (or not supported)
5616f64dd462SJiri Olsa  *  -ENOMEM  - There was an allocation failure.
5617f64dd462SJiri Olsa  */
5618f64dd462SJiri Olsa int register_ftrace_direct_multi(struct ftrace_ops *ops, unsigned long addr)
5619f64dd462SJiri Olsa {
5620f64dd462SJiri Olsa 	struct ftrace_hash *hash, *free_hash = NULL;
5621f64dd462SJiri Olsa 	struct ftrace_func_entry *entry, *new;
5622f64dd462SJiri Olsa 	int err = -EBUSY, size, i;
5623f64dd462SJiri Olsa 
5624f64dd462SJiri Olsa 	if (ops->func || ops->trampoline)
5625f64dd462SJiri Olsa 		return -EINVAL;
5626f64dd462SJiri Olsa 	if (!(ops->flags & FTRACE_OPS_FL_INITIALIZED))
5627f64dd462SJiri Olsa 		return -EINVAL;
5628f64dd462SJiri Olsa 	if (ops->flags & FTRACE_OPS_FL_ENABLED)
5629f64dd462SJiri Olsa 		return -EINVAL;
5630f64dd462SJiri Olsa 
5631f64dd462SJiri Olsa 	hash = ops->func_hash->filter_hash;
5632f64dd462SJiri Olsa 	if (ftrace_hash_empty(hash))
5633f64dd462SJiri Olsa 		return -EINVAL;
5634f64dd462SJiri Olsa 
5635f64dd462SJiri Olsa 	mutex_lock(&direct_mutex);
5636f64dd462SJiri Olsa 
5637f64dd462SJiri Olsa 	/* Make sure requested entries are not already registered.. */
5638f64dd462SJiri Olsa 	size = 1 << hash->size_bits;
5639f64dd462SJiri Olsa 	for (i = 0; i < size; i++) {
5640f64dd462SJiri Olsa 		hlist_for_each_entry(entry, &hash->buckets[i], hlist) {
5641f64dd462SJiri Olsa 			if (ftrace_find_rec_direct(entry->ip))
5642f64dd462SJiri Olsa 				goto out_unlock;
5643f64dd462SJiri Olsa 		}
5644f64dd462SJiri Olsa 	}
5645f64dd462SJiri Olsa 
5646f64dd462SJiri Olsa 	/* ... and insert them to direct_functions hash. */
5647f64dd462SJiri Olsa 	err = -ENOMEM;
5648f64dd462SJiri Olsa 	for (i = 0; i < size; i++) {
5649f64dd462SJiri Olsa 		hlist_for_each_entry(entry, &hash->buckets[i], hlist) {
5650f64dd462SJiri Olsa 			new = ftrace_add_rec_direct(entry->ip, addr, &free_hash);
5651f64dd462SJiri Olsa 			if (!new)
5652f64dd462SJiri Olsa 				goto out_remove;
5653f64dd462SJiri Olsa 			entry->direct = addr;
5654f64dd462SJiri Olsa 		}
5655f64dd462SJiri Olsa 	}
5656f64dd462SJiri Olsa 
5657f64dd462SJiri Olsa 	ops->func = call_direct_funcs;
5658f64dd462SJiri Olsa 	ops->flags = MULTI_FLAGS;
5659f64dd462SJiri Olsa 	ops->trampoline = FTRACE_REGS_ADDR;
5660f64dd462SJiri Olsa 
566153cd885bSSong Liu 	err = register_ftrace_function_nolock(ops);
5662f64dd462SJiri Olsa 
5663f64dd462SJiri Olsa  out_remove:
5664f64dd462SJiri Olsa 	if (err)
5665f64dd462SJiri Olsa 		remove_direct_functions_hash(hash, addr);
5666f64dd462SJiri Olsa 
5667f64dd462SJiri Olsa  out_unlock:
5668f64dd462SJiri Olsa 	mutex_unlock(&direct_mutex);
5669f64dd462SJiri Olsa 
5670f64dd462SJiri Olsa 	if (free_hash) {
5671f64dd462SJiri Olsa 		synchronize_rcu_tasks();
5672f64dd462SJiri Olsa 		free_ftrace_hash(free_hash);
5673f64dd462SJiri Olsa 	}
5674f64dd462SJiri Olsa 	return err;
5675f64dd462SJiri Olsa }
5676f64dd462SJiri Olsa EXPORT_SYMBOL_GPL(register_ftrace_direct_multi);
5677f64dd462SJiri Olsa 
5678f64dd462SJiri Olsa /**
5679f64dd462SJiri Olsa  * unregister_ftrace_direct_multi - Remove calls to custom trampoline
5680f64dd462SJiri Olsa  * previously registered by register_ftrace_direct_multi for @ops object.
5681f64dd462SJiri Olsa  * @ops: The address of the struct ftrace_ops object
5682f64dd462SJiri Olsa  *
5683f64dd462SJiri Olsa  * This is used to remove a direct calls to @addr from the nop locations
5684f64dd462SJiri Olsa  * of the functions registered in @ops (with by ftrace_set_filter_ip
5685f64dd462SJiri Olsa  * function).
5686f64dd462SJiri Olsa  *
5687f64dd462SJiri Olsa  * Returns:
5688f64dd462SJiri Olsa  *  0 on success
5689f64dd462SJiri Olsa  *  -EINVAL - The @ops object was not properly registered.
5690f64dd462SJiri Olsa  */
5691f64dd462SJiri Olsa int unregister_ftrace_direct_multi(struct ftrace_ops *ops, unsigned long addr)
5692f64dd462SJiri Olsa {
5693f64dd462SJiri Olsa 	struct ftrace_hash *hash = ops->func_hash->filter_hash;
5694f64dd462SJiri Olsa 	int err;
5695f64dd462SJiri Olsa 
5696f64dd462SJiri Olsa 	if (check_direct_multi(ops))
5697f64dd462SJiri Olsa 		return -EINVAL;
5698f64dd462SJiri Olsa 	if (!(ops->flags & FTRACE_OPS_FL_ENABLED))
5699f64dd462SJiri Olsa 		return -EINVAL;
5700f64dd462SJiri Olsa 
5701f64dd462SJiri Olsa 	mutex_lock(&direct_mutex);
5702f64dd462SJiri Olsa 	err = unregister_ftrace_function(ops);
5703f64dd462SJiri Olsa 	remove_direct_functions_hash(hash, addr);
5704f64dd462SJiri Olsa 	mutex_unlock(&direct_mutex);
5705fea3ffa4SJiri Olsa 
5706fea3ffa4SJiri Olsa 	/* cleanup for possible another register call */
5707fea3ffa4SJiri Olsa 	ops->func = NULL;
5708fea3ffa4SJiri Olsa 	ops->trampoline = 0;
5709f64dd462SJiri Olsa 	return err;
5710f64dd462SJiri Olsa }
5711f64dd462SJiri Olsa EXPORT_SYMBOL_GPL(unregister_ftrace_direct_multi);
5712ccf5a89eSJiri Olsa 
5713f96f644aSSong Liu static int
5714f96f644aSSong Liu __modify_ftrace_direct_multi(struct ftrace_ops *ops, unsigned long addr)
5715ccf5a89eSJiri Olsa {
5716ed292718SSteven Rostedt (VMware) 	struct ftrace_hash *hash;
5717ccf5a89eSJiri Olsa 	struct ftrace_func_entry *entry, *iter;
5718ed292718SSteven Rostedt (VMware) 	static struct ftrace_ops tmp_ops = {
5719ed292718SSteven Rostedt (VMware) 		.func		= ftrace_stub,
5720ed292718SSteven Rostedt (VMware) 		.flags		= FTRACE_OPS_FL_STUB,
5721ed292718SSteven Rostedt (VMware) 	};
5722ccf5a89eSJiri Olsa 	int i, size;
5723ccf5a89eSJiri Olsa 	int err;
5724ccf5a89eSJiri Olsa 
5725f96f644aSSong Liu 	lockdep_assert_held_once(&direct_mutex);
5726ed292718SSteven Rostedt (VMware) 
5727ed292718SSteven Rostedt (VMware) 	/* Enable the tmp_ops to have the same functions as the direct ops */
5728ed292718SSteven Rostedt (VMware) 	ftrace_ops_init(&tmp_ops);
5729ed292718SSteven Rostedt (VMware) 	tmp_ops.func_hash = ops->func_hash;
5730ed292718SSteven Rostedt (VMware) 
573153cd885bSSong Liu 	err = register_ftrace_function_nolock(&tmp_ops);
5732ed292718SSteven Rostedt (VMware) 	if (err)
5733f96f644aSSong Liu 		return err;
5734ccf5a89eSJiri Olsa 
5735ccf5a89eSJiri Olsa 	/*
5736ed292718SSteven Rostedt (VMware) 	 * Now the ftrace_ops_list_func() is called to do the direct callers.
5737ed292718SSteven Rostedt (VMware) 	 * We can safely change the direct functions attached to each entry.
5738ccf5a89eSJiri Olsa 	 */
5739ed292718SSteven Rostedt (VMware) 	mutex_lock(&ftrace_lock);
5740ccf5a89eSJiri Olsa 
5741ed292718SSteven Rostedt (VMware) 	hash = ops->func_hash->filter_hash;
5742ccf5a89eSJiri Olsa 	size = 1 << hash->size_bits;
5743ccf5a89eSJiri Olsa 	for (i = 0; i < size; i++) {
5744ccf5a89eSJiri Olsa 		hlist_for_each_entry(iter, &hash->buckets[i], hlist) {
5745ccf5a89eSJiri Olsa 			entry = __ftrace_lookup_ip(direct_functions, iter->ip);
5746ccf5a89eSJiri Olsa 			if (!entry)
5747ccf5a89eSJiri Olsa 				continue;
5748ccf5a89eSJiri Olsa 			entry->direct = addr;
5749ccf5a89eSJiri Olsa 		}
5750ccf5a89eSJiri Olsa 	}
5751ccf5a89eSJiri Olsa 
57522e6e9058SJiri Olsa 	mutex_unlock(&ftrace_lock);
57532e6e9058SJiri Olsa 
5754ed292718SSteven Rostedt (VMware) 	/* Removing the tmp_ops will add the updated direct callers to the functions */
5755ed292718SSteven Rostedt (VMware) 	unregister_ftrace_function(&tmp_ops);
5756ccf5a89eSJiri Olsa 
5757f96f644aSSong Liu 	return err;
5758f96f644aSSong Liu }
5759f96f644aSSong Liu 
5760f96f644aSSong Liu /**
5761f96f644aSSong Liu  * modify_ftrace_direct_multi_nolock - Modify an existing direct 'multi' call
5762f96f644aSSong Liu  * to call something else
5763f96f644aSSong Liu  * @ops: The address of the struct ftrace_ops object
5764f96f644aSSong Liu  * @addr: The address of the new trampoline to call at @ops functions
5765f96f644aSSong Liu  *
5766f96f644aSSong Liu  * This is used to unregister currently registered direct caller and
5767f96f644aSSong Liu  * register new one @addr on functions registered in @ops object.
5768f96f644aSSong Liu  *
5769f96f644aSSong Liu  * Note there's window between ftrace_shutdown and ftrace_startup calls
5770f96f644aSSong Liu  * where there will be no callbacks called.
5771f96f644aSSong Liu  *
5772f96f644aSSong Liu  * Caller should already have direct_mutex locked, so we don't lock
5773f96f644aSSong Liu  * direct_mutex here.
5774f96f644aSSong Liu  *
5775f96f644aSSong Liu  * Returns: zero on success. Non zero on error, which includes:
5776f96f644aSSong Liu  *  -EINVAL - The @ops object was not properly registered.
5777f96f644aSSong Liu  */
5778f96f644aSSong Liu int modify_ftrace_direct_multi_nolock(struct ftrace_ops *ops, unsigned long addr)
5779f96f644aSSong Liu {
5780f96f644aSSong Liu 	if (check_direct_multi(ops))
5781f96f644aSSong Liu 		return -EINVAL;
5782f96f644aSSong Liu 	if (!(ops->flags & FTRACE_OPS_FL_ENABLED))
5783f96f644aSSong Liu 		return -EINVAL;
5784f96f644aSSong Liu 
5785f96f644aSSong Liu 	return __modify_ftrace_direct_multi(ops, addr);
5786f96f644aSSong Liu }
5787f96f644aSSong Liu EXPORT_SYMBOL_GPL(modify_ftrace_direct_multi_nolock);
5788f96f644aSSong Liu 
5789f96f644aSSong Liu /**
5790f96f644aSSong Liu  * modify_ftrace_direct_multi - Modify an existing direct 'multi' call
5791f96f644aSSong Liu  * to call something else
5792f96f644aSSong Liu  * @ops: The address of the struct ftrace_ops object
5793f96f644aSSong Liu  * @addr: The address of the new trampoline to call at @ops functions
5794f96f644aSSong Liu  *
5795f96f644aSSong Liu  * This is used to unregister currently registered direct caller and
5796f96f644aSSong Liu  * register new one @addr on functions registered in @ops object.
5797f96f644aSSong Liu  *
5798f96f644aSSong Liu  * Note there's window between ftrace_shutdown and ftrace_startup calls
5799f96f644aSSong Liu  * where there will be no callbacks called.
5800f96f644aSSong Liu  *
5801f96f644aSSong Liu  * Returns: zero on success. Non zero on error, which includes:
5802f96f644aSSong Liu  *  -EINVAL - The @ops object was not properly registered.
5803f96f644aSSong Liu  */
5804f96f644aSSong Liu int modify_ftrace_direct_multi(struct ftrace_ops *ops, unsigned long addr)
5805f96f644aSSong Liu {
5806f96f644aSSong Liu 	int err;
5807f96f644aSSong Liu 
5808f96f644aSSong Liu 	if (check_direct_multi(ops))
5809f96f644aSSong Liu 		return -EINVAL;
5810f96f644aSSong Liu 	if (!(ops->flags & FTRACE_OPS_FL_ENABLED))
5811f96f644aSSong Liu 		return -EINVAL;
5812f96f644aSSong Liu 
5813f96f644aSSong Liu 	mutex_lock(&direct_mutex);
5814f96f644aSSong Liu 	err = __modify_ftrace_direct_multi(ops, addr);
5815ccf5a89eSJiri Olsa 	mutex_unlock(&direct_mutex);
5816ccf5a89eSJiri Olsa 	return err;
5817ccf5a89eSJiri Olsa }
5818ccf5a89eSJiri Olsa EXPORT_SYMBOL_GPL(modify_ftrace_direct_multi);
5819763e34e7SSteven Rostedt (VMware) #endif /* CONFIG_DYNAMIC_FTRACE_WITH_DIRECT_CALLS */
5820763e34e7SSteven Rostedt (VMware) 
5821647664eaSMasami Hiramatsu /**
5822647664eaSMasami Hiramatsu  * ftrace_set_filter_ip - set a function to filter on in ftrace by address
5823647664eaSMasami Hiramatsu  * @ops - the ops to set the filter with
5824647664eaSMasami Hiramatsu  * @ip - the address to add to or remove from the filter.
5825647664eaSMasami Hiramatsu  * @remove - non zero to remove the ip from the filter
5826647664eaSMasami Hiramatsu  * @reset - non zero to reset all filters before applying this filter.
5827647664eaSMasami Hiramatsu  *
5828647664eaSMasami Hiramatsu  * Filters denote which functions should be enabled when tracing is enabled
5829f2cc020dSIngo Molnar  * If @ip is NULL, it fails to update filter.
5830647664eaSMasami Hiramatsu  */
5831647664eaSMasami Hiramatsu int ftrace_set_filter_ip(struct ftrace_ops *ops, unsigned long ip,
5832647664eaSMasami Hiramatsu 			 int remove, int reset)
5833647664eaSMasami Hiramatsu {
5834f04f24fbSMasami Hiramatsu 	ftrace_ops_init(ops);
58354f554e95SJiri Olsa 	return ftrace_set_addr(ops, &ip, 1, remove, reset, 1);
5836647664eaSMasami Hiramatsu }
5837647664eaSMasami Hiramatsu EXPORT_SYMBOL_GPL(ftrace_set_filter_ip);
5838647664eaSMasami Hiramatsu 
5839d032ae89SJoel Fernandes /**
58404f554e95SJiri Olsa  * ftrace_set_filter_ips - set functions to filter on in ftrace by addresses
58414f554e95SJiri Olsa  * @ops - the ops to set the filter with
58424f554e95SJiri Olsa  * @ips - the array of addresses to add to or remove from the filter.
58434f554e95SJiri Olsa  * @cnt - the number of addresses in @ips
58444f554e95SJiri Olsa  * @remove - non zero to remove ips from the filter
58454f554e95SJiri Olsa  * @reset - non zero to reset all filters before applying this filter.
58464f554e95SJiri Olsa  *
58474f554e95SJiri Olsa  * Filters denote which functions should be enabled when tracing is enabled
58484f554e95SJiri Olsa  * If @ips array or any ip specified within is NULL , it fails to update filter.
58494f554e95SJiri Olsa  */
58504f554e95SJiri Olsa int ftrace_set_filter_ips(struct ftrace_ops *ops, unsigned long *ips,
58514f554e95SJiri Olsa 			  unsigned int cnt, int remove, int reset)
58524f554e95SJiri Olsa {
58534f554e95SJiri Olsa 	ftrace_ops_init(ops);
58544f554e95SJiri Olsa 	return ftrace_set_addr(ops, ips, cnt, remove, reset, 1);
58554f554e95SJiri Olsa }
58564f554e95SJiri Olsa EXPORT_SYMBOL_GPL(ftrace_set_filter_ips);
58574f554e95SJiri Olsa 
58584f554e95SJiri Olsa /**
5859d032ae89SJoel Fernandes  * ftrace_ops_set_global_filter - setup ops to use global filters
5860d032ae89SJoel Fernandes  * @ops - the ops which will use the global filters
5861d032ae89SJoel Fernandes  *
5862d032ae89SJoel Fernandes  * ftrace users who need global function trace filtering should call this.
5863d032ae89SJoel Fernandes  * It can set the global filter only if ops were not initialized before.
5864d032ae89SJoel Fernandes  */
5865d032ae89SJoel Fernandes void ftrace_ops_set_global_filter(struct ftrace_ops *ops)
5866d032ae89SJoel Fernandes {
5867d032ae89SJoel Fernandes 	if (ops->flags & FTRACE_OPS_FL_INITIALIZED)
5868d032ae89SJoel Fernandes 		return;
5869d032ae89SJoel Fernandes 
5870d032ae89SJoel Fernandes 	ftrace_ops_init(ops);
5871d032ae89SJoel Fernandes 	ops->func_hash = &global_ops.local_hash;
5872d032ae89SJoel Fernandes }
5873d032ae89SJoel Fernandes EXPORT_SYMBOL_GPL(ftrace_ops_set_global_filter);
5874d032ae89SJoel Fernandes 
5875647664eaSMasami Hiramatsu static int
5876647664eaSMasami Hiramatsu ftrace_set_regex(struct ftrace_ops *ops, unsigned char *buf, int len,
5877647664eaSMasami Hiramatsu 		 int reset, int enable)
5878647664eaSMasami Hiramatsu {
58794f554e95SJiri Olsa 	return ftrace_set_hash(ops, buf, len, NULL, 0, 0, reset, enable);
5880647664eaSMasami Hiramatsu }
5881647664eaSMasami Hiramatsu 
588277a2b37dSSteven Rostedt /**
588377a2b37dSSteven Rostedt  * ftrace_set_filter - set a function to filter on in ftrace
5884936e074bSSteven Rostedt  * @ops - the ops to set the filter with
588577a2b37dSSteven Rostedt  * @buf - the string that holds the function filter text.
588677a2b37dSSteven Rostedt  * @len - the length of the string.
588777a2b37dSSteven Rostedt  * @reset - non zero to reset all filters before applying this filter.
588877a2b37dSSteven Rostedt  *
588977a2b37dSSteven Rostedt  * Filters denote which functions should be enabled when tracing is enabled.
589077a2b37dSSteven Rostedt  * If @buf is NULL and reset is set, all functions will be enabled for tracing.
589177a2b37dSSteven Rostedt  */
5892ac483c44SJiri Olsa int ftrace_set_filter(struct ftrace_ops *ops, unsigned char *buf,
5893936e074bSSteven Rostedt 		       int len, int reset)
589477a2b37dSSteven Rostedt {
5895f04f24fbSMasami Hiramatsu 	ftrace_ops_init(ops);
5896ac483c44SJiri Olsa 	return ftrace_set_regex(ops, buf, len, reset, 1);
589741c52c0dSSteven Rostedt }
5898936e074bSSteven Rostedt EXPORT_SYMBOL_GPL(ftrace_set_filter);
58994eebcc81SSteven Rostedt 
590041c52c0dSSteven Rostedt /**
590141c52c0dSSteven Rostedt  * ftrace_set_notrace - set a function to not trace in ftrace
5902936e074bSSteven Rostedt  * @ops - the ops to set the notrace filter with
590341c52c0dSSteven Rostedt  * @buf - the string that holds the function notrace text.
590441c52c0dSSteven Rostedt  * @len - the length of the string.
590541c52c0dSSteven Rostedt  * @reset - non zero to reset all filters before applying this filter.
590641c52c0dSSteven Rostedt  *
590741c52c0dSSteven Rostedt  * Notrace Filters denote which functions should not be enabled when tracing
590841c52c0dSSteven Rostedt  * is enabled. If @buf is NULL and reset is set, all functions will be enabled
590941c52c0dSSteven Rostedt  * for tracing.
591041c52c0dSSteven Rostedt  */
5911ac483c44SJiri Olsa int ftrace_set_notrace(struct ftrace_ops *ops, unsigned char *buf,
5912936e074bSSteven Rostedt 			int len, int reset)
5913936e074bSSteven Rostedt {
5914f04f24fbSMasami Hiramatsu 	ftrace_ops_init(ops);
5915ac483c44SJiri Olsa 	return ftrace_set_regex(ops, buf, len, reset, 0);
5916936e074bSSteven Rostedt }
5917936e074bSSteven Rostedt EXPORT_SYMBOL_GPL(ftrace_set_notrace);
5918936e074bSSteven Rostedt /**
59198d1b065dSJiaxing Wang  * ftrace_set_global_filter - set a function to filter on with global tracers
5920936e074bSSteven Rostedt  * @buf - the string that holds the function filter text.
5921936e074bSSteven Rostedt  * @len - the length of the string.
5922936e074bSSteven Rostedt  * @reset - non zero to reset all filters before applying this filter.
5923936e074bSSteven Rostedt  *
5924936e074bSSteven Rostedt  * Filters denote which functions should be enabled when tracing is enabled.
5925936e074bSSteven Rostedt  * If @buf is NULL and reset is set, all functions will be enabled for tracing.
5926936e074bSSteven Rostedt  */
5927936e074bSSteven Rostedt void ftrace_set_global_filter(unsigned char *buf, int len, int reset)
5928936e074bSSteven Rostedt {
5929936e074bSSteven Rostedt 	ftrace_set_regex(&global_ops, buf, len, reset, 1);
5930936e074bSSteven Rostedt }
5931936e074bSSteven Rostedt EXPORT_SYMBOL_GPL(ftrace_set_global_filter);
5932936e074bSSteven Rostedt 
5933936e074bSSteven Rostedt /**
59348d1b065dSJiaxing Wang  * ftrace_set_global_notrace - set a function to not trace with global tracers
5935936e074bSSteven Rostedt  * @buf - the string that holds the function notrace text.
5936936e074bSSteven Rostedt  * @len - the length of the string.
5937936e074bSSteven Rostedt  * @reset - non zero to reset all filters before applying this filter.
5938936e074bSSteven Rostedt  *
5939936e074bSSteven Rostedt  * Notrace Filters denote which functions should not be enabled when tracing
5940936e074bSSteven Rostedt  * is enabled. If @buf is NULL and reset is set, all functions will be enabled
5941936e074bSSteven Rostedt  * for tracing.
5942936e074bSSteven Rostedt  */
5943936e074bSSteven Rostedt void ftrace_set_global_notrace(unsigned char *buf, int len, int reset)
594441c52c0dSSteven Rostedt {
5945f45948e8SSteven Rostedt 	ftrace_set_regex(&global_ops, buf, len, reset, 0);
594677a2b37dSSteven Rostedt }
5947936e074bSSteven Rostedt EXPORT_SYMBOL_GPL(ftrace_set_global_notrace);
594877a2b37dSSteven Rostedt 
59492af15d6aSSteven Rostedt /*
59502af15d6aSSteven Rostedt  * command line interface to allow users to set filters on boot up.
59512af15d6aSSteven Rostedt  */
59522af15d6aSSteven Rostedt #define FTRACE_FILTER_SIZE		COMMAND_LINE_SIZE
59532af15d6aSSteven Rostedt static char ftrace_notrace_buf[FTRACE_FILTER_SIZE] __initdata;
59542af15d6aSSteven Rostedt static char ftrace_filter_buf[FTRACE_FILTER_SIZE] __initdata;
59552af15d6aSSteven Rostedt 
5956f1ed7c74SSteven Rostedt (Red Hat) /* Used by function selftest to not test if filter is set */
5957f1ed7c74SSteven Rostedt (Red Hat) bool ftrace_filter_param __initdata;
5958f1ed7c74SSteven Rostedt (Red Hat) 
59592af15d6aSSteven Rostedt static int __init set_ftrace_notrace(char *str)
59602af15d6aSSteven Rostedt {
5961f1ed7c74SSteven Rostedt (Red Hat) 	ftrace_filter_param = true;
596275761cc1SChen Gang 	strlcpy(ftrace_notrace_buf, str, FTRACE_FILTER_SIZE);
59632af15d6aSSteven Rostedt 	return 1;
59642af15d6aSSteven Rostedt }
59652af15d6aSSteven Rostedt __setup("ftrace_notrace=", set_ftrace_notrace);
59662af15d6aSSteven Rostedt 
59672af15d6aSSteven Rostedt static int __init set_ftrace_filter(char *str)
59682af15d6aSSteven Rostedt {
5969f1ed7c74SSteven Rostedt (Red Hat) 	ftrace_filter_param = true;
597075761cc1SChen Gang 	strlcpy(ftrace_filter_buf, str, FTRACE_FILTER_SIZE);
59712af15d6aSSteven Rostedt 	return 1;
59722af15d6aSSteven Rostedt }
59732af15d6aSSteven Rostedt __setup("ftrace_filter=", set_ftrace_filter);
59742af15d6aSSteven Rostedt 
5975369bc18fSStefan Assmann #ifdef CONFIG_FUNCTION_GRAPH_TRACER
5976f6060f46SLai Jiangshan static char ftrace_graph_buf[FTRACE_FILTER_SIZE] __initdata;
59770d7d9a16SNamhyung Kim static char ftrace_graph_notrace_buf[FTRACE_FILTER_SIZE] __initdata;
5978b9b0c831SNamhyung Kim static int ftrace_graph_set_hash(struct ftrace_hash *hash, char *buffer);
5979801c29fdSSteven Rostedt 
5980369bc18fSStefan Assmann static int __init set_graph_function(char *str)
5981369bc18fSStefan Assmann {
598206f43d66SFrederic Weisbecker 	strlcpy(ftrace_graph_buf, str, FTRACE_FILTER_SIZE);
5983369bc18fSStefan Assmann 	return 1;
5984369bc18fSStefan Assmann }
5985369bc18fSStefan Assmann __setup("ftrace_graph_filter=", set_graph_function);
5986369bc18fSStefan Assmann 
59870d7d9a16SNamhyung Kim static int __init set_graph_notrace_function(char *str)
59880d7d9a16SNamhyung Kim {
59890d7d9a16SNamhyung Kim 	strlcpy(ftrace_graph_notrace_buf, str, FTRACE_FILTER_SIZE);
59900d7d9a16SNamhyung Kim 	return 1;
59910d7d9a16SNamhyung Kim }
59920d7d9a16SNamhyung Kim __setup("ftrace_graph_notrace=", set_graph_notrace_function);
59930d7d9a16SNamhyung Kim 
599465a50c65STodd Brandt static int __init set_graph_max_depth_function(char *str)
599565a50c65STodd Brandt {
599665a50c65STodd Brandt 	if (!str)
599765a50c65STodd Brandt 		return 0;
599865a50c65STodd Brandt 	fgraph_max_depth = simple_strtoul(str, NULL, 0);
599965a50c65STodd Brandt 	return 1;
600065a50c65STodd Brandt }
600165a50c65STodd Brandt __setup("ftrace_graph_max_depth=", set_graph_max_depth_function);
600265a50c65STodd Brandt 
60030d7d9a16SNamhyung Kim static void __init set_ftrace_early_graph(char *buf, int enable)
6004369bc18fSStefan Assmann {
6005369bc18fSStefan Assmann 	int ret;
6006369bc18fSStefan Assmann 	char *func;
6007b9b0c831SNamhyung Kim 	struct ftrace_hash *hash;
60080d7d9a16SNamhyung Kim 
600992ad18ecSSteven Rostedt (VMware) 	hash = alloc_ftrace_hash(FTRACE_HASH_DEFAULT_BITS);
601024589e3aSSteven Rostedt (VMware) 	if (MEM_FAIL(!hash, "Failed to allocate hash\n"))
601192ad18ecSSteven Rostedt (VMware) 		return;
6012369bc18fSStefan Assmann 
6013369bc18fSStefan Assmann 	while (buf) {
6014369bc18fSStefan Assmann 		func = strsep(&buf, ",");
6015369bc18fSStefan Assmann 		/* we allow only one expression at a time */
6016b9b0c831SNamhyung Kim 		ret = ftrace_graph_set_hash(hash, func);
6017369bc18fSStefan Assmann 		if (ret)
6018369bc18fSStefan Assmann 			printk(KERN_DEBUG "ftrace: function %s not "
6019369bc18fSStefan Assmann 					  "traceable\n", func);
6020369bc18fSStefan Assmann 	}
602192ad18ecSSteven Rostedt (VMware) 
602292ad18ecSSteven Rostedt (VMware) 	if (enable)
602392ad18ecSSteven Rostedt (VMware) 		ftrace_graph_hash = hash;
602492ad18ecSSteven Rostedt (VMware) 	else
602592ad18ecSSteven Rostedt (VMware) 		ftrace_graph_notrace_hash = hash;
6026369bc18fSStefan Assmann }
6027369bc18fSStefan Assmann #endif /* CONFIG_FUNCTION_GRAPH_TRACER */
6028369bc18fSStefan Assmann 
60292a85a37fSSteven Rostedt void __init
60302a85a37fSSteven Rostedt ftrace_set_early_filter(struct ftrace_ops *ops, char *buf, int enable)
60312af15d6aSSteven Rostedt {
60322af15d6aSSteven Rostedt 	char *func;
60332af15d6aSSteven Rostedt 
6034f04f24fbSMasami Hiramatsu 	ftrace_ops_init(ops);
6035f04f24fbSMasami Hiramatsu 
60362af15d6aSSteven Rostedt 	while (buf) {
60372af15d6aSSteven Rostedt 		func = strsep(&buf, ",");
6038f45948e8SSteven Rostedt 		ftrace_set_regex(ops, func, strlen(func), 0, enable);
60392af15d6aSSteven Rostedt 	}
60402af15d6aSSteven Rostedt }
60412af15d6aSSteven Rostedt 
60422af15d6aSSteven Rostedt static void __init set_ftrace_early_filters(void)
60432af15d6aSSteven Rostedt {
60442af15d6aSSteven Rostedt 	if (ftrace_filter_buf[0])
60452a85a37fSSteven Rostedt 		ftrace_set_early_filter(&global_ops, ftrace_filter_buf, 1);
60462af15d6aSSteven Rostedt 	if (ftrace_notrace_buf[0])
60472a85a37fSSteven Rostedt 		ftrace_set_early_filter(&global_ops, ftrace_notrace_buf, 0);
6048369bc18fSStefan Assmann #ifdef CONFIG_FUNCTION_GRAPH_TRACER
6049369bc18fSStefan Assmann 	if (ftrace_graph_buf[0])
60500d7d9a16SNamhyung Kim 		set_ftrace_early_graph(ftrace_graph_buf, 1);
60510d7d9a16SNamhyung Kim 	if (ftrace_graph_notrace_buf[0])
60520d7d9a16SNamhyung Kim 		set_ftrace_early_graph(ftrace_graph_notrace_buf, 0);
6053369bc18fSStefan Assmann #endif /* CONFIG_FUNCTION_GRAPH_TRACER */
60542af15d6aSSteven Rostedt }
60552af15d6aSSteven Rostedt 
6056fc13cb0cSSteven Rostedt int ftrace_regex_release(struct inode *inode, struct file *file)
60575072c59fSSteven Rostedt {
60585072c59fSSteven Rostedt 	struct seq_file *m = (struct seq_file *)file->private_data;
60595072c59fSSteven Rostedt 	struct ftrace_iterator *iter;
606033dc9b12SSteven Rostedt 	struct ftrace_hash **orig_hash;
6061689fd8b6S[email protected] 	struct trace_parser *parser;
6062ed926f9bSSteven Rostedt 	int filter_hash;
60635072c59fSSteven Rostedt 
60645072c59fSSteven Rostedt 	if (file->f_mode & FMODE_READ) {
60655072c59fSSteven Rostedt 		iter = m->private;
60665072c59fSSteven Rostedt 		seq_release(inode, file);
60675072c59fSSteven Rostedt 	} else
60685072c59fSSteven Rostedt 		iter = file->private_data;
60695072c59fSSteven Rostedt 
6070689fd8b6S[email protected] 	parser = &iter->parser;
6071689fd8b6S[email protected] 	if (trace_parser_loaded(parser)) {
60728c9af478SSteven Rostedt (VMware) 		int enable = !(iter->flags & FTRACE_ITER_NOTRACE);
60738c9af478SSteven Rostedt (VMware) 
60748c9af478SSteven Rostedt (VMware) 		ftrace_process_regex(iter, parser->buffer,
60758c9af478SSteven Rostedt (VMware) 				     parser->idx, enable);
60765072c59fSSteven Rostedt 	}
60775072c59fSSteven Rostedt 
6078058e297dSSteven Rostedt 	trace_parser_put(parser);
6079058e297dSSteven Rostedt 
608033b7f99cSSteven Rostedt (Red Hat) 	mutex_lock(&iter->ops->func_hash->regex_lock);
60813f2367baSMasami Hiramatsu 
6082058e297dSSteven Rostedt 	if (file->f_mode & FMODE_WRITE) {
6083ed926f9bSSteven Rostedt 		filter_hash = !!(iter->flags & FTRACE_ITER_FILTER);
6084ed926f9bSSteven Rostedt 
60858c08f0d5SSteven Rostedt (VMware) 		if (filter_hash) {
608633b7f99cSSteven Rostedt (Red Hat) 			orig_hash = &iter->ops->func_hash->filter_hash;
60870ce0638eSZheng Yejian 			if (iter->tr) {
60880ce0638eSZheng Yejian 				if (list_empty(&iter->tr->mod_trace))
60890ce0638eSZheng Yejian 					iter->hash->flags &= ~FTRACE_HASH_FL_MOD;
60900ce0638eSZheng Yejian 				else
60918c08f0d5SSteven Rostedt (VMware) 					iter->hash->flags |= FTRACE_HASH_FL_MOD;
60920ce0638eSZheng Yejian 			}
60938c08f0d5SSteven Rostedt (VMware) 		} else
609433b7f99cSSteven Rostedt (Red Hat) 			orig_hash = &iter->ops->func_hash->notrace_hash;
609533dc9b12SSteven Rostedt 
6096e6ea44e9SSteven Rostedt 		mutex_lock(&ftrace_lock);
6097045e269cSAlex Shi 		ftrace_hash_move_and_update_ops(iter->ops, orig_hash,
6098e16b35ddSSteven Rostedt (VMware) 						      iter->hash, filter_hash);
6099e6ea44e9SSteven Rostedt 		mutex_unlock(&ftrace_lock);
6100c20489daSSteven Rostedt (VMware) 	} else {
6101c20489daSSteven Rostedt (VMware) 		/* For read only, the hash is the ops hash */
6102c20489daSSteven Rostedt (VMware) 		iter->hash = NULL;
6103058e297dSSteven Rostedt 	}
61043f2367baSMasami Hiramatsu 
610533b7f99cSSteven Rostedt (Red Hat) 	mutex_unlock(&iter->ops->func_hash->regex_lock);
610633dc9b12SSteven Rostedt 	free_ftrace_hash(iter->hash);
61079ef16693SSteven Rostedt (VMware) 	if (iter->tr)
61089ef16693SSteven Rostedt (VMware) 		trace_array_put(iter->tr);
610933dc9b12SSteven Rostedt 	kfree(iter);
6110689fd8b6S[email protected] 
61115072c59fSSteven Rostedt 	return 0;
61125072c59fSSteven Rostedt }
61135072c59fSSteven Rostedt 
61145e2336a0SSteven Rostedt static const struct file_operations ftrace_avail_fops = {
61155072c59fSSteven Rostedt 	.open = ftrace_avail_open,
61165072c59fSSteven Rostedt 	.read = seq_read,
61175072c59fSSteven Rostedt 	.llseek = seq_lseek,
61183be04b47SLi Zefan 	.release = seq_release_private,
61195072c59fSSteven Rostedt };
61205072c59fSSteven Rostedt 
6121647bcd03SSteven Rostedt static const struct file_operations ftrace_enabled_fops = {
6122647bcd03SSteven Rostedt 	.open = ftrace_enabled_open,
6123647bcd03SSteven Rostedt 	.read = seq_read,
6124647bcd03SSteven Rostedt 	.llseek = seq_lseek,
6125647bcd03SSteven Rostedt 	.release = seq_release_private,
6126647bcd03SSteven Rostedt };
6127647bcd03SSteven Rostedt 
61285e2336a0SSteven Rostedt static const struct file_operations ftrace_filter_fops = {
61295072c59fSSteven Rostedt 	.open = ftrace_filter_open,
6130850a80cfSLai Jiangshan 	.read = seq_read,
61315072c59fSSteven Rostedt 	.write = ftrace_filter_write,
6132098c879eSSteven Rostedt (Red Hat) 	.llseek = tracing_lseek,
61331cf41dd7SSteven Rostedt 	.release = ftrace_regex_release,
61345072c59fSSteven Rostedt };
61355072c59fSSteven Rostedt 
61365e2336a0SSteven Rostedt static const struct file_operations ftrace_notrace_fops = {
613741c52c0dSSteven Rostedt 	.open = ftrace_notrace_open,
6138850a80cfSLai Jiangshan 	.read = seq_read,
613941c52c0dSSteven Rostedt 	.write = ftrace_notrace_write,
6140098c879eSSteven Rostedt (Red Hat) 	.llseek = tracing_lseek,
61411cf41dd7SSteven Rostedt 	.release = ftrace_regex_release,
614241c52c0dSSteven Rostedt };
614341c52c0dSSteven Rostedt 
6144ea4e2bc4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
6145ea4e2bc4SSteven Rostedt 
6146ea4e2bc4SSteven Rostedt static DEFINE_MUTEX(graph_lock);
6147ea4e2bc4SSteven Rostedt 
614824a9729fSAmol Grover struct ftrace_hash __rcu *ftrace_graph_hash = EMPTY_HASH;
6149fd0e6852SAmol Grover struct ftrace_hash __rcu *ftrace_graph_notrace_hash = EMPTY_HASH;
6150b9b0c831SNamhyung Kim 
6151b9b0c831SNamhyung Kim enum graph_filter_type {
6152b9b0c831SNamhyung Kim 	GRAPH_FILTER_NOTRACE	= 0,
6153b9b0c831SNamhyung Kim 	GRAPH_FILTER_FUNCTION,
6154b9b0c831SNamhyung Kim };
6155ea4e2bc4SSteven Rostedt 
6156555fc781SSteven Rostedt (VMware) #define FTRACE_GRAPH_EMPTY	((void *)1)
6157555fc781SSteven Rostedt (VMware) 
6158faf982a6SNamhyung Kim struct ftrace_graph_data {
6159b9b0c831SNamhyung Kim 	struct ftrace_hash		*hash;
6160b9b0c831SNamhyung Kim 	struct ftrace_func_entry	*entry;
6161b9b0c831SNamhyung Kim 	int				idx;   /* for hash table iteration */
6162b9b0c831SNamhyung Kim 	enum graph_filter_type		type;
6163b9b0c831SNamhyung Kim 	struct ftrace_hash		*new_hash;
6164faf982a6SNamhyung Kim 	const struct seq_operations	*seq_ops;
6165e704eff3SSteven Rostedt (VMware) 	struct trace_parser		parser;
6166faf982a6SNamhyung Kim };
6167faf982a6SNamhyung Kim 
6168ea4e2bc4SSteven Rostedt static void *
616985951842SLi Zefan __g_next(struct seq_file *m, loff_t *pos)
6170ea4e2bc4SSteven Rostedt {
6171faf982a6SNamhyung Kim 	struct ftrace_graph_data *fgd = m->private;
6172b9b0c831SNamhyung Kim 	struct ftrace_func_entry *entry = fgd->entry;
6173b9b0c831SNamhyung Kim 	struct hlist_head *head;
6174b9b0c831SNamhyung Kim 	int i, idx = fgd->idx;
6175faf982a6SNamhyung Kim 
6176b9b0c831SNamhyung Kim 	if (*pos >= fgd->hash->count)
6177ea4e2bc4SSteven Rostedt 		return NULL;
6178b9b0c831SNamhyung Kim 
6179b9b0c831SNamhyung Kim 	if (entry) {
6180b9b0c831SNamhyung Kim 		hlist_for_each_entry_continue(entry, hlist) {
6181b9b0c831SNamhyung Kim 			fgd->entry = entry;
6182b9b0c831SNamhyung Kim 			return entry;
6183b9b0c831SNamhyung Kim 		}
6184b9b0c831SNamhyung Kim 
6185b9b0c831SNamhyung Kim 		idx++;
6186b9b0c831SNamhyung Kim 	}
6187b9b0c831SNamhyung Kim 
6188b9b0c831SNamhyung Kim 	for (i = idx; i < 1 << fgd->hash->size_bits; i++) {
6189b9b0c831SNamhyung Kim 		head = &fgd->hash->buckets[i];
6190b9b0c831SNamhyung Kim 		hlist_for_each_entry(entry, head, hlist) {
6191b9b0c831SNamhyung Kim 			fgd->entry = entry;
6192b9b0c831SNamhyung Kim 			fgd->idx = i;
6193b9b0c831SNamhyung Kim 			return entry;
6194b9b0c831SNamhyung Kim 		}
6195b9b0c831SNamhyung Kim 	}
6196b9b0c831SNamhyung Kim 	return NULL;
619785951842SLi Zefan }
6198ea4e2bc4SSteven Rostedt 
619985951842SLi Zefan static void *
620085951842SLi Zefan g_next(struct seq_file *m, void *v, loff_t *pos)
620185951842SLi Zefan {
620285951842SLi Zefan 	(*pos)++;
620385951842SLi Zefan 	return __g_next(m, pos);
6204ea4e2bc4SSteven Rostedt }
6205ea4e2bc4SSteven Rostedt 
6206ea4e2bc4SSteven Rostedt static void *g_start(struct seq_file *m, loff_t *pos)
6207ea4e2bc4SSteven Rostedt {
6208faf982a6SNamhyung Kim 	struct ftrace_graph_data *fgd = m->private;
6209faf982a6SNamhyung Kim 
6210ea4e2bc4SSteven Rostedt 	mutex_lock(&graph_lock);
6211ea4e2bc4SSteven Rostedt 
6212649b988bSSteven Rostedt (VMware) 	if (fgd->type == GRAPH_FILTER_FUNCTION)
6213649b988bSSteven Rostedt (VMware) 		fgd->hash = rcu_dereference_protected(ftrace_graph_hash,
6214649b988bSSteven Rostedt (VMware) 					lockdep_is_held(&graph_lock));
6215649b988bSSteven Rostedt (VMware) 	else
6216649b988bSSteven Rostedt (VMware) 		fgd->hash = rcu_dereference_protected(ftrace_graph_notrace_hash,
6217649b988bSSteven Rostedt (VMware) 					lockdep_is_held(&graph_lock));
6218649b988bSSteven Rostedt (VMware) 
6219f9349a8fSFrederic Weisbecker 	/* Nothing, tell g_show to print all functions are enabled */
6220b9b0c831SNamhyung Kim 	if (ftrace_hash_empty(fgd->hash) && !*pos)
6221555fc781SSteven Rostedt (VMware) 		return FTRACE_GRAPH_EMPTY;
6222f9349a8fSFrederic Weisbecker 
6223b9b0c831SNamhyung Kim 	fgd->idx = 0;
6224b9b0c831SNamhyung Kim 	fgd->entry = NULL;
622585951842SLi Zefan 	return __g_next(m, pos);
6226ea4e2bc4SSteven Rostedt }
6227ea4e2bc4SSteven Rostedt 
6228ea4e2bc4SSteven Rostedt static void g_stop(struct seq_file *m, void *p)
6229ea4e2bc4SSteven Rostedt {
6230ea4e2bc4SSteven Rostedt 	mutex_unlock(&graph_lock);
6231ea4e2bc4SSteven Rostedt }
6232ea4e2bc4SSteven Rostedt 
6233ea4e2bc4SSteven Rostedt static int g_show(struct seq_file *m, void *v)
6234ea4e2bc4SSteven Rostedt {
6235b9b0c831SNamhyung Kim 	struct ftrace_func_entry *entry = v;
6236ea4e2bc4SSteven Rostedt 
6237b9b0c831SNamhyung Kim 	if (!entry)
6238ea4e2bc4SSteven Rostedt 		return 0;
6239ea4e2bc4SSteven Rostedt 
6240555fc781SSteven Rostedt (VMware) 	if (entry == FTRACE_GRAPH_EMPTY) {
6241280d1429SNamhyung Kim 		struct ftrace_graph_data *fgd = m->private;
6242280d1429SNamhyung Kim 
6243b9b0c831SNamhyung Kim 		if (fgd->type == GRAPH_FILTER_FUNCTION)
6244fa6f0cc7SRasmus Villemoes 			seq_puts(m, "#### all functions enabled ####\n");
6245280d1429SNamhyung Kim 		else
6246fa6f0cc7SRasmus Villemoes 			seq_puts(m, "#### no functions disabled ####\n");
6247f9349a8fSFrederic Weisbecker 		return 0;
6248f9349a8fSFrederic Weisbecker 	}
6249f9349a8fSFrederic Weisbecker 
6250b9b0c831SNamhyung Kim 	seq_printf(m, "%ps\n", (void *)entry->ip);
6251ea4e2bc4SSteven Rostedt 
6252ea4e2bc4SSteven Rostedt 	return 0;
6253ea4e2bc4SSteven Rostedt }
6254ea4e2bc4SSteven Rostedt 
625588e9d34cSJames Morris static const struct seq_operations ftrace_graph_seq_ops = {
6256ea4e2bc4SSteven Rostedt 	.start = g_start,
6257ea4e2bc4SSteven Rostedt 	.next = g_next,
6258ea4e2bc4SSteven Rostedt 	.stop = g_stop,
6259ea4e2bc4SSteven Rostedt 	.show = g_show,
6260ea4e2bc4SSteven Rostedt };
6261ea4e2bc4SSteven Rostedt 
6262ea4e2bc4SSteven Rostedt static int
6263faf982a6SNamhyung Kim __ftrace_graph_open(struct inode *inode, struct file *file,
6264faf982a6SNamhyung Kim 		    struct ftrace_graph_data *fgd)
6265ea4e2bc4SSteven Rostedt {
626617911ff3SSteven Rostedt (VMware) 	int ret;
6267b9b0c831SNamhyung Kim 	struct ftrace_hash *new_hash = NULL;
6268ea4e2bc4SSteven Rostedt 
626917911ff3SSteven Rostedt (VMware) 	ret = security_locked_down(LOCKDOWN_TRACEFS);
627017911ff3SSteven Rostedt (VMware) 	if (ret)
627117911ff3SSteven Rostedt (VMware) 		return ret;
627217911ff3SSteven Rostedt (VMware) 
6273b9b0c831SNamhyung Kim 	if (file->f_mode & FMODE_WRITE) {
6274b9b0c831SNamhyung Kim 		const int size_bits = FTRACE_HASH_DEFAULT_BITS;
6275b9b0c831SNamhyung Kim 
6276e704eff3SSteven Rostedt (VMware) 		if (trace_parser_get_init(&fgd->parser, FTRACE_BUFF_MAX))
6277e704eff3SSteven Rostedt (VMware) 			return -ENOMEM;
6278e704eff3SSteven Rostedt (VMware) 
6279b9b0c831SNamhyung Kim 		if (file->f_flags & O_TRUNC)
6280b9b0c831SNamhyung Kim 			new_hash = alloc_ftrace_hash(size_bits);
6281b9b0c831SNamhyung Kim 		else
6282b9b0c831SNamhyung Kim 			new_hash = alloc_and_copy_ftrace_hash(size_bits,
6283b9b0c831SNamhyung Kim 							      fgd->hash);
6284b9b0c831SNamhyung Kim 		if (!new_hash) {
6285b9b0c831SNamhyung Kim 			ret = -ENOMEM;
6286b9b0c831SNamhyung Kim 			goto out;
6287ea4e2bc4SSteven Rostedt 		}
6288b9b0c831SNamhyung Kim 	}
6289ea4e2bc4SSteven Rostedt 
6290faf982a6SNamhyung Kim 	if (file->f_mode & FMODE_READ) {
6291b9b0c831SNamhyung Kim 		ret = seq_open(file, &ftrace_graph_seq_ops);
6292faf982a6SNamhyung Kim 		if (!ret) {
6293faf982a6SNamhyung Kim 			struct seq_file *m = file->private_data;
6294faf982a6SNamhyung Kim 			m->private = fgd;
6295b9b0c831SNamhyung Kim 		} else {
6296b9b0c831SNamhyung Kim 			/* Failed */
6297b9b0c831SNamhyung Kim 			free_ftrace_hash(new_hash);
6298b9b0c831SNamhyung Kim 			new_hash = NULL;
6299faf982a6SNamhyung Kim 		}
6300faf982a6SNamhyung Kim 	} else
6301faf982a6SNamhyung Kim 		file->private_data = fgd;
6302a4ec5e0cSLi Zefan 
6303b9b0c831SNamhyung Kim out:
6304e704eff3SSteven Rostedt (VMware) 	if (ret < 0 && file->f_mode & FMODE_WRITE)
6305e704eff3SSteven Rostedt (VMware) 		trace_parser_put(&fgd->parser);
6306e704eff3SSteven Rostedt (VMware) 
6307b9b0c831SNamhyung Kim 	fgd->new_hash = new_hash;
6308649b988bSSteven Rostedt (VMware) 
6309649b988bSSteven Rostedt (VMware) 	/*
6310649b988bSSteven Rostedt (VMware) 	 * All uses of fgd->hash must be taken with the graph_lock
6311649b988bSSteven Rostedt (VMware) 	 * held. The graph_lock is going to be released, so force
6312649b988bSSteven Rostedt (VMware) 	 * fgd->hash to be reinitialized when it is taken again.
6313649b988bSSteven Rostedt (VMware) 	 */
6314649b988bSSteven Rostedt (VMware) 	fgd->hash = NULL;
6315649b988bSSteven Rostedt (VMware) 
6316ea4e2bc4SSteven Rostedt 	return ret;
6317ea4e2bc4SSteven Rostedt }
6318ea4e2bc4SSteven Rostedt 
6319ea4e2bc4SSteven Rostedt static int
6320faf982a6SNamhyung Kim ftrace_graph_open(struct inode *inode, struct file *file)
6321faf982a6SNamhyung Kim {
6322faf982a6SNamhyung Kim 	struct ftrace_graph_data *fgd;
6323b9b0c831SNamhyung Kim 	int ret;
6324faf982a6SNamhyung Kim 
6325faf982a6SNamhyung Kim 	if (unlikely(ftrace_disabled))
6326faf982a6SNamhyung Kim 		return -ENODEV;
6327faf982a6SNamhyung Kim 
6328faf982a6SNamhyung Kim 	fgd = kmalloc(sizeof(*fgd), GFP_KERNEL);
6329faf982a6SNamhyung Kim 	if (fgd == NULL)
6330faf982a6SNamhyung Kim 		return -ENOMEM;
6331faf982a6SNamhyung Kim 
6332b9b0c831SNamhyung Kim 	mutex_lock(&graph_lock);
6333b9b0c831SNamhyung Kim 
6334649b988bSSteven Rostedt (VMware) 	fgd->hash = rcu_dereference_protected(ftrace_graph_hash,
6335649b988bSSteven Rostedt (VMware) 					lockdep_is_held(&graph_lock));
6336b9b0c831SNamhyung Kim 	fgd->type = GRAPH_FILTER_FUNCTION;
6337faf982a6SNamhyung Kim 	fgd->seq_ops = &ftrace_graph_seq_ops;
6338faf982a6SNamhyung Kim 
6339b9b0c831SNamhyung Kim 	ret = __ftrace_graph_open(inode, file, fgd);
6340b9b0c831SNamhyung Kim 	if (ret < 0)
6341b9b0c831SNamhyung Kim 		kfree(fgd);
6342b9b0c831SNamhyung Kim 
6343b9b0c831SNamhyung Kim 	mutex_unlock(&graph_lock);
6344b9b0c831SNamhyung Kim 	return ret;
6345faf982a6SNamhyung Kim }
6346faf982a6SNamhyung Kim 
6347faf982a6SNamhyung Kim static int
634829ad23b0SNamhyung Kim ftrace_graph_notrace_open(struct inode *inode, struct file *file)
634929ad23b0SNamhyung Kim {
635029ad23b0SNamhyung Kim 	struct ftrace_graph_data *fgd;
6351b9b0c831SNamhyung Kim 	int ret;
635229ad23b0SNamhyung Kim 
635329ad23b0SNamhyung Kim 	if (unlikely(ftrace_disabled))
635429ad23b0SNamhyung Kim 		return -ENODEV;
635529ad23b0SNamhyung Kim 
635629ad23b0SNamhyung Kim 	fgd = kmalloc(sizeof(*fgd), GFP_KERNEL);
635729ad23b0SNamhyung Kim 	if (fgd == NULL)
635829ad23b0SNamhyung Kim 		return -ENOMEM;
635929ad23b0SNamhyung Kim 
6360b9b0c831SNamhyung Kim 	mutex_lock(&graph_lock);
6361b9b0c831SNamhyung Kim 
6362649b988bSSteven Rostedt (VMware) 	fgd->hash = rcu_dereference_protected(ftrace_graph_notrace_hash,
6363649b988bSSteven Rostedt (VMware) 					lockdep_is_held(&graph_lock));
6364b9b0c831SNamhyung Kim 	fgd->type = GRAPH_FILTER_NOTRACE;
636529ad23b0SNamhyung Kim 	fgd->seq_ops = &ftrace_graph_seq_ops;
636629ad23b0SNamhyung Kim 
6367b9b0c831SNamhyung Kim 	ret = __ftrace_graph_open(inode, file, fgd);
6368b9b0c831SNamhyung Kim 	if (ret < 0)
6369b9b0c831SNamhyung Kim 		kfree(fgd);
6370b9b0c831SNamhyung Kim 
6371b9b0c831SNamhyung Kim 	mutex_unlock(&graph_lock);
6372b9b0c831SNamhyung Kim 	return ret;
637329ad23b0SNamhyung Kim }
637429ad23b0SNamhyung Kim 
637529ad23b0SNamhyung Kim static int
637687827111SLi Zefan ftrace_graph_release(struct inode *inode, struct file *file)
637787827111SLi Zefan {
6378b9b0c831SNamhyung Kim 	struct ftrace_graph_data *fgd;
6379e704eff3SSteven Rostedt (VMware) 	struct ftrace_hash *old_hash, *new_hash;
6380e704eff3SSteven Rostedt (VMware) 	struct trace_parser *parser;
6381e704eff3SSteven Rostedt (VMware) 	int ret = 0;
6382b9b0c831SNamhyung Kim 
6383faf982a6SNamhyung Kim 	if (file->f_mode & FMODE_READ) {
6384faf982a6SNamhyung Kim 		struct seq_file *m = file->private_data;
6385faf982a6SNamhyung Kim 
6386b9b0c831SNamhyung Kim 		fgd = m->private;
638787827111SLi Zefan 		seq_release(inode, file);
6388faf982a6SNamhyung Kim 	} else {
6389b9b0c831SNamhyung Kim 		fgd = file->private_data;
6390faf982a6SNamhyung Kim 	}
6391faf982a6SNamhyung Kim 
6392e704eff3SSteven Rostedt (VMware) 
6393e704eff3SSteven Rostedt (VMware) 	if (file->f_mode & FMODE_WRITE) {
6394e704eff3SSteven Rostedt (VMware) 
6395e704eff3SSteven Rostedt (VMware) 		parser = &fgd->parser;
6396e704eff3SSteven Rostedt (VMware) 
6397e704eff3SSteven Rostedt (VMware) 		if (trace_parser_loaded((parser))) {
6398e704eff3SSteven Rostedt (VMware) 			ret = ftrace_graph_set_hash(fgd->new_hash,
6399e704eff3SSteven Rostedt (VMware) 						    parser->buffer);
6400e704eff3SSteven Rostedt (VMware) 		}
6401e704eff3SSteven Rostedt (VMware) 
6402e704eff3SSteven Rostedt (VMware) 		trace_parser_put(parser);
6403e704eff3SSteven Rostedt (VMware) 
6404e704eff3SSteven Rostedt (VMware) 		new_hash = __ftrace_hash_move(fgd->new_hash);
6405e704eff3SSteven Rostedt (VMware) 		if (!new_hash) {
6406e704eff3SSteven Rostedt (VMware) 			ret = -ENOMEM;
6407e704eff3SSteven Rostedt (VMware) 			goto out;
6408e704eff3SSteven Rostedt (VMware) 		}
6409e704eff3SSteven Rostedt (VMware) 
6410e704eff3SSteven Rostedt (VMware) 		mutex_lock(&graph_lock);
6411e704eff3SSteven Rostedt (VMware) 
6412e704eff3SSteven Rostedt (VMware) 		if (fgd->type == GRAPH_FILTER_FUNCTION) {
6413e704eff3SSteven Rostedt (VMware) 			old_hash = rcu_dereference_protected(ftrace_graph_hash,
6414e704eff3SSteven Rostedt (VMware) 					lockdep_is_held(&graph_lock));
6415e704eff3SSteven Rostedt (VMware) 			rcu_assign_pointer(ftrace_graph_hash, new_hash);
6416e704eff3SSteven Rostedt (VMware) 		} else {
6417e704eff3SSteven Rostedt (VMware) 			old_hash = rcu_dereference_protected(ftrace_graph_notrace_hash,
6418e704eff3SSteven Rostedt (VMware) 					lockdep_is_held(&graph_lock));
6419e704eff3SSteven Rostedt (VMware) 			rcu_assign_pointer(ftrace_graph_notrace_hash, new_hash);
6420e704eff3SSteven Rostedt (VMware) 		}
6421e704eff3SSteven Rostedt (VMware) 
6422e704eff3SSteven Rostedt (VMware) 		mutex_unlock(&graph_lock);
6423e704eff3SSteven Rostedt (VMware) 
642454a16ff6SSteven Rostedt (VMware) 		/*
642554a16ff6SSteven Rostedt (VMware) 		 * We need to do a hard force of sched synchronization.
642654a16ff6SSteven Rostedt (VMware) 		 * This is because we use preempt_disable() to do RCU, but
642754a16ff6SSteven Rostedt (VMware) 		 * the function tracers can be called where RCU is not watching
642854a16ff6SSteven Rostedt (VMware) 		 * (like before user_exit()). We can not rely on the RCU
642954a16ff6SSteven Rostedt (VMware) 		 * infrastructure to do the synchronization, thus we must do it
643054a16ff6SSteven Rostedt (VMware) 		 * ourselves.
643154a16ff6SSteven Rostedt (VMware) 		 */
643268e83498SNicolas Saenz Julienne 		if (old_hash != EMPTY_HASH)
6433e5a971d7SPaul E. McKenney 			synchronize_rcu_tasks_rude();
6434e704eff3SSteven Rostedt (VMware) 
6435e704eff3SSteven Rostedt (VMware) 		free_ftrace_hash(old_hash);
6436e704eff3SSteven Rostedt (VMware) 	}
6437e704eff3SSteven Rostedt (VMware) 
6438e704eff3SSteven Rostedt (VMware)  out:
6439f9797c2fSLuis Henriques 	free_ftrace_hash(fgd->new_hash);
6440b9b0c831SNamhyung Kim 	kfree(fgd);
6441b9b0c831SNamhyung Kim 
6442e704eff3SSteven Rostedt (VMware) 	return ret;
644387827111SLi Zefan }
644487827111SLi Zefan 
644587827111SLi Zefan static int
6446b9b0c831SNamhyung Kim ftrace_graph_set_hash(struct ftrace_hash *hash, char *buffer)
6447ea4e2bc4SSteven Rostedt {
64483ba00929SDmitry Safonov 	struct ftrace_glob func_g;
6449ea4e2bc4SSteven Rostedt 	struct dyn_ftrace *rec;
6450ea4e2bc4SSteven Rostedt 	struct ftrace_page *pg;
6451b9b0c831SNamhyung Kim 	struct ftrace_func_entry *entry;
6452c7c6b1feSLi Zefan 	int fail = 1;
64533ba00929SDmitry Safonov 	int not;
6454ea4e2bc4SSteven Rostedt 
6455f9349a8fSFrederic Weisbecker 	/* decode regex */
64563ba00929SDmitry Safonov 	func_g.type = filter_parse_regex(buffer, strlen(buffer),
64573ba00929SDmitry Safonov 					 &func_g.search, &not);
6458f9349a8fSFrederic Weisbecker 
64593ba00929SDmitry Safonov 	func_g.len = strlen(func_g.search);
6460f9349a8fSFrederic Weisbecker 
646152baf119SSteven Rostedt 	mutex_lock(&ftrace_lock);
646245a4a237SSteven Rostedt 
646345a4a237SSteven Rostedt 	if (unlikely(ftrace_disabled)) {
646445a4a237SSteven Rostedt 		mutex_unlock(&ftrace_lock);
646545a4a237SSteven Rostedt 		return -ENODEV;
646645a4a237SSteven Rostedt 	}
646745a4a237SSteven Rostedt 
6468265c831cSSteven Rostedt 	do_for_each_ftrace_rec(pg, rec) {
6469ea4e2bc4SSteven Rostedt 
6470546fece4SSteven Rostedt (Red Hat) 		if (rec->flags & FTRACE_FL_DISABLED)
6471546fece4SSteven Rostedt (Red Hat) 			continue;
6472546fece4SSteven Rostedt (Red Hat) 
64730b507e1eSDmitry Safonov 		if (ftrace_match_record(rec, &func_g, NULL, 0)) {
6474b9b0c831SNamhyung Kim 			entry = ftrace_lookup_ip(hash, rec->ip);
6475c7c6b1feSLi Zefan 
6476c7c6b1feSLi Zefan 			if (!not) {
6477c7c6b1feSLi Zefan 				fail = 0;
6478b9b0c831SNamhyung Kim 
6479b9b0c831SNamhyung Kim 				if (entry)
6480b9b0c831SNamhyung Kim 					continue;
6481b9b0c831SNamhyung Kim 				if (add_hash_entry(hash, rec->ip) < 0)
6482c7c6b1feSLi Zefan 					goto out;
6483c7c6b1feSLi Zefan 			} else {
6484b9b0c831SNamhyung Kim 				if (entry) {
6485b9b0c831SNamhyung Kim 					free_hash_entry(hash, entry);
6486c7c6b1feSLi Zefan 					fail = 0;
6487c7c6b1feSLi Zefan 				}
6488c7c6b1feSLi Zefan 			}
6489f9349a8fSFrederic Weisbecker 		}
6490265c831cSSteven Rostedt 	} while_for_each_ftrace_rec();
6491c7c6b1feSLi Zefan out:
649252baf119SSteven Rostedt 	mutex_unlock(&ftrace_lock);
6493ea4e2bc4SSteven Rostedt 
6494c7c6b1feSLi Zefan 	if (fail)
6495c7c6b1feSLi Zefan 		return -EINVAL;
6496c7c6b1feSLi Zefan 
6497c7c6b1feSLi Zefan 	return 0;
6498ea4e2bc4SSteven Rostedt }
6499ea4e2bc4SSteven Rostedt 
6500ea4e2bc4SSteven Rostedt static ssize_t
6501ea4e2bc4SSteven Rostedt ftrace_graph_write(struct file *file, const char __user *ubuf,
6502ea4e2bc4SSteven Rostedt 		   size_t cnt, loff_t *ppos)
6503ea4e2bc4SSteven Rostedt {
65046a10108bSNamhyung Kim 	ssize_t read, ret = 0;
6505faf982a6SNamhyung Kim 	struct ftrace_graph_data *fgd = file->private_data;
6506e704eff3SSteven Rostedt (VMware) 	struct trace_parser *parser;
6507ea4e2bc4SSteven Rostedt 
6508c7c6b1feSLi Zefan 	if (!cnt)
6509ea4e2bc4SSteven Rostedt 		return 0;
6510ea4e2bc4SSteven Rostedt 
6511ae98d27aSSteven Rostedt (VMware) 	/* Read mode uses seq functions */
6512ae98d27aSSteven Rostedt (VMware) 	if (file->f_mode & FMODE_READ) {
6513ae98d27aSSteven Rostedt (VMware) 		struct seq_file *m = file->private_data;
6514ae98d27aSSteven Rostedt (VMware) 		fgd = m->private;
6515ae98d27aSSteven Rostedt (VMware) 	}
6516ae98d27aSSteven Rostedt (VMware) 
6517e704eff3SSteven Rostedt (VMware) 	parser = &fgd->parser;
6518689fd8b6S[email protected] 
6519e704eff3SSteven Rostedt (VMware) 	read = trace_get_user(parser, ubuf, cnt, ppos);
6520ea4e2bc4SSteven Rostedt 
6521e704eff3SSteven Rostedt (VMware) 	if (read >= 0 && trace_parser_loaded(parser) &&
6522e704eff3SSteven Rostedt (VMware) 	    !trace_parser_cont(parser)) {
65236a10108bSNamhyung Kim 
6524b9b0c831SNamhyung Kim 		ret = ftrace_graph_set_hash(fgd->new_hash,
6525e704eff3SSteven Rostedt (VMware) 					    parser->buffer);
6526e704eff3SSteven Rostedt (VMware) 		trace_parser_clear(parser);
6527689fd8b6S[email protected] 	}
6528ea4e2bc4SSteven Rostedt 
65296a10108bSNamhyung Kim 	if (!ret)
6530ea4e2bc4SSteven Rostedt 		ret = read;
65311eb90f13SLi Zefan 
6532ea4e2bc4SSteven Rostedt 	return ret;
6533ea4e2bc4SSteven Rostedt }
6534ea4e2bc4SSteven Rostedt 
6535ea4e2bc4SSteven Rostedt static const struct file_operations ftrace_graph_fops = {
6536ea4e2bc4SSteven Rostedt 	.open		= ftrace_graph_open,
6537850a80cfSLai Jiangshan 	.read		= seq_read,
6538ea4e2bc4SSteven Rostedt 	.write		= ftrace_graph_write,
6539098c879eSSteven Rostedt (Red Hat) 	.llseek		= tracing_lseek,
654087827111SLi Zefan 	.release	= ftrace_graph_release,
6541ea4e2bc4SSteven Rostedt };
654229ad23b0SNamhyung Kim 
654329ad23b0SNamhyung Kim static const struct file_operations ftrace_graph_notrace_fops = {
654429ad23b0SNamhyung Kim 	.open		= ftrace_graph_notrace_open,
654529ad23b0SNamhyung Kim 	.read		= seq_read,
654629ad23b0SNamhyung Kim 	.write		= ftrace_graph_write,
6547098c879eSSteven Rostedt (Red Hat) 	.llseek		= tracing_lseek,
654829ad23b0SNamhyung Kim 	.release	= ftrace_graph_release,
654929ad23b0SNamhyung Kim };
6550ea4e2bc4SSteven Rostedt #endif /* CONFIG_FUNCTION_GRAPH_TRACER */
6551ea4e2bc4SSteven Rostedt 
6552591dffdaSSteven Rostedt (Red Hat) void ftrace_create_filter_files(struct ftrace_ops *ops,
6553591dffdaSSteven Rostedt (Red Hat) 				struct dentry *parent)
6554591dffdaSSteven Rostedt (Red Hat) {
6555591dffdaSSteven Rostedt (Red Hat) 
655621ccc9cdSSteven Rostedt (VMware) 	trace_create_file("set_ftrace_filter", TRACE_MODE_WRITE, parent,
6557591dffdaSSteven Rostedt (Red Hat) 			  ops, &ftrace_filter_fops);
6558591dffdaSSteven Rostedt (Red Hat) 
655921ccc9cdSSteven Rostedt (VMware) 	trace_create_file("set_ftrace_notrace", TRACE_MODE_WRITE, parent,
6560591dffdaSSteven Rostedt (Red Hat) 			  ops, &ftrace_notrace_fops);
6561591dffdaSSteven Rostedt (Red Hat) }
6562591dffdaSSteven Rostedt (Red Hat) 
6563591dffdaSSteven Rostedt (Red Hat) /*
6564591dffdaSSteven Rostedt (Red Hat)  * The name "destroy_filter_files" is really a misnomer. Although
65659efb85c5SHariprasad Kelam  * in the future, it may actually delete the files, but this is
6566591dffdaSSteven Rostedt (Red Hat)  * really intended to make sure the ops passed in are disabled
6567591dffdaSSteven Rostedt (Red Hat)  * and that when this function returns, the caller is free to
6568591dffdaSSteven Rostedt (Red Hat)  * free the ops.
6569591dffdaSSteven Rostedt (Red Hat)  *
6570591dffdaSSteven Rostedt (Red Hat)  * The "destroy" name is only to match the "create" name that this
6571591dffdaSSteven Rostedt (Red Hat)  * should be paired with.
6572591dffdaSSteven Rostedt (Red Hat)  */
6573591dffdaSSteven Rostedt (Red Hat) void ftrace_destroy_filter_files(struct ftrace_ops *ops)
6574591dffdaSSteven Rostedt (Red Hat) {
6575591dffdaSSteven Rostedt (Red Hat) 	mutex_lock(&ftrace_lock);
6576591dffdaSSteven Rostedt (Red Hat) 	if (ops->flags & FTRACE_OPS_FL_ENABLED)
6577591dffdaSSteven Rostedt (Red Hat) 		ftrace_shutdown(ops, 0);
6578591dffdaSSteven Rostedt (Red Hat) 	ops->flags |= FTRACE_OPS_FL_DELETED;
65792840f84fSSteven Rostedt (VMware) 	ftrace_free_filter(ops);
6580591dffdaSSteven Rostedt (Red Hat) 	mutex_unlock(&ftrace_lock);
6581591dffdaSSteven Rostedt (Red Hat) }
6582591dffdaSSteven Rostedt (Red Hat) 
65838434dc93SSteven Rostedt (Red Hat) static __init int ftrace_init_dyn_tracefs(struct dentry *d_tracer)
65845072c59fSSteven Rostedt {
65855072c59fSSteven Rostedt 
658621ccc9cdSSteven Rostedt (VMware) 	trace_create_file("available_filter_functions", TRACE_MODE_READ,
65875072c59fSSteven Rostedt 			d_tracer, NULL, &ftrace_avail_fops);
65885072c59fSSteven Rostedt 
658921ccc9cdSSteven Rostedt (VMware) 	trace_create_file("enabled_functions", TRACE_MODE_READ,
6590647bcd03SSteven Rostedt 			d_tracer, NULL, &ftrace_enabled_fops);
6591647bcd03SSteven Rostedt 
6592591dffdaSSteven Rostedt (Red Hat) 	ftrace_create_filter_files(&global_ops, d_tracer);
6593ad90c0e3SSteven Rostedt 
6594ea4e2bc4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
659521ccc9cdSSteven Rostedt (VMware) 	trace_create_file("set_graph_function", TRACE_MODE_WRITE, d_tracer,
6596ea4e2bc4SSteven Rostedt 				    NULL,
6597ea4e2bc4SSteven Rostedt 				    &ftrace_graph_fops);
659821ccc9cdSSteven Rostedt (VMware) 	trace_create_file("set_graph_notrace", TRACE_MODE_WRITE, d_tracer,
659929ad23b0SNamhyung Kim 				    NULL,
660029ad23b0SNamhyung Kim 				    &ftrace_graph_notrace_fops);
6601ea4e2bc4SSteven Rostedt #endif /* CONFIG_FUNCTION_GRAPH_TRACER */
6602ea4e2bc4SSteven Rostedt 
66035072c59fSSteven Rostedt 	return 0;
66045072c59fSSteven Rostedt }
66055072c59fSSteven Rostedt 
66069fd49328SSteven Rostedt static int ftrace_cmp_ips(const void *a, const void *b)
660768950619SSteven Rostedt {
66089fd49328SSteven Rostedt 	const unsigned long *ipa = a;
66099fd49328SSteven Rostedt 	const unsigned long *ipb = b;
661068950619SSteven Rostedt 
66119fd49328SSteven Rostedt 	if (*ipa > *ipb)
66129fd49328SSteven Rostedt 		return 1;
66139fd49328SSteven Rostedt 	if (*ipa < *ipb)
66149fd49328SSteven Rostedt 		return -1;
66159fd49328SSteven Rostedt 	return 0;
66169fd49328SSteven Rostedt }
66179fd49328SSteven Rostedt 
66188147dc78SSteven Rostedt (VMware) #ifdef CONFIG_FTRACE_SORT_STARTUP_TEST
66198147dc78SSteven Rostedt (VMware) static void test_is_sorted(unsigned long *start, unsigned long count)
66208147dc78SSteven Rostedt (VMware) {
66218147dc78SSteven Rostedt (VMware) 	int i;
66228147dc78SSteven Rostedt (VMware) 
66238147dc78SSteven Rostedt (VMware) 	for (i = 1; i < count; i++) {
66248147dc78SSteven Rostedt (VMware) 		if (WARN(start[i - 1] > start[i],
66258147dc78SSteven Rostedt (VMware) 			 "[%d] %pS at %lx is not sorted with %pS at %lx\n", i,
66268147dc78SSteven Rostedt (VMware) 			 (void *)start[i - 1], start[i - 1],
66278147dc78SSteven Rostedt (VMware) 			 (void *)start[i], start[i]))
66288147dc78SSteven Rostedt (VMware) 			break;
66298147dc78SSteven Rostedt (VMware) 	}
66308147dc78SSteven Rostedt (VMware) 	if (i == count)
66318147dc78SSteven Rostedt (VMware) 		pr_info("ftrace section at %px sorted properly\n", start);
66328147dc78SSteven Rostedt (VMware) }
66338147dc78SSteven Rostedt (VMware) #else
66348147dc78SSteven Rostedt (VMware) static void test_is_sorted(unsigned long *start, unsigned long count)
66358147dc78SSteven Rostedt (VMware) {
66368147dc78SSteven Rostedt (VMware) }
66378147dc78SSteven Rostedt (VMware) #endif
66388147dc78SSteven Rostedt (VMware) 
66395cb084bbSJiri Olsa static int ftrace_process_locs(struct module *mod,
664031e88909SSteven Rostedt 			       unsigned long *start,
664168bf21aaSSteven Rostedt 			       unsigned long *end)
664268bf21aaSSteven Rostedt {
6643706c81f8SSteven Rostedt 	struct ftrace_page *start_pg;
6644a7900875SSteven Rostedt 	struct ftrace_page *pg;
6645706c81f8SSteven Rostedt 	struct dyn_ftrace *rec;
6646a7900875SSteven Rostedt 	unsigned long count;
664768bf21aaSSteven Rostedt 	unsigned long *p;
664868bf21aaSSteven Rostedt 	unsigned long addr;
66494376cac6SSteven Rostedt 	unsigned long flags = 0; /* Shut up gcc */
6650a7900875SSteven Rostedt 	int ret = -ENOMEM;
6651a7900875SSteven Rostedt 
6652a7900875SSteven Rostedt 	count = end - start;
6653a7900875SSteven Rostedt 
6654a7900875SSteven Rostedt 	if (!count)
6655a7900875SSteven Rostedt 		return 0;
6656a7900875SSteven Rostedt 
665772b3942aSYinan Liu 	/*
665872b3942aSYinan Liu 	 * Sorting mcount in vmlinux at build time depend on
66596b9b6413SSteven Rostedt (Google) 	 * CONFIG_BUILDTIME_MCOUNT_SORT, while mcount loc in
666072b3942aSYinan Liu 	 * modules can not be sorted at build time.
666172b3942aSYinan Liu 	 */
66626b9b6413SSteven Rostedt (Google) 	if (!IS_ENABLED(CONFIG_BUILDTIME_MCOUNT_SORT) || mod) {
66639fd49328SSteven Rostedt 		sort(start, count, sizeof(*start),
66646db02903SRasmus Villemoes 		     ftrace_cmp_ips, NULL);
66658147dc78SSteven Rostedt (VMware) 	} else {
66668147dc78SSteven Rostedt (VMware) 		test_is_sorted(start, count);
666772b3942aSYinan Liu 	}
66689fd49328SSteven Rostedt 
6669706c81f8SSteven Rostedt 	start_pg = ftrace_allocate_pages(count);
6670706c81f8SSteven Rostedt 	if (!start_pg)
6671a7900875SSteven Rostedt 		return -ENOMEM;
667268bf21aaSSteven Rostedt 
6673e6ea44e9SSteven Rostedt 	mutex_lock(&ftrace_lock);
6674a7900875SSteven Rostedt 
667532082309SSteven Rostedt 	/*
667632082309SSteven Rostedt 	 * Core and each module needs their own pages, as
667732082309SSteven Rostedt 	 * modules will free them when they are removed.
667832082309SSteven Rostedt 	 * Force a new page to be allocated for modules.
667932082309SSteven Rostedt 	 */
6680a7900875SSteven Rostedt 	if (!mod) {
6681a7900875SSteven Rostedt 		WARN_ON(ftrace_pages || ftrace_pages_start);
6682a7900875SSteven Rostedt 		/* First initialization */
6683706c81f8SSteven Rostedt 		ftrace_pages = ftrace_pages_start = start_pg;
6684a7900875SSteven Rostedt 	} else {
668532082309SSteven Rostedt 		if (!ftrace_pages)
6686a7900875SSteven Rostedt 			goto out;
668732082309SSteven Rostedt 
6688a7900875SSteven Rostedt 		if (WARN_ON(ftrace_pages->next)) {
6689a7900875SSteven Rostedt 			/* Hmm, we have free pages? */
6690a7900875SSteven Rostedt 			while (ftrace_pages->next)
669132082309SSteven Rostedt 				ftrace_pages = ftrace_pages->next;
669232082309SSteven Rostedt 		}
6693a7900875SSteven Rostedt 
6694706c81f8SSteven Rostedt 		ftrace_pages->next = start_pg;
669532082309SSteven Rostedt 	}
669632082309SSteven Rostedt 
669768bf21aaSSteven Rostedt 	p = start;
6698706c81f8SSteven Rostedt 	pg = start_pg;
669968bf21aaSSteven Rostedt 	while (p < end) {
6700db42523bSLinus Torvalds 		unsigned long end_offset;
670168bf21aaSSteven Rostedt 		addr = ftrace_call_adjust(*p++);
670220e5227eSSteven Rostedt 		/*
670320e5227eSSteven Rostedt 		 * Some architecture linkers will pad between
670420e5227eSSteven Rostedt 		 * the different mcount_loc sections of different
670520e5227eSSteven Rostedt 		 * object files to satisfy alignments.
670620e5227eSSteven Rostedt 		 * Skip any NULL pointers.
670720e5227eSSteven Rostedt 		 */
670820e5227eSSteven Rostedt 		if (!addr)
670920e5227eSSteven Rostedt 			continue;
6710706c81f8SSteven Rostedt 
6711db42523bSLinus Torvalds 		end_offset = (pg->index+1) * sizeof(pg->records[0]);
6712db42523bSLinus Torvalds 		if (end_offset > PAGE_SIZE << pg->order) {
6713706c81f8SSteven Rostedt 			/* We should have allocated enough */
6714706c81f8SSteven Rostedt 			if (WARN_ON(!pg->next))
6715a7900875SSteven Rostedt 				break;
6716706c81f8SSteven Rostedt 			pg = pg->next;
671768bf21aaSSteven Rostedt 		}
671868bf21aaSSteven Rostedt 
6719706c81f8SSteven Rostedt 		rec = &pg->records[pg->index++];
6720706c81f8SSteven Rostedt 		rec->ip = addr;
6721706c81f8SSteven Rostedt 	}
6722706c81f8SSteven Rostedt 
6723706c81f8SSteven Rostedt 	/* We should have used all pages */
6724706c81f8SSteven Rostedt 	WARN_ON(pg->next);
6725706c81f8SSteven Rostedt 
6726706c81f8SSteven Rostedt 	/* Assign the last page to ftrace_pages */
6727706c81f8SSteven Rostedt 	ftrace_pages = pg;
6728706c81f8SSteven Rostedt 
6729a4f18ed1SSteven Rostedt 	/*
67304376cac6SSteven Rostedt 	 * We only need to disable interrupts on start up
67314376cac6SSteven Rostedt 	 * because we are modifying code that an interrupt
67324376cac6SSteven Rostedt 	 * may execute, and the modification is not atomic.
67334376cac6SSteven Rostedt 	 * But for modules, nothing runs the code we modify
67344376cac6SSteven Rostedt 	 * until we are finished with it, and there's no
67354376cac6SSteven Rostedt 	 * reason to cause large interrupt latencies while we do it.
6736a4f18ed1SSteven Rostedt 	 */
67374376cac6SSteven Rostedt 	if (!mod)
6738a4f18ed1SSteven Rostedt 		local_irq_save(flags);
67391dc43cf0SJiri Slaby 	ftrace_update_code(mod, start_pg);
67404376cac6SSteven Rostedt 	if (!mod)
6741a4f18ed1SSteven Rostedt 		local_irq_restore(flags);
6742a7900875SSteven Rostedt 	ret = 0;
6743a7900875SSteven Rostedt  out:
6744e6ea44e9SSteven Rostedt 	mutex_unlock(&ftrace_lock);
674568bf21aaSSteven Rostedt 
6746a7900875SSteven Rostedt 	return ret;
674768bf21aaSSteven Rostedt }
674868bf21aaSSteven Rostedt 
6749aba4b5c2SSteven Rostedt (VMware) struct ftrace_mod_func {
6750aba4b5c2SSteven Rostedt (VMware) 	struct list_head	list;
6751aba4b5c2SSteven Rostedt (VMware) 	char			*name;
6752aba4b5c2SSteven Rostedt (VMware) 	unsigned long		ip;
6753aba4b5c2SSteven Rostedt (VMware) 	unsigned int		size;
6754aba4b5c2SSteven Rostedt (VMware) };
6755aba4b5c2SSteven Rostedt (VMware) 
6756aba4b5c2SSteven Rostedt (VMware) struct ftrace_mod_map {
67576aa69784SSteven Rostedt (VMware) 	struct rcu_head		rcu;
6758aba4b5c2SSteven Rostedt (VMware) 	struct list_head	list;
6759aba4b5c2SSteven Rostedt (VMware) 	struct module		*mod;
6760aba4b5c2SSteven Rostedt (VMware) 	unsigned long		start_addr;
6761aba4b5c2SSteven Rostedt (VMware) 	unsigned long		end_addr;
6762aba4b5c2SSteven Rostedt (VMware) 	struct list_head	funcs;
67636171a031SSteven Rostedt (VMware) 	unsigned int		num_funcs;
6764aba4b5c2SSteven Rostedt (VMware) };
6765aba4b5c2SSteven Rostedt (VMware) 
6766fc0ea795SAdrian Hunter static int ftrace_get_trampoline_kallsym(unsigned int symnum,
6767fc0ea795SAdrian Hunter 					 unsigned long *value, char *type,
6768fc0ea795SAdrian Hunter 					 char *name, char *module_name,
6769fc0ea795SAdrian Hunter 					 int *exported)
6770fc0ea795SAdrian Hunter {
6771fc0ea795SAdrian Hunter 	struct ftrace_ops *op;
6772fc0ea795SAdrian Hunter 
6773fc0ea795SAdrian Hunter 	list_for_each_entry_rcu(op, &ftrace_ops_trampoline_list, list) {
6774fc0ea795SAdrian Hunter 		if (!op->trampoline || symnum--)
6775fc0ea795SAdrian Hunter 			continue;
6776fc0ea795SAdrian Hunter 		*value = op->trampoline;
6777fc0ea795SAdrian Hunter 		*type = 't';
6778fc0ea795SAdrian Hunter 		strlcpy(name, FTRACE_TRAMPOLINE_SYM, KSYM_NAME_LEN);
6779fc0ea795SAdrian Hunter 		strlcpy(module_name, FTRACE_TRAMPOLINE_MOD, MODULE_NAME_LEN);
6780fc0ea795SAdrian Hunter 		*exported = 0;
6781fc0ea795SAdrian Hunter 		return 0;
6782fc0ea795SAdrian Hunter 	}
6783fc0ea795SAdrian Hunter 
6784fc0ea795SAdrian Hunter 	return -ERANGE;
6785fc0ea795SAdrian Hunter }
6786fc0ea795SAdrian Hunter 
6787123d6455SWang Jingjin #if defined(CONFIG_DYNAMIC_FTRACE_WITH_DIRECT_CALLS) || defined(CONFIG_MODULES)
6788123d6455SWang Jingjin /*
6789123d6455SWang Jingjin  * Check if the current ops references the given ip.
6790123d6455SWang Jingjin  *
6791123d6455SWang Jingjin  * If the ops traces all functions, then it was already accounted for.
6792123d6455SWang Jingjin  * If the ops does not trace the current record function, skip it.
6793123d6455SWang Jingjin  * If the ops ignores the function via notrace filter, skip it.
6794123d6455SWang Jingjin  */
6795123d6455SWang Jingjin static bool
6796123d6455SWang Jingjin ops_references_ip(struct ftrace_ops *ops, unsigned long ip)
6797123d6455SWang Jingjin {
6798123d6455SWang Jingjin 	/* If ops isn't enabled, ignore it */
6799123d6455SWang Jingjin 	if (!(ops->flags & FTRACE_OPS_FL_ENABLED))
6800123d6455SWang Jingjin 		return false;
6801123d6455SWang Jingjin 
6802123d6455SWang Jingjin 	/* If ops traces all then it includes this function */
6803123d6455SWang Jingjin 	if (ops_traces_mod(ops))
6804123d6455SWang Jingjin 		return true;
6805123d6455SWang Jingjin 
6806123d6455SWang Jingjin 	/* The function must be in the filter */
6807123d6455SWang Jingjin 	if (!ftrace_hash_empty(ops->func_hash->filter_hash) &&
6808123d6455SWang Jingjin 	    !__ftrace_lookup_ip(ops->func_hash->filter_hash, ip))
6809123d6455SWang Jingjin 		return false;
6810123d6455SWang Jingjin 
6811123d6455SWang Jingjin 	/* If in notrace hash, we ignore it too */
6812123d6455SWang Jingjin 	if (ftrace_lookup_ip(ops->func_hash->notrace_hash, ip))
6813123d6455SWang Jingjin 		return false;
6814123d6455SWang Jingjin 
6815123d6455SWang Jingjin 	return true;
6816123d6455SWang Jingjin }
6817123d6455SWang Jingjin #endif
6818123d6455SWang Jingjin 
681993eb677dSSteven Rostedt #ifdef CONFIG_MODULES
682032082309SSteven Rostedt 
682132082309SSteven Rostedt #define next_to_ftrace_page(p) container_of(p, struct ftrace_page, next)
682232082309SSteven Rostedt 
68236aa69784SSteven Rostedt (VMware) static LIST_HEAD(ftrace_mod_maps);
68246aa69784SSteven Rostedt (VMware) 
6825b7ffffbbSSteven Rostedt (Red Hat) static int referenced_filters(struct dyn_ftrace *rec)
6826b7ffffbbSSteven Rostedt (Red Hat) {
6827b7ffffbbSSteven Rostedt (Red Hat) 	struct ftrace_ops *ops;
6828b7ffffbbSSteven Rostedt (Red Hat) 	int cnt = 0;
6829b7ffffbbSSteven Rostedt (Red Hat) 
6830b7ffffbbSSteven Rostedt (Red Hat) 	for (ops = ftrace_ops_list; ops != &ftrace_list_end; ops = ops->next) {
6831123d6455SWang Jingjin 		if (ops_references_ip(ops, rec->ip)) {
6832c5f51572SChengming Zhou 			if (WARN_ON_ONCE(ops->flags & FTRACE_OPS_FL_DIRECT))
6833c5f51572SChengming Zhou 				continue;
6834c5f51572SChengming Zhou 			if (WARN_ON_ONCE(ops->flags & FTRACE_OPS_FL_IPMODIFY))
6835c5f51572SChengming Zhou 				continue;
6836b7ffffbbSSteven Rostedt (Red Hat) 			cnt++;
68378a224ffbSChengming Zhou 			if (ops->flags & FTRACE_OPS_FL_SAVE_REGS)
68388a224ffbSChengming Zhou 				rec->flags |= FTRACE_FL_REGS;
6839c5f51572SChengming Zhou 			if (cnt == 1 && ops->trampoline)
6840c5f51572SChengming Zhou 				rec->flags |= FTRACE_FL_TRAMP;
6841c5f51572SChengming Zhou 			else
6842c5f51572SChengming Zhou 				rec->flags &= ~FTRACE_FL_TRAMP;
68438a224ffbSChengming Zhou 		}
6844b7ffffbbSSteven Rostedt (Red Hat) 	}
6845b7ffffbbSSteven Rostedt (Red Hat) 
6846b7ffffbbSSteven Rostedt (Red Hat) 	return cnt;
6847b7ffffbbSSteven Rostedt (Red Hat) }
6848b7ffffbbSSteven Rostedt (Red Hat) 
68492a5bfe47SSteven Rostedt (VMware) static void
68502a5bfe47SSteven Rostedt (VMware) clear_mod_from_hash(struct ftrace_page *pg, struct ftrace_hash *hash)
68512a5bfe47SSteven Rostedt (VMware) {
68522a5bfe47SSteven Rostedt (VMware) 	struct ftrace_func_entry *entry;
68532a5bfe47SSteven Rostedt (VMware) 	struct dyn_ftrace *rec;
68542a5bfe47SSteven Rostedt (VMware) 	int i;
68552a5bfe47SSteven Rostedt (VMware) 
68562a5bfe47SSteven Rostedt (VMware) 	if (ftrace_hash_empty(hash))
68572a5bfe47SSteven Rostedt (VMware) 		return;
68582a5bfe47SSteven Rostedt (VMware) 
68592a5bfe47SSteven Rostedt (VMware) 	for (i = 0; i < pg->index; i++) {
68602a5bfe47SSteven Rostedt (VMware) 		rec = &pg->records[i];
68612a5bfe47SSteven Rostedt (VMware) 		entry = __ftrace_lookup_ip(hash, rec->ip);
68622a5bfe47SSteven Rostedt (VMware) 		/*
68632a5bfe47SSteven Rostedt (VMware) 		 * Do not allow this rec to match again.
68642a5bfe47SSteven Rostedt (VMware) 		 * Yeah, it may waste some memory, but will be removed
68652a5bfe47SSteven Rostedt (VMware) 		 * if/when the hash is modified again.
68662a5bfe47SSteven Rostedt (VMware) 		 */
68672a5bfe47SSteven Rostedt (VMware) 		if (entry)
68682a5bfe47SSteven Rostedt (VMware) 			entry->ip = 0;
68692a5bfe47SSteven Rostedt (VMware) 	}
68702a5bfe47SSteven Rostedt (VMware) }
68712a5bfe47SSteven Rostedt (VMware) 
6872f2cc020dSIngo Molnar /* Clear any records from hashes */
68732a5bfe47SSteven Rostedt (VMware) static void clear_mod_from_hashes(struct ftrace_page *pg)
68742a5bfe47SSteven Rostedt (VMware) {
68752a5bfe47SSteven Rostedt (VMware) 	struct trace_array *tr;
68762a5bfe47SSteven Rostedt (VMware) 
68772a5bfe47SSteven Rostedt (VMware) 	mutex_lock(&trace_types_lock);
68782a5bfe47SSteven Rostedt (VMware) 	list_for_each_entry(tr, &ftrace_trace_arrays, list) {
68792a5bfe47SSteven Rostedt (VMware) 		if (!tr->ops || !tr->ops->func_hash)
68802a5bfe47SSteven Rostedt (VMware) 			continue;
68812a5bfe47SSteven Rostedt (VMware) 		mutex_lock(&tr->ops->func_hash->regex_lock);
68822a5bfe47SSteven Rostedt (VMware) 		clear_mod_from_hash(pg, tr->ops->func_hash->filter_hash);
68832a5bfe47SSteven Rostedt (VMware) 		clear_mod_from_hash(pg, tr->ops->func_hash->notrace_hash);
68842a5bfe47SSteven Rostedt (VMware) 		mutex_unlock(&tr->ops->func_hash->regex_lock);
68852a5bfe47SSteven Rostedt (VMware) 	}
68862a5bfe47SSteven Rostedt (VMware) 	mutex_unlock(&trace_types_lock);
68872a5bfe47SSteven Rostedt (VMware) }
68882a5bfe47SSteven Rostedt (VMware) 
68896aa69784SSteven Rostedt (VMware) static void ftrace_free_mod_map(struct rcu_head *rcu)
68906aa69784SSteven Rostedt (VMware) {
68916aa69784SSteven Rostedt (VMware) 	struct ftrace_mod_map *mod_map = container_of(rcu, struct ftrace_mod_map, rcu);
68926aa69784SSteven Rostedt (VMware) 	struct ftrace_mod_func *mod_func;
68936aa69784SSteven Rostedt (VMware) 	struct ftrace_mod_func *n;
68946aa69784SSteven Rostedt (VMware) 
68956aa69784SSteven Rostedt (VMware) 	/* All the contents of mod_map are now not visible to readers */
68966aa69784SSteven Rostedt (VMware) 	list_for_each_entry_safe(mod_func, n, &mod_map->funcs, list) {
68976aa69784SSteven Rostedt (VMware) 		kfree(mod_func->name);
68986aa69784SSteven Rostedt (VMware) 		list_del(&mod_func->list);
68996aa69784SSteven Rostedt (VMware) 		kfree(mod_func);
69006aa69784SSteven Rostedt (VMware) 	}
69016aa69784SSteven Rostedt (VMware) 
69026aa69784SSteven Rostedt (VMware) 	kfree(mod_map);
69036aa69784SSteven Rostedt (VMware) }
69046aa69784SSteven Rostedt (VMware) 
6905e7247a15S[email protected] void ftrace_release_mod(struct module *mod)
690693eb677dSSteven Rostedt {
69076aa69784SSteven Rostedt (VMware) 	struct ftrace_mod_map *mod_map;
69086aa69784SSteven Rostedt (VMware) 	struct ftrace_mod_map *n;
690993eb677dSSteven Rostedt 	struct dyn_ftrace *rec;
691032082309SSteven Rostedt 	struct ftrace_page **last_pg;
69112a5bfe47SSteven Rostedt (VMware) 	struct ftrace_page *tmp_page = NULL;
691293eb677dSSteven Rostedt 	struct ftrace_page *pg;
691393eb677dSSteven Rostedt 
691493eb677dSSteven Rostedt 	mutex_lock(&ftrace_lock);
691545a4a237SSteven Rostedt 
691645a4a237SSteven Rostedt 	if (ftrace_disabled)
691745a4a237SSteven Rostedt 		goto out_unlock;
691845a4a237SSteven Rostedt 
69196aa69784SSteven Rostedt (VMware) 	list_for_each_entry_safe(mod_map, n, &ftrace_mod_maps, list) {
69206aa69784SSteven Rostedt (VMware) 		if (mod_map->mod == mod) {
69216aa69784SSteven Rostedt (VMware) 			list_del_rcu(&mod_map->list);
692274401729SPaul E. McKenney 			call_rcu(&mod_map->rcu, ftrace_free_mod_map);
69236aa69784SSteven Rostedt (VMware) 			break;
69246aa69784SSteven Rostedt (VMware) 		}
69256aa69784SSteven Rostedt (VMware) 	}
69266aa69784SSteven Rostedt (VMware) 
692732082309SSteven Rostedt 	/*
692832082309SSteven Rostedt 	 * Each module has its own ftrace_pages, remove
692932082309SSteven Rostedt 	 * them from the list.
693032082309SSteven Rostedt 	 */
693132082309SSteven Rostedt 	last_pg = &ftrace_pages_start;
693232082309SSteven Rostedt 	for (pg = ftrace_pages_start; pg; pg = *last_pg) {
693332082309SSteven Rostedt 		rec = &pg->records[0];
69343e234289SSteven Rostedt (VMware) 		if (within_module_core(rec->ip, mod) ||
69353e234289SSteven Rostedt (VMware) 		    within_module_init(rec->ip, mod)) {
693693eb677dSSteven Rostedt 			/*
693732082309SSteven Rostedt 			 * As core pages are first, the first
693832082309SSteven Rostedt 			 * page should never be a module page.
693993eb677dSSteven Rostedt 			 */
694032082309SSteven Rostedt 			if (WARN_ON(pg == ftrace_pages_start))
694132082309SSteven Rostedt 				goto out_unlock;
694232082309SSteven Rostedt 
694332082309SSteven Rostedt 			/* Check if we are deleting the last page */
694432082309SSteven Rostedt 			if (pg == ftrace_pages)
694532082309SSteven Rostedt 				ftrace_pages = next_to_ftrace_page(last_pg);
694632082309SSteven Rostedt 
694783dd1493SSteven Rostedt (VMware) 			ftrace_update_tot_cnt -= pg->index;
694832082309SSteven Rostedt 			*last_pg = pg->next;
69492a5bfe47SSteven Rostedt (VMware) 
69502a5bfe47SSteven Rostedt (VMware) 			pg->next = tmp_page;
69512a5bfe47SSteven Rostedt (VMware) 			tmp_page = pg;
695232082309SSteven Rostedt 		} else
695332082309SSteven Rostedt 			last_pg = &pg->next;
695493eb677dSSteven Rostedt 	}
695545a4a237SSteven Rostedt  out_unlock:
695693eb677dSSteven Rostedt 	mutex_unlock(&ftrace_lock);
69572a5bfe47SSteven Rostedt (VMware) 
69582a5bfe47SSteven Rostedt (VMware) 	for (pg = tmp_page; pg; pg = tmp_page) {
69592a5bfe47SSteven Rostedt (VMware) 
69602a5bfe47SSteven Rostedt (VMware) 		/* Needs to be called outside of ftrace_lock */
69612a5bfe47SSteven Rostedt (VMware) 		clear_mod_from_hashes(pg);
69622a5bfe47SSteven Rostedt (VMware) 
6963db42523bSLinus Torvalds 		if (pg->records) {
6964db42523bSLinus Torvalds 			free_pages((unsigned long)pg->records, pg->order);
6965db42523bSLinus Torvalds 			ftrace_number_of_pages -= 1 << pg->order;
6966db42523bSLinus Torvalds 		}
69672a5bfe47SSteven Rostedt (VMware) 		tmp_page = pg->next;
69682a5bfe47SSteven Rostedt (VMware) 		kfree(pg);
6969da537f0aSSteven Rostedt (VMware) 		ftrace_number_of_groups--;
69702a5bfe47SSteven Rostedt (VMware) 	}
697193eb677dSSteven Rostedt }
697293eb677dSSteven Rostedt 
69737dcd182bSJessica Yu void ftrace_module_enable(struct module *mod)
6974b7ffffbbSSteven Rostedt (Red Hat) {
6975b7ffffbbSSteven Rostedt (Red Hat) 	struct dyn_ftrace *rec;
6976b7ffffbbSSteven Rostedt (Red Hat) 	struct ftrace_page *pg;
6977b7ffffbbSSteven Rostedt (Red Hat) 
6978b7ffffbbSSteven Rostedt (Red Hat) 	mutex_lock(&ftrace_lock);
6979b7ffffbbSSteven Rostedt (Red Hat) 
6980b7ffffbbSSteven Rostedt (Red Hat) 	if (ftrace_disabled)
6981b7ffffbbSSteven Rostedt (Red Hat) 		goto out_unlock;
6982b7ffffbbSSteven Rostedt (Red Hat) 
6983b7ffffbbSSteven Rostedt (Red Hat) 	/*
6984b7ffffbbSSteven Rostedt (Red Hat) 	 * If the tracing is enabled, go ahead and enable the record.
6985b7ffffbbSSteven Rostedt (Red Hat) 	 *
69869efb85c5SHariprasad Kelam 	 * The reason not to enable the record immediately is the
6987b7ffffbbSSteven Rostedt (Red Hat) 	 * inherent check of ftrace_make_nop/ftrace_make_call for
6988b7ffffbbSSteven Rostedt (Red Hat) 	 * correct previous instructions.  Making first the NOP
6989b7ffffbbSSteven Rostedt (Red Hat) 	 * conversion puts the module to the correct state, thus
6990b7ffffbbSSteven Rostedt (Red Hat) 	 * passing the ftrace_make_call check.
6991b7ffffbbSSteven Rostedt (Red Hat) 	 *
6992b7ffffbbSSteven Rostedt (Red Hat) 	 * We also delay this to after the module code already set the
6993b7ffffbbSSteven Rostedt (Red Hat) 	 * text to read-only, as we now need to set it back to read-write
6994b7ffffbbSSteven Rostedt (Red Hat) 	 * so that we can modify the text.
6995b7ffffbbSSteven Rostedt (Red Hat) 	 */
6996b7ffffbbSSteven Rostedt (Red Hat) 	if (ftrace_start_up)
6997b7ffffbbSSteven Rostedt (Red Hat) 		ftrace_arch_code_modify_prepare();
6998b7ffffbbSSteven Rostedt (Red Hat) 
6999b7ffffbbSSteven Rostedt (Red Hat) 	do_for_each_ftrace_rec(pg, rec) {
7000b7ffffbbSSteven Rostedt (Red Hat) 		int cnt;
7001b7ffffbbSSteven Rostedt (Red Hat) 		/*
7002b7ffffbbSSteven Rostedt (Red Hat) 		 * do_for_each_ftrace_rec() is a double loop.
7003b7ffffbbSSteven Rostedt (Red Hat) 		 * module text shares the pg. If a record is
7004b7ffffbbSSteven Rostedt (Red Hat) 		 * not part of this module, then skip this pg,
7005b7ffffbbSSteven Rostedt (Red Hat) 		 * which the "break" will do.
7006b7ffffbbSSteven Rostedt (Red Hat) 		 */
70073e234289SSteven Rostedt (VMware) 		if (!within_module_core(rec->ip, mod) &&
70083e234289SSteven Rostedt (VMware) 		    !within_module_init(rec->ip, mod))
7009b7ffffbbSSteven Rostedt (Red Hat) 			break;
7010b7ffffbbSSteven Rostedt (Red Hat) 
7011b39181f7SSteven Rostedt (Google) 		/* Weak functions should still be ignored */
7012b39181f7SSteven Rostedt (Google) 		if (!test_for_valid_rec(rec)) {
7013b39181f7SSteven Rostedt (Google) 			/* Clear all other flags. Should not be enabled anyway */
7014b39181f7SSteven Rostedt (Google) 			rec->flags = FTRACE_FL_DISABLED;
7015b39181f7SSteven Rostedt (Google) 			continue;
7016b39181f7SSteven Rostedt (Google) 		}
7017b39181f7SSteven Rostedt (Google) 
7018b7ffffbbSSteven Rostedt (Red Hat) 		cnt = 0;
7019b7ffffbbSSteven Rostedt (Red Hat) 
7020b7ffffbbSSteven Rostedt (Red Hat) 		/*
7021b7ffffbbSSteven Rostedt (Red Hat) 		 * When adding a module, we need to check if tracers are
7022b7ffffbbSSteven Rostedt (Red Hat) 		 * currently enabled and if they are, and can trace this record,
7023b7ffffbbSSteven Rostedt (Red Hat) 		 * we need to enable the module functions as well as update the
7024b7ffffbbSSteven Rostedt (Red Hat) 		 * reference counts for those function records.
7025b7ffffbbSSteven Rostedt (Red Hat) 		 */
7026b7ffffbbSSteven Rostedt (Red Hat) 		if (ftrace_start_up)
7027b7ffffbbSSteven Rostedt (Red Hat) 			cnt += referenced_filters(rec);
7028b7ffffbbSSteven Rostedt (Red Hat) 
70298a224ffbSChengming Zhou 		rec->flags &= ~FTRACE_FL_DISABLED;
70308a224ffbSChengming Zhou 		rec->flags += cnt;
7031b7ffffbbSSteven Rostedt (Red Hat) 
7032b7ffffbbSSteven Rostedt (Red Hat) 		if (ftrace_start_up && cnt) {
7033b7ffffbbSSteven Rostedt (Red Hat) 			int failed = __ftrace_replace_code(rec, 1);
7034b7ffffbbSSteven Rostedt (Red Hat) 			if (failed) {
7035b7ffffbbSSteven Rostedt (Red Hat) 				ftrace_bug(failed, rec);
7036b7ffffbbSSteven Rostedt (Red Hat) 				goto out_loop;
7037b7ffffbbSSteven Rostedt (Red Hat) 			}
7038b7ffffbbSSteven Rostedt (Red Hat) 		}
7039b7ffffbbSSteven Rostedt (Red Hat) 
7040b7ffffbbSSteven Rostedt (Red Hat) 	} while_for_each_ftrace_rec();
7041b7ffffbbSSteven Rostedt (Red Hat) 
7042b7ffffbbSSteven Rostedt (Red Hat)  out_loop:
7043b7ffffbbSSteven Rostedt (Red Hat) 	if (ftrace_start_up)
7044b7ffffbbSSteven Rostedt (Red Hat) 		ftrace_arch_code_modify_post_process();
7045b7ffffbbSSteven Rostedt (Red Hat) 
7046b7ffffbbSSteven Rostedt (Red Hat)  out_unlock:
7047b7ffffbbSSteven Rostedt (Red Hat) 	mutex_unlock(&ftrace_lock);
7048d7fbf8dfSSteven Rostedt (VMware) 
7049d7fbf8dfSSteven Rostedt (VMware) 	process_cached_mods(mod->name);
7050b7ffffbbSSteven Rostedt (Red Hat) }
7051b7ffffbbSSteven Rostedt (Red Hat) 
7052a949ae56SSteven Rostedt (Red Hat) void ftrace_module_init(struct module *mod)
705393eb677dSSteven Rostedt {
70542889c658SYuntao Wang 	int ret;
70552889c658SYuntao Wang 
705697e9b4fcSSteven Rostedt (Red Hat) 	if (ftrace_disabled || !mod->num_ftrace_callsites)
7057b6b71f66SAbel Vesa 		return;
7058b6b71f66SAbel Vesa 
70592889c658SYuntao Wang 	ret = ftrace_process_locs(mod, mod->ftrace_callsites,
706097e9b4fcSSteven Rostedt (Red Hat) 				  mod->ftrace_callsites + mod->num_ftrace_callsites);
70612889c658SYuntao Wang 	if (ret)
70622889c658SYuntao Wang 		pr_warn("ftrace: failed to allocate entries for module '%s' functions\n",
70632889c658SYuntao Wang 			mod->name);
706493eb677dSSteven Rostedt }
7065aba4b5c2SSteven Rostedt (VMware) 
7066aba4b5c2SSteven Rostedt (VMware) static void save_ftrace_mod_rec(struct ftrace_mod_map *mod_map,
7067aba4b5c2SSteven Rostedt (VMware) 				struct dyn_ftrace *rec)
7068aba4b5c2SSteven Rostedt (VMware) {
7069aba4b5c2SSteven Rostedt (VMware) 	struct ftrace_mod_func *mod_func;
7070aba4b5c2SSteven Rostedt (VMware) 	unsigned long symsize;
7071aba4b5c2SSteven Rostedt (VMware) 	unsigned long offset;
7072aba4b5c2SSteven Rostedt (VMware) 	char str[KSYM_SYMBOL_LEN];
7073aba4b5c2SSteven Rostedt (VMware) 	char *modname;
7074aba4b5c2SSteven Rostedt (VMware) 	const char *ret;
7075aba4b5c2SSteven Rostedt (VMware) 
7076aba4b5c2SSteven Rostedt (VMware) 	ret = kallsyms_lookup(rec->ip, &symsize, &offset, &modname, str);
7077aba4b5c2SSteven Rostedt (VMware) 	if (!ret)
7078aba4b5c2SSteven Rostedt (VMware) 		return;
7079aba4b5c2SSteven Rostedt (VMware) 
7080aba4b5c2SSteven Rostedt (VMware) 	mod_func = kmalloc(sizeof(*mod_func), GFP_KERNEL);
7081aba4b5c2SSteven Rostedt (VMware) 	if (!mod_func)
7082aba4b5c2SSteven Rostedt (VMware) 		return;
7083aba4b5c2SSteven Rostedt (VMware) 
7084aba4b5c2SSteven Rostedt (VMware) 	mod_func->name = kstrdup(str, GFP_KERNEL);
7085aba4b5c2SSteven Rostedt (VMware) 	if (!mod_func->name) {
7086aba4b5c2SSteven Rostedt (VMware) 		kfree(mod_func);
7087aba4b5c2SSteven Rostedt (VMware) 		return;
7088aba4b5c2SSteven Rostedt (VMware) 	}
7089aba4b5c2SSteven Rostedt (VMware) 
7090aba4b5c2SSteven Rostedt (VMware) 	mod_func->ip = rec->ip - offset;
7091aba4b5c2SSteven Rostedt (VMware) 	mod_func->size = symsize;
7092aba4b5c2SSteven Rostedt (VMware) 
70936171a031SSteven Rostedt (VMware) 	mod_map->num_funcs++;
70946171a031SSteven Rostedt (VMware) 
7095aba4b5c2SSteven Rostedt (VMware) 	list_add_rcu(&mod_func->list, &mod_map->funcs);
7096aba4b5c2SSteven Rostedt (VMware) }
7097aba4b5c2SSteven Rostedt (VMware) 
7098aba4b5c2SSteven Rostedt (VMware) static struct ftrace_mod_map *
7099aba4b5c2SSteven Rostedt (VMware) allocate_ftrace_mod_map(struct module *mod,
7100aba4b5c2SSteven Rostedt (VMware) 			unsigned long start, unsigned long end)
7101aba4b5c2SSteven Rostedt (VMware) {
7102aba4b5c2SSteven Rostedt (VMware) 	struct ftrace_mod_map *mod_map;
7103aba4b5c2SSteven Rostedt (VMware) 
7104aba4b5c2SSteven Rostedt (VMware) 	mod_map = kmalloc(sizeof(*mod_map), GFP_KERNEL);
7105aba4b5c2SSteven Rostedt (VMware) 	if (!mod_map)
7106aba4b5c2SSteven Rostedt (VMware) 		return NULL;
7107aba4b5c2SSteven Rostedt (VMware) 
7108aba4b5c2SSteven Rostedt (VMware) 	mod_map->mod = mod;
7109aba4b5c2SSteven Rostedt (VMware) 	mod_map->start_addr = start;
7110aba4b5c2SSteven Rostedt (VMware) 	mod_map->end_addr = end;
71116171a031SSteven Rostedt (VMware) 	mod_map->num_funcs = 0;
7112aba4b5c2SSteven Rostedt (VMware) 
7113aba4b5c2SSteven Rostedt (VMware) 	INIT_LIST_HEAD_RCU(&mod_map->funcs);
7114aba4b5c2SSteven Rostedt (VMware) 
7115aba4b5c2SSteven Rostedt (VMware) 	list_add_rcu(&mod_map->list, &ftrace_mod_maps);
7116aba4b5c2SSteven Rostedt (VMware) 
7117aba4b5c2SSteven Rostedt (VMware) 	return mod_map;
7118aba4b5c2SSteven Rostedt (VMware) }
7119aba4b5c2SSteven Rostedt (VMware) 
7120aba4b5c2SSteven Rostedt (VMware) static const char *
7121aba4b5c2SSteven Rostedt (VMware) ftrace_func_address_lookup(struct ftrace_mod_map *mod_map,
7122aba4b5c2SSteven Rostedt (VMware) 			   unsigned long addr, unsigned long *size,
7123aba4b5c2SSteven Rostedt (VMware) 			   unsigned long *off, char *sym)
7124aba4b5c2SSteven Rostedt (VMware) {
7125aba4b5c2SSteven Rostedt (VMware) 	struct ftrace_mod_func *found_func =  NULL;
7126aba4b5c2SSteven Rostedt (VMware) 	struct ftrace_mod_func *mod_func;
7127aba4b5c2SSteven Rostedt (VMware) 
7128aba4b5c2SSteven Rostedt (VMware) 	list_for_each_entry_rcu(mod_func, &mod_map->funcs, list) {
7129aba4b5c2SSteven Rostedt (VMware) 		if (addr >= mod_func->ip &&
7130aba4b5c2SSteven Rostedt (VMware) 		    addr < mod_func->ip + mod_func->size) {
7131aba4b5c2SSteven Rostedt (VMware) 			found_func = mod_func;
7132aba4b5c2SSteven Rostedt (VMware) 			break;
7133aba4b5c2SSteven Rostedt (VMware) 		}
7134aba4b5c2SSteven Rostedt (VMware) 	}
7135aba4b5c2SSteven Rostedt (VMware) 
7136aba4b5c2SSteven Rostedt (VMware) 	if (found_func) {
7137aba4b5c2SSteven Rostedt (VMware) 		if (size)
7138aba4b5c2SSteven Rostedt (VMware) 			*size = found_func->size;
7139aba4b5c2SSteven Rostedt (VMware) 		if (off)
7140aba4b5c2SSteven Rostedt (VMware) 			*off = addr - found_func->ip;
7141aba4b5c2SSteven Rostedt (VMware) 		if (sym)
7142aba4b5c2SSteven Rostedt (VMware) 			strlcpy(sym, found_func->name, KSYM_NAME_LEN);
7143aba4b5c2SSteven Rostedt (VMware) 
7144aba4b5c2SSteven Rostedt (VMware) 		return found_func->name;
7145aba4b5c2SSteven Rostedt (VMware) 	}
7146aba4b5c2SSteven Rostedt (VMware) 
7147aba4b5c2SSteven Rostedt (VMware) 	return NULL;
7148aba4b5c2SSteven Rostedt (VMware) }
7149aba4b5c2SSteven Rostedt (VMware) 
7150aba4b5c2SSteven Rostedt (VMware) const char *
7151aba4b5c2SSteven Rostedt (VMware) ftrace_mod_address_lookup(unsigned long addr, unsigned long *size,
7152aba4b5c2SSteven Rostedt (VMware) 		   unsigned long *off, char **modname, char *sym)
7153aba4b5c2SSteven Rostedt (VMware) {
7154aba4b5c2SSteven Rostedt (VMware) 	struct ftrace_mod_map *mod_map;
7155aba4b5c2SSteven Rostedt (VMware) 	const char *ret = NULL;
7156aba4b5c2SSteven Rostedt (VMware) 
715774401729SPaul E. McKenney 	/* mod_map is freed via call_rcu() */
7158aba4b5c2SSteven Rostedt (VMware) 	preempt_disable();
7159aba4b5c2SSteven Rostedt (VMware) 	list_for_each_entry_rcu(mod_map, &ftrace_mod_maps, list) {
7160aba4b5c2SSteven Rostedt (VMware) 		ret = ftrace_func_address_lookup(mod_map, addr, size, off, sym);
7161aba4b5c2SSteven Rostedt (VMware) 		if (ret) {
7162aba4b5c2SSteven Rostedt (VMware) 			if (modname)
7163aba4b5c2SSteven Rostedt (VMware) 				*modname = mod_map->mod->name;
7164aba4b5c2SSteven Rostedt (VMware) 			break;
7165aba4b5c2SSteven Rostedt (VMware) 		}
7166aba4b5c2SSteven Rostedt (VMware) 	}
7167aba4b5c2SSteven Rostedt (VMware) 	preempt_enable();
7168aba4b5c2SSteven Rostedt (VMware) 
7169aba4b5c2SSteven Rostedt (VMware) 	return ret;
7170aba4b5c2SSteven Rostedt (VMware) }
7171aba4b5c2SSteven Rostedt (VMware) 
71726171a031SSteven Rostedt (VMware) int ftrace_mod_get_kallsym(unsigned int symnum, unsigned long *value,
71736171a031SSteven Rostedt (VMware) 			   char *type, char *name,
71746171a031SSteven Rostedt (VMware) 			   char *module_name, int *exported)
71756171a031SSteven Rostedt (VMware) {
71766171a031SSteven Rostedt (VMware) 	struct ftrace_mod_map *mod_map;
71776171a031SSteven Rostedt (VMware) 	struct ftrace_mod_func *mod_func;
7178fc0ea795SAdrian Hunter 	int ret;
71796171a031SSteven Rostedt (VMware) 
71806171a031SSteven Rostedt (VMware) 	preempt_disable();
71816171a031SSteven Rostedt (VMware) 	list_for_each_entry_rcu(mod_map, &ftrace_mod_maps, list) {
71826171a031SSteven Rostedt (VMware) 
71836171a031SSteven Rostedt (VMware) 		if (symnum >= mod_map->num_funcs) {
71846171a031SSteven Rostedt (VMware) 			symnum -= mod_map->num_funcs;
71856171a031SSteven Rostedt (VMware) 			continue;
71866171a031SSteven Rostedt (VMware) 		}
71876171a031SSteven Rostedt (VMware) 
71886171a031SSteven Rostedt (VMware) 		list_for_each_entry_rcu(mod_func, &mod_map->funcs, list) {
71896171a031SSteven Rostedt (VMware) 			if (symnum > 1) {
71906171a031SSteven Rostedt (VMware) 				symnum--;
71916171a031SSteven Rostedt (VMware) 				continue;
71926171a031SSteven Rostedt (VMware) 			}
71936171a031SSteven Rostedt (VMware) 
71946171a031SSteven Rostedt (VMware) 			*value = mod_func->ip;
71956171a031SSteven Rostedt (VMware) 			*type = 'T';
71966171a031SSteven Rostedt (VMware) 			strlcpy(name, mod_func->name, KSYM_NAME_LEN);
71976171a031SSteven Rostedt (VMware) 			strlcpy(module_name, mod_map->mod->name, MODULE_NAME_LEN);
71986171a031SSteven Rostedt (VMware) 			*exported = 1;
71996171a031SSteven Rostedt (VMware) 			preempt_enable();
72006171a031SSteven Rostedt (VMware) 			return 0;
72016171a031SSteven Rostedt (VMware) 		}
72026171a031SSteven Rostedt (VMware) 		WARN_ON(1);
72036171a031SSteven Rostedt (VMware) 		break;
72046171a031SSteven Rostedt (VMware) 	}
7205fc0ea795SAdrian Hunter 	ret = ftrace_get_trampoline_kallsym(symnum, value, type, name,
7206fc0ea795SAdrian Hunter 					    module_name, exported);
72076171a031SSteven Rostedt (VMware) 	preempt_enable();
7208fc0ea795SAdrian Hunter 	return ret;
72096171a031SSteven Rostedt (VMware) }
72106171a031SSteven Rostedt (VMware) 
7211aba4b5c2SSteven Rostedt (VMware) #else
7212aba4b5c2SSteven Rostedt (VMware) static void save_ftrace_mod_rec(struct ftrace_mod_map *mod_map,
7213aba4b5c2SSteven Rostedt (VMware) 				struct dyn_ftrace *rec) { }
7214aba4b5c2SSteven Rostedt (VMware) static inline struct ftrace_mod_map *
7215aba4b5c2SSteven Rostedt (VMware) allocate_ftrace_mod_map(struct module *mod,
7216aba4b5c2SSteven Rostedt (VMware) 			unsigned long start, unsigned long end)
7217aba4b5c2SSteven Rostedt (VMware) {
7218aba4b5c2SSteven Rostedt (VMware) 	return NULL;
7219aba4b5c2SSteven Rostedt (VMware) }
7220fc0ea795SAdrian Hunter int ftrace_mod_get_kallsym(unsigned int symnum, unsigned long *value,
7221fc0ea795SAdrian Hunter 			   char *type, char *name, char *module_name,
7222fc0ea795SAdrian Hunter 			   int *exported)
7223fc0ea795SAdrian Hunter {
7224fc0ea795SAdrian Hunter 	int ret;
7225fc0ea795SAdrian Hunter 
7226fc0ea795SAdrian Hunter 	preempt_disable();
7227fc0ea795SAdrian Hunter 	ret = ftrace_get_trampoline_kallsym(symnum, value, type, name,
7228fc0ea795SAdrian Hunter 					    module_name, exported);
7229fc0ea795SAdrian Hunter 	preempt_enable();
7230fc0ea795SAdrian Hunter 	return ret;
7231fc0ea795SAdrian Hunter }
723293eb677dSSteven Rostedt #endif /* CONFIG_MODULES */
723393eb677dSSteven Rostedt 
72348715b108SJoel Fernandes struct ftrace_init_func {
72358715b108SJoel Fernandes 	struct list_head list;
72368715b108SJoel Fernandes 	unsigned long ip;
72378715b108SJoel Fernandes };
72388715b108SJoel Fernandes 
72398715b108SJoel Fernandes /* Clear any init ips from hashes */
72408715b108SJoel Fernandes static void
72418715b108SJoel Fernandes clear_func_from_hash(struct ftrace_init_func *func, struct ftrace_hash *hash)
724242c269c8SSteven Rostedt (VMware) {
72438715b108SJoel Fernandes 	struct ftrace_func_entry *entry;
72448715b108SJoel Fernandes 
724508468754SChangbin Du 	entry = ftrace_lookup_ip(hash, func->ip);
72468715b108SJoel Fernandes 	/*
72478715b108SJoel Fernandes 	 * Do not allow this rec to match again.
72488715b108SJoel Fernandes 	 * Yeah, it may waste some memory, but will be removed
72498715b108SJoel Fernandes 	 * if/when the hash is modified again.
72508715b108SJoel Fernandes 	 */
72518715b108SJoel Fernandes 	if (entry)
72528715b108SJoel Fernandes 		entry->ip = 0;
72538715b108SJoel Fernandes }
72548715b108SJoel Fernandes 
72558715b108SJoel Fernandes static void
72568715b108SJoel Fernandes clear_func_from_hashes(struct ftrace_init_func *func)
72578715b108SJoel Fernandes {
72588715b108SJoel Fernandes 	struct trace_array *tr;
72598715b108SJoel Fernandes 
72608715b108SJoel Fernandes 	mutex_lock(&trace_types_lock);
72618715b108SJoel Fernandes 	list_for_each_entry(tr, &ftrace_trace_arrays, list) {
72628715b108SJoel Fernandes 		if (!tr->ops || !tr->ops->func_hash)
72638715b108SJoel Fernandes 			continue;
72648715b108SJoel Fernandes 		mutex_lock(&tr->ops->func_hash->regex_lock);
72658715b108SJoel Fernandes 		clear_func_from_hash(func, tr->ops->func_hash->filter_hash);
72668715b108SJoel Fernandes 		clear_func_from_hash(func, tr->ops->func_hash->notrace_hash);
72678715b108SJoel Fernandes 		mutex_unlock(&tr->ops->func_hash->regex_lock);
72688715b108SJoel Fernandes 	}
72698715b108SJoel Fernandes 	mutex_unlock(&trace_types_lock);
72708715b108SJoel Fernandes }
72718715b108SJoel Fernandes 
72728715b108SJoel Fernandes static void add_to_clear_hash_list(struct list_head *clear_list,
72738715b108SJoel Fernandes 				   struct dyn_ftrace *rec)
72748715b108SJoel Fernandes {
72758715b108SJoel Fernandes 	struct ftrace_init_func *func;
72768715b108SJoel Fernandes 
72778715b108SJoel Fernandes 	func = kmalloc(sizeof(*func), GFP_KERNEL);
72788715b108SJoel Fernandes 	if (!func) {
727924589e3aSSteven Rostedt (VMware) 		MEM_FAIL(1, "alloc failure, ftrace filter could be stale\n");
72808715b108SJoel Fernandes 		return;
72818715b108SJoel Fernandes 	}
72828715b108SJoel Fernandes 
72838715b108SJoel Fernandes 	func->ip = rec->ip;
72848715b108SJoel Fernandes 	list_add(&func->list, clear_list);
72858715b108SJoel Fernandes }
72868715b108SJoel Fernandes 
7287aba4b5c2SSteven Rostedt (VMware) void ftrace_free_mem(struct module *mod, void *start_ptr, void *end_ptr)
728842c269c8SSteven Rostedt (VMware) {
72896cafbe15SSteven Rostedt (VMware) 	unsigned long start = (unsigned long)(start_ptr);
72906cafbe15SSteven Rostedt (VMware) 	unsigned long end = (unsigned long)(end_ptr);
729142c269c8SSteven Rostedt (VMware) 	struct ftrace_page **last_pg = &ftrace_pages_start;
729242c269c8SSteven Rostedt (VMware) 	struct ftrace_page *pg;
729342c269c8SSteven Rostedt (VMware) 	struct dyn_ftrace *rec;
729442c269c8SSteven Rostedt (VMware) 	struct dyn_ftrace key;
7295aba4b5c2SSteven Rostedt (VMware) 	struct ftrace_mod_map *mod_map = NULL;
72968715b108SJoel Fernandes 	struct ftrace_init_func *func, *func_next;
72978715b108SJoel Fernandes 	struct list_head clear_hash;
729842c269c8SSteven Rostedt (VMware) 
72998715b108SJoel Fernandes 	INIT_LIST_HEAD(&clear_hash);
73008715b108SJoel Fernandes 
730142c269c8SSteven Rostedt (VMware) 	key.ip = start;
730242c269c8SSteven Rostedt (VMware) 	key.flags = end;	/* overload flags, as it is unsigned long */
730342c269c8SSteven Rostedt (VMware) 
730442c269c8SSteven Rostedt (VMware) 	mutex_lock(&ftrace_lock);
730542c269c8SSteven Rostedt (VMware) 
7306aba4b5c2SSteven Rostedt (VMware) 	/*
7307aba4b5c2SSteven Rostedt (VMware) 	 * If we are freeing module init memory, then check if
7308aba4b5c2SSteven Rostedt (VMware) 	 * any tracer is active. If so, we need to save a mapping of
7309aba4b5c2SSteven Rostedt (VMware) 	 * the module functions being freed with the address.
7310aba4b5c2SSteven Rostedt (VMware) 	 */
7311aba4b5c2SSteven Rostedt (VMware) 	if (mod && ftrace_ops_list != &ftrace_list_end)
7312aba4b5c2SSteven Rostedt (VMware) 		mod_map = allocate_ftrace_mod_map(mod, start, end);
7313aba4b5c2SSteven Rostedt (VMware) 
731442c269c8SSteven Rostedt (VMware) 	for (pg = ftrace_pages_start; pg; last_pg = &pg->next, pg = *last_pg) {
731542c269c8SSteven Rostedt (VMware) 		if (end < pg->records[0].ip ||
731642c269c8SSteven Rostedt (VMware) 		    start >= (pg->records[pg->index - 1].ip + MCOUNT_INSN_SIZE))
731742c269c8SSteven Rostedt (VMware) 			continue;
731842c269c8SSteven Rostedt (VMware)  again:
731942c269c8SSteven Rostedt (VMware) 		rec = bsearch(&key, pg->records, pg->index,
732042c269c8SSteven Rostedt (VMware) 			      sizeof(struct dyn_ftrace),
732142c269c8SSteven Rostedt (VMware) 			      ftrace_cmp_recs);
732242c269c8SSteven Rostedt (VMware) 		if (!rec)
732342c269c8SSteven Rostedt (VMware) 			continue;
7324aba4b5c2SSteven Rostedt (VMware) 
73258715b108SJoel Fernandes 		/* rec will be cleared from hashes after ftrace_lock unlock */
73268715b108SJoel Fernandes 		add_to_clear_hash_list(&clear_hash, rec);
73278715b108SJoel Fernandes 
7328aba4b5c2SSteven Rostedt (VMware) 		if (mod_map)
7329aba4b5c2SSteven Rostedt (VMware) 			save_ftrace_mod_rec(mod_map, rec);
7330aba4b5c2SSteven Rostedt (VMware) 
733142c269c8SSteven Rostedt (VMware) 		pg->index--;
73324ec78467SSteven Rostedt (VMware) 		ftrace_update_tot_cnt--;
733342c269c8SSteven Rostedt (VMware) 		if (!pg->index) {
733442c269c8SSteven Rostedt (VMware) 			*last_pg = pg->next;
7335db42523bSLinus Torvalds 			if (pg->records) {
7336db42523bSLinus Torvalds 				free_pages((unsigned long)pg->records, pg->order);
7337db42523bSLinus Torvalds 				ftrace_number_of_pages -= 1 << pg->order;
7338db42523bSLinus Torvalds 			}
7339da537f0aSSteven Rostedt (VMware) 			ftrace_number_of_groups--;
734042c269c8SSteven Rostedt (VMware) 			kfree(pg);
734142c269c8SSteven Rostedt (VMware) 			pg = container_of(last_pg, struct ftrace_page, next);
734242c269c8SSteven Rostedt (VMware) 			if (!(*last_pg))
734342c269c8SSteven Rostedt (VMware) 				ftrace_pages = pg;
734442c269c8SSteven Rostedt (VMware) 			continue;
734542c269c8SSteven Rostedt (VMware) 		}
734642c269c8SSteven Rostedt (VMware) 		memmove(rec, rec + 1,
734742c269c8SSteven Rostedt (VMware) 			(pg->index - (rec - pg->records)) * sizeof(*rec));
734842c269c8SSteven Rostedt (VMware) 		/* More than one function may be in this block */
734942c269c8SSteven Rostedt (VMware) 		goto again;
735042c269c8SSteven Rostedt (VMware) 	}
735142c269c8SSteven Rostedt (VMware) 	mutex_unlock(&ftrace_lock);
73528715b108SJoel Fernandes 
73538715b108SJoel Fernandes 	list_for_each_entry_safe(func, func_next, &clear_hash, list) {
73548715b108SJoel Fernandes 		clear_func_from_hashes(func);
73558715b108SJoel Fernandes 		kfree(func);
73568715b108SJoel Fernandes 	}
735742c269c8SSteven Rostedt (VMware) }
735842c269c8SSteven Rostedt (VMware) 
73596cafbe15SSteven Rostedt (VMware) void __init ftrace_free_init_mem(void)
73606cafbe15SSteven Rostedt (VMware) {
73616cafbe15SSteven Rostedt (VMware) 	void *start = (void *)(&__init_begin);
73626cafbe15SSteven Rostedt (VMware) 	void *end = (void *)(&__init_end);
73636cafbe15SSteven Rostedt (VMware) 
7364380af29bSSteven Rostedt (Google) 	ftrace_boot_snapshot();
7365380af29bSSteven Rostedt (Google) 
7366aba4b5c2SSteven Rostedt (VMware) 	ftrace_free_mem(NULL, start, end);
736793eb677dSSteven Rostedt }
736893eb677dSSteven Rostedt 
73696644c654SWeizhao Ouyang int __init __weak ftrace_dyn_arch_init(void)
73706644c654SWeizhao Ouyang {
73716644c654SWeizhao Ouyang 	return 0;
73726644c654SWeizhao Ouyang }
73736644c654SWeizhao Ouyang 
737468bf21aaSSteven Rostedt void __init ftrace_init(void)
737568bf21aaSSteven Rostedt {
73761dc43cf0SJiri Slaby 	extern unsigned long __start_mcount_loc[];
73771dc43cf0SJiri Slaby 	extern unsigned long __stop_mcount_loc[];
73783a36cb11SJiri Slaby 	unsigned long count, flags;
737968bf21aaSSteven Rostedt 	int ret;
738068bf21aaSSteven Rostedt 
738168bf21aaSSteven Rostedt 	local_irq_save(flags);
73823a36cb11SJiri Slaby 	ret = ftrace_dyn_arch_init();
738368bf21aaSSteven Rostedt 	local_irq_restore(flags);
7384af64a7cbSJiri Slaby 	if (ret)
738568bf21aaSSteven Rostedt 		goto failed;
738668bf21aaSSteven Rostedt 
738768bf21aaSSteven Rostedt 	count = __stop_mcount_loc - __start_mcount_loc;
7388c867ccd8SJiri Slaby 	if (!count) {
7389c867ccd8SJiri Slaby 		pr_info("ftrace: No functions to be traced?\n");
739068bf21aaSSteven Rostedt 		goto failed;
7391c867ccd8SJiri Slaby 	}
7392c867ccd8SJiri Slaby 
7393c867ccd8SJiri Slaby 	pr_info("ftrace: allocating %ld entries in %ld pages\n",
739408948caeSWang Wensheng 		count, DIV_ROUND_UP(count, ENTRIES_PER_PAGE));
739568bf21aaSSteven Rostedt 
73965cb084bbSJiri Olsa 	ret = ftrace_process_locs(NULL,
739731e88909SSteven Rostedt 				  __start_mcount_loc,
739868bf21aaSSteven Rostedt 				  __stop_mcount_loc);
73992889c658SYuntao Wang 	if (ret) {
74002889c658SYuntao Wang 		pr_warn("ftrace: failed to allocate entries for functions\n");
74012889c658SYuntao Wang 		goto failed;
74022889c658SYuntao Wang 	}
740368bf21aaSSteven Rostedt 
7404da537f0aSSteven Rostedt (VMware) 	pr_info("ftrace: allocated %ld pages with %ld groups\n",
7405da537f0aSSteven Rostedt (VMware) 		ftrace_number_of_pages, ftrace_number_of_groups);
7406da537f0aSSteven Rostedt (VMware) 
74072889c658SYuntao Wang 	last_ftrace_enabled = ftrace_enabled = 1;
74082889c658SYuntao Wang 
74092af15d6aSSteven Rostedt 	set_ftrace_early_filters();
74102af15d6aSSteven Rostedt 
741168bf21aaSSteven Rostedt 	return;
741268bf21aaSSteven Rostedt  failed:
741368bf21aaSSteven Rostedt 	ftrace_disabled = 1;
741468bf21aaSSteven Rostedt }
741568bf21aaSSteven Rostedt 
7416f3bea491SSteven Rostedt (Red Hat) /* Do nothing if arch does not support this */
7417f3bea491SSteven Rostedt (Red Hat) void __weak arch_ftrace_update_trampoline(struct ftrace_ops *ops)
7418f3bea491SSteven Rostedt (Red Hat) {
7419f3bea491SSteven Rostedt (Red Hat) }
7420f3bea491SSteven Rostedt (Red Hat) 
7421f3bea491SSteven Rostedt (Red Hat) static void ftrace_update_trampoline(struct ftrace_ops *ops)
7422f3bea491SSteven Rostedt (Red Hat) {
7423fc0ea795SAdrian Hunter 	unsigned long trampoline = ops->trampoline;
7424fc0ea795SAdrian Hunter 
7425f3bea491SSteven Rostedt (Red Hat) 	arch_ftrace_update_trampoline(ops);
7426fc0ea795SAdrian Hunter 	if (ops->trampoline && ops->trampoline != trampoline &&
7427dd9ddf46SAdrian Hunter 	    (ops->flags & FTRACE_OPS_FL_ALLOC_TRAMP)) {
7428dd9ddf46SAdrian Hunter 		/* Add to kallsyms before the perf events */
7429fc0ea795SAdrian Hunter 		ftrace_add_trampoline_to_kallsyms(ops);
7430dd9ddf46SAdrian Hunter 		perf_event_ksymbol(PERF_RECORD_KSYMBOL_TYPE_OOL,
7431dd9ddf46SAdrian Hunter 				   ops->trampoline, ops->trampoline_size, false,
7432dd9ddf46SAdrian Hunter 				   FTRACE_TRAMPOLINE_SYM);
7433548e1f6cSAdrian Hunter 		/*
7434548e1f6cSAdrian Hunter 		 * Record the perf text poke event after the ksymbol register
7435548e1f6cSAdrian Hunter 		 * event.
7436548e1f6cSAdrian Hunter 		 */
7437548e1f6cSAdrian Hunter 		perf_event_text_poke((void *)ops->trampoline, NULL, 0,
7438548e1f6cSAdrian Hunter 				     (void *)ops->trampoline,
7439548e1f6cSAdrian Hunter 				     ops->trampoline_size);
7440dd9ddf46SAdrian Hunter 	}
7441f3bea491SSteven Rostedt (Red Hat) }
7442f3bea491SSteven Rostedt (Red Hat) 
744304ec7bb6SSteven Rostedt (VMware) void ftrace_init_trace_array(struct trace_array *tr)
744404ec7bb6SSteven Rostedt (VMware) {
744504ec7bb6SSteven Rostedt (VMware) 	INIT_LIST_HEAD(&tr->func_probes);
7446673feb9dSSteven Rostedt (VMware) 	INIT_LIST_HEAD(&tr->mod_trace);
7447673feb9dSSteven Rostedt (VMware) 	INIT_LIST_HEAD(&tr->mod_notrace);
744804ec7bb6SSteven Rostedt (VMware) }
74493d083395SSteven Rostedt #else
74500b6e4d56SFrederic Weisbecker 
74513306fc4aSSteven Rostedt (VMware) struct ftrace_ops global_ops = {
7452bd69c30bSSteven Rostedt 	.func			= ftrace_stub,
7453a25d036dSSteven Rostedt (VMware) 	.flags			= FTRACE_OPS_FL_INITIALIZED |
7454e3eea140SSteven Rostedt (Red Hat) 				  FTRACE_OPS_FL_PID,
7455bd69c30bSSteven Rostedt };
7456bd69c30bSSteven Rostedt 
74570b6e4d56SFrederic Weisbecker static int __init ftrace_nodyn_init(void)
74580b6e4d56SFrederic Weisbecker {
74590b6e4d56SFrederic Weisbecker 	ftrace_enabled = 1;
74600b6e4d56SFrederic Weisbecker 	return 0;
74610b6e4d56SFrederic Weisbecker }
74626f415672SSteven Rostedt core_initcall(ftrace_nodyn_init);
74630b6e4d56SFrederic Weisbecker 
74648434dc93SSteven Rostedt (Red Hat) static inline int ftrace_init_dyn_tracefs(struct dentry *d_tracer) { return 0; }
7465e1effa01SSteven Rostedt (Red Hat) static inline void ftrace_startup_all(int command) { }
74668a56d776SSteven Rostedt (Red Hat) 
7467f3bea491SSteven Rostedt (Red Hat) static void ftrace_update_trampoline(struct ftrace_ops *ops)
7468f3bea491SSteven Rostedt (Red Hat) {
7469f3bea491SSteven Rostedt (Red Hat) }
7470f3bea491SSteven Rostedt (Red Hat) 
74713d083395SSteven Rostedt #endif /* CONFIG_DYNAMIC_FTRACE */
74723d083395SSteven Rostedt 
74734104d326SSteven Rostedt (Red Hat) __init void ftrace_init_global_array_ops(struct trace_array *tr)
74744104d326SSteven Rostedt (Red Hat) {
74754104d326SSteven Rostedt (Red Hat) 	tr->ops = &global_ops;
74764104d326SSteven Rostedt (Red Hat) 	tr->ops->private = tr;
747704ec7bb6SSteven Rostedt (VMware) 	ftrace_init_trace_array(tr);
74784104d326SSteven Rostedt (Red Hat) }
74794104d326SSteven Rostedt (Red Hat) 
74804104d326SSteven Rostedt (Red Hat) void ftrace_init_array_ops(struct trace_array *tr, ftrace_func_t func)
74814104d326SSteven Rostedt (Red Hat) {
74824104d326SSteven Rostedt (Red Hat) 	/* If we filter on pids, update to use the pid function */
74834104d326SSteven Rostedt (Red Hat) 	if (tr->flags & TRACE_ARRAY_FL_GLOBAL) {
74844104d326SSteven Rostedt (Red Hat) 		if (WARN_ON(tr->ops->func != ftrace_stub))
74854104d326SSteven Rostedt (Red Hat) 			printk("ftrace ops had %pS for function\n",
74864104d326SSteven Rostedt (Red Hat) 			       tr->ops->func);
74874104d326SSteven Rostedt (Red Hat) 	}
74884104d326SSteven Rostedt (Red Hat) 	tr->ops->func = func;
74894104d326SSteven Rostedt (Red Hat) 	tr->ops->private = tr;
74904104d326SSteven Rostedt (Red Hat) }
74914104d326SSteven Rostedt (Red Hat) 
74924104d326SSteven Rostedt (Red Hat) void ftrace_reset_array_ops(struct trace_array *tr)
74934104d326SSteven Rostedt (Red Hat) {
74944104d326SSteven Rostedt (Red Hat) 	tr->ops->func = ftrace_stub;
74954104d326SSteven Rostedt (Red Hat) }
74964104d326SSteven Rostedt (Red Hat) 
7497fabe38abSMasami Hiramatsu static nokprobe_inline void
74982f5f6ad9SSteven Rostedt __ftrace_ops_list_func(unsigned long ip, unsigned long parent_ip,
7499d19ad077SSteven Rostedt (VMware) 		       struct ftrace_ops *ignored, struct ftrace_regs *fregs)
7500b848914cSSteven Rostedt {
7501d19ad077SSteven Rostedt (VMware) 	struct pt_regs *regs = ftrace_get_regs(fregs);
7502cdbe61bfSSteven Rostedt 	struct ftrace_ops *op;
7503edc15cafSSteven Rostedt 	int bit;
7504b848914cSSteven Rostedt 
7505ce5e4803S王贇 	/*
7506ce5e4803S王贇 	 * The ftrace_test_and_set_recursion() will disable preemption,
7507ce5e4803S王贇 	 * which is required since some of the ops may be dynamically
7508ce5e4803S王贇 	 * allocated, they must be freed after a synchronize_rcu().
7509ce5e4803S王贇 	 */
7510ed65df63SSteven Rostedt (VMware) 	bit = trace_test_and_set_recursion(ip, parent_ip, TRACE_LIST_START);
7511edc15cafSSteven Rostedt 	if (bit < 0)
7512b1cff0adSSteven Rostedt 		return;
7513b1cff0adSSteven Rostedt 
75140a016409SSteven Rostedt 	do_for_each_ftrace_op(op, ftrace_ops_list) {
75152fa717a0SSteven Rostedt (VMware) 		/* Stub functions don't need to be called nor tested */
75162fa717a0SSteven Rostedt (VMware) 		if (op->flags & FTRACE_OPS_FL_STUB)
75172fa717a0SSteven Rostedt (VMware) 			continue;
7518ba27f2bcSSteven Rostedt (Red Hat) 		/*
7519ba27f2bcSSteven Rostedt (Red Hat) 		 * Check the following for each ops before calling their func:
7520ba27f2bcSSteven Rostedt (Red Hat) 		 *  if RCU flag is set, then rcu_is_watching() must be true
7521ba27f2bcSSteven Rostedt (Red Hat) 		 *  if PER_CPU is set, then ftrace_function_local_disable()
7522ba27f2bcSSteven Rostedt (Red Hat) 		 *                          must be false
7523ba27f2bcSSteven Rostedt (Red Hat) 		 *  Otherwise test if the ip matches the ops filter
7524ba27f2bcSSteven Rostedt (Red Hat) 		 *
7525ba27f2bcSSteven Rostedt (Red Hat) 		 * If any of the above fails then the op->func() is not executed.
7526ba27f2bcSSteven Rostedt (Red Hat) 		 */
7527ba27f2bcSSteven Rostedt (Red Hat) 		if ((!(op->flags & FTRACE_OPS_FL_RCU) || rcu_is_watching()) &&
7528ba27f2bcSSteven Rostedt (Red Hat) 		    ftrace_ops_test(op, ip, regs)) {
75291d48d596SSteven Rostedt (Red Hat) 			if (FTRACE_WARN_ON(!op->func)) {
75301d48d596SSteven Rostedt (Red Hat) 				pr_warn("op=%p %pS\n", op, op);
75314104d326SSteven Rostedt (Red Hat) 				goto out;
75324104d326SSteven Rostedt (Red Hat) 			}
7533d19ad077SSteven Rostedt (VMware) 			op->func(ip, parent_ip, op, fregs);
75344104d326SSteven Rostedt (Red Hat) 		}
75350a016409SSteven Rostedt 	} while_for_each_ftrace_op(op);
75364104d326SSteven Rostedt (Red Hat) out:
7537edc15cafSSteven Rostedt 	trace_clear_recursion(bit);
7538b848914cSSteven Rostedt }
7539b848914cSSteven Rostedt 
75402f5f6ad9SSteven Rostedt /*
75412f5f6ad9SSteven Rostedt  * Some archs only support passing ip and parent_ip. Even though
75422f5f6ad9SSteven Rostedt  * the list function ignores the op parameter, we do not want any
75432f5f6ad9SSteven Rostedt  * C side effects, where a function is called without the caller
75442f5f6ad9SSteven Rostedt  * sending a third parameter.
7545a1e2e31dSSteven Rostedt  * Archs are to support both the regs and ftrace_ops at the same time.
7546a1e2e31dSSteven Rostedt  * If they support ftrace_ops, it is assumed they support regs.
7547a1e2e31dSSteven Rostedt  * If call backs want to use regs, they must either check for regs
754806aeaaeaSMasami Hiramatsu  * being NULL, or CONFIG_DYNAMIC_FTRACE_WITH_REGS.
754906aeaaeaSMasami Hiramatsu  * Note, CONFIG_DYNAMIC_FTRACE_WITH_REGS expects a full regs to be saved.
7550a1e2e31dSSteven Rostedt  * An architecture can pass partial regs with ftrace_ops and still
7551b8ec330aSLi Bin  * set the ARCH_SUPPORTS_FTRACE_OPS.
755234cdd18bSSteven Rostedt (VMware)  *
755334cdd18bSSteven Rostedt (VMware)  * In vmlinux.lds.h, ftrace_ops_list_func() is defined to be
755434cdd18bSSteven Rostedt (VMware)  * arch_ftrace_ops_list_func.
75552f5f6ad9SSteven Rostedt  */
75562f5f6ad9SSteven Rostedt #if ARCH_SUPPORTS_FTRACE_OPS
755734cdd18bSSteven Rostedt (VMware) void arch_ftrace_ops_list_func(unsigned long ip, unsigned long parent_ip,
7558d19ad077SSteven Rostedt (VMware) 			       struct ftrace_ops *op, struct ftrace_regs *fregs)
75592f5f6ad9SSteven Rostedt {
7560d19ad077SSteven Rostedt (VMware) 	__ftrace_ops_list_func(ip, parent_ip, NULL, fregs);
75612f5f6ad9SSteven Rostedt }
75622f5f6ad9SSteven Rostedt #else
756334cdd18bSSteven Rostedt (VMware) void arch_ftrace_ops_list_func(unsigned long ip, unsigned long parent_ip)
75642f5f6ad9SSteven Rostedt {
7565a1e2e31dSSteven Rostedt 	__ftrace_ops_list_func(ip, parent_ip, NULL, NULL);
75662f5f6ad9SSteven Rostedt }
75672f5f6ad9SSteven Rostedt #endif
756834cdd18bSSteven Rostedt (VMware) NOKPROBE_SYMBOL(arch_ftrace_ops_list_func);
75692f5f6ad9SSteven Rostedt 
7570f1ff6348SSteven Rostedt (Red Hat) /*
7571f1ff6348SSteven Rostedt (Red Hat)  * If there's only one function registered but it does not support
7572c68c0fa2SSteven Rostedt (Red Hat)  * recursion, needs RCU protection and/or requires per cpu handling, then
7573c68c0fa2SSteven Rostedt (Red Hat)  * this function will be called by the mcount trampoline.
7574f1ff6348SSteven Rostedt (Red Hat)  */
7575c68c0fa2SSteven Rostedt (Red Hat) static void ftrace_ops_assist_func(unsigned long ip, unsigned long parent_ip,
7576d19ad077SSteven Rostedt (VMware) 				   struct ftrace_ops *op, struct ftrace_regs *fregs)
7577f1ff6348SSteven Rostedt (Red Hat) {
7578f1ff6348SSteven Rostedt (Red Hat) 	int bit;
7579f1ff6348SSteven Rostedt (Red Hat) 
7580ed65df63SSteven Rostedt (VMware) 	bit = trace_test_and_set_recursion(ip, parent_ip, TRACE_LIST_START);
7581f1ff6348SSteven Rostedt (Red Hat) 	if (bit < 0)
7582f1ff6348SSteven Rostedt (Red Hat) 		return;
7583f1ff6348SSteven Rostedt (Red Hat) 
7584b40341faSSteven Rostedt (VMware) 	if (!(op->flags & FTRACE_OPS_FL_RCU) || rcu_is_watching())
7585d19ad077SSteven Rostedt (VMware) 		op->func(ip, parent_ip, op, fregs);
7586c68c0fa2SSteven Rostedt (Red Hat) 
7587f1ff6348SSteven Rostedt (Red Hat) 	trace_clear_recursion(bit);
7588f1ff6348SSteven Rostedt (Red Hat) }
7589fabe38abSMasami Hiramatsu NOKPROBE_SYMBOL(ftrace_ops_assist_func);
7590f1ff6348SSteven Rostedt (Red Hat) 
759187354059SSteven Rostedt (Red Hat) /**
759287354059SSteven Rostedt (Red Hat)  * ftrace_ops_get_func - get the function a trampoline should call
759387354059SSteven Rostedt (Red Hat)  * @ops: the ops to get the function for
759487354059SSteven Rostedt (Red Hat)  *
759587354059SSteven Rostedt (Red Hat)  * Normally the mcount trampoline will call the ops->func, but there
759687354059SSteven Rostedt (Red Hat)  * are times that it should not. For example, if the ops does not
759787354059SSteven Rostedt (Red Hat)  * have its own recursion protection, then it should call the
75983a150df9SChunyu Hu  * ftrace_ops_assist_func() instead.
759987354059SSteven Rostedt (Red Hat)  *
760087354059SSteven Rostedt (Red Hat)  * Returns the function that the trampoline should call for @ops.
760187354059SSteven Rostedt (Red Hat)  */
760287354059SSteven Rostedt (Red Hat) ftrace_func_t ftrace_ops_get_func(struct ftrace_ops *ops)
760387354059SSteven Rostedt (Red Hat) {
760487354059SSteven Rostedt (Red Hat) 	/*
7605a25d036dSSteven Rostedt (VMware) 	 * If the function does not handle recursion or needs to be RCU safe,
7606a25d036dSSteven Rostedt (VMware) 	 * then we need to call the assist handler.
760787354059SSteven Rostedt (Red Hat) 	 */
7608a25d036dSSteven Rostedt (VMware) 	if (ops->flags & (FTRACE_OPS_FL_RECURSION |
7609a25d036dSSteven Rostedt (VMware) 			  FTRACE_OPS_FL_RCU))
7610c68c0fa2SSteven Rostedt (Red Hat) 		return ftrace_ops_assist_func;
761187354059SSteven Rostedt (Red Hat) 
761287354059SSteven Rostedt (Red Hat) 	return ops->func;
761387354059SSteven Rostedt (Red Hat) }
761487354059SSteven Rostedt (Red Hat) 
7615345ddcc8SSteven Rostedt (Red Hat) static void
7616345ddcc8SSteven Rostedt (Red Hat) ftrace_filter_pid_sched_switch_probe(void *data, bool preempt,
7617fa2c3254SValentin Schneider 				     struct task_struct *prev,
76189c2136beSDelyan Kratunov 				     struct task_struct *next,
76199c2136beSDelyan Kratunov 				     unsigned int prev_state)
7620e32d8956SSteven Rostedt {
7621345ddcc8SSteven Rostedt (Red Hat) 	struct trace_array *tr = data;
7622345ddcc8SSteven Rostedt (Red Hat) 	struct trace_pid_list *pid_list;
7623b3b1e6edSSteven Rostedt (VMware) 	struct trace_pid_list *no_pid_list;
7624345ddcc8SSteven Rostedt (Red Hat) 
7625345ddcc8SSteven Rostedt (Red Hat) 	pid_list = rcu_dereference_sched(tr->function_pids);
7626b3b1e6edSSteven Rostedt (VMware) 	no_pid_list = rcu_dereference_sched(tr->function_no_pids);
7627345ddcc8SSteven Rostedt (Red Hat) 
7628b3b1e6edSSteven Rostedt (VMware) 	if (trace_ignore_this_task(pid_list, no_pid_list, next))
76291c5eb448SSteven Rostedt (VMware) 		this_cpu_write(tr->array_buffer.data->ftrace_ignore_pid,
7630717e3f5eSSteven Rostedt (VMware) 			       FTRACE_PID_IGNORE);
7631717e3f5eSSteven Rostedt (VMware) 	else
7632717e3f5eSSteven Rostedt (VMware) 		this_cpu_write(tr->array_buffer.data->ftrace_ignore_pid,
7633717e3f5eSSteven Rostedt (VMware) 			       next->pid);
7634345ddcc8SSteven Rostedt (Red Hat) }
7635345ddcc8SSteven Rostedt (Red Hat) 
76361e10486fSNamhyung Kim static void
76371e10486fSNamhyung Kim ftrace_pid_follow_sched_process_fork(void *data,
76381e10486fSNamhyung Kim 				     struct task_struct *self,
76391e10486fSNamhyung Kim 				     struct task_struct *task)
76401e10486fSNamhyung Kim {
76411e10486fSNamhyung Kim 	struct trace_pid_list *pid_list;
76421e10486fSNamhyung Kim 	struct trace_array *tr = data;
76431e10486fSNamhyung Kim 
76441e10486fSNamhyung Kim 	pid_list = rcu_dereference_sched(tr->function_pids);
76451e10486fSNamhyung Kim 	trace_filter_add_remove_task(pid_list, self, task);
7646b3b1e6edSSteven Rostedt (VMware) 
7647b3b1e6edSSteven Rostedt (VMware) 	pid_list = rcu_dereference_sched(tr->function_no_pids);
7648b3b1e6edSSteven Rostedt (VMware) 	trace_filter_add_remove_task(pid_list, self, task);
76491e10486fSNamhyung Kim }
76501e10486fSNamhyung Kim 
76511e10486fSNamhyung Kim static void
76521e10486fSNamhyung Kim ftrace_pid_follow_sched_process_exit(void *data, struct task_struct *task)
76531e10486fSNamhyung Kim {
76541e10486fSNamhyung Kim 	struct trace_pid_list *pid_list;
76551e10486fSNamhyung Kim 	struct trace_array *tr = data;
76561e10486fSNamhyung Kim 
76571e10486fSNamhyung Kim 	pid_list = rcu_dereference_sched(tr->function_pids);
76581e10486fSNamhyung Kim 	trace_filter_add_remove_task(pid_list, NULL, task);
7659b3b1e6edSSteven Rostedt (VMware) 
7660b3b1e6edSSteven Rostedt (VMware) 	pid_list = rcu_dereference_sched(tr->function_no_pids);
7661b3b1e6edSSteven Rostedt (VMware) 	trace_filter_add_remove_task(pid_list, NULL, task);
76621e10486fSNamhyung Kim }
76631e10486fSNamhyung Kim 
76641e10486fSNamhyung Kim void ftrace_pid_follow_fork(struct trace_array *tr, bool enable)
76651e10486fSNamhyung Kim {
76661e10486fSNamhyung Kim 	if (enable) {
76671e10486fSNamhyung Kim 		register_trace_sched_process_fork(ftrace_pid_follow_sched_process_fork,
76681e10486fSNamhyung Kim 						  tr);
7669afcab636SSteven Rostedt (VMware) 		register_trace_sched_process_free(ftrace_pid_follow_sched_process_exit,
76701e10486fSNamhyung Kim 						  tr);
76711e10486fSNamhyung Kim 	} else {
76721e10486fSNamhyung Kim 		unregister_trace_sched_process_fork(ftrace_pid_follow_sched_process_fork,
76731e10486fSNamhyung Kim 						    tr);
7674afcab636SSteven Rostedt (VMware) 		unregister_trace_sched_process_free(ftrace_pid_follow_sched_process_exit,
76751e10486fSNamhyung Kim 						    tr);
76761e10486fSNamhyung Kim 	}
76771e10486fSNamhyung Kim }
76781e10486fSNamhyung Kim 
7679b3b1e6edSSteven Rostedt (VMware) static void clear_ftrace_pids(struct trace_array *tr, int type)
7680345ddcc8SSteven Rostedt (Red Hat) {
7681345ddcc8SSteven Rostedt (Red Hat) 	struct trace_pid_list *pid_list;
7682b3b1e6edSSteven Rostedt (VMware) 	struct trace_pid_list *no_pid_list;
7683e32d8956SSteven Rostedt 	int cpu;
7684e32d8956SSteven Rostedt 
7685345ddcc8SSteven Rostedt (Red Hat) 	pid_list = rcu_dereference_protected(tr->function_pids,
7686345ddcc8SSteven Rostedt (Red Hat) 					     lockdep_is_held(&ftrace_lock));
7687b3b1e6edSSteven Rostedt (VMware) 	no_pid_list = rcu_dereference_protected(tr->function_no_pids,
7688b3b1e6edSSteven Rostedt (VMware) 						lockdep_is_held(&ftrace_lock));
7689b3b1e6edSSteven Rostedt (VMware) 
7690b3b1e6edSSteven Rostedt (VMware) 	/* Make sure there's something to do */
769127683626SSteven Rostedt (VMware) 	if (!pid_type_enabled(type, pid_list, no_pid_list))
7692345ddcc8SSteven Rostedt (Red Hat) 		return;
7693345ddcc8SSteven Rostedt (Red Hat) 
7694b3b1e6edSSteven Rostedt (VMware) 	/* See if the pids still need to be checked after this */
769527683626SSteven Rostedt (VMware) 	if (!still_need_pid_events(type, pid_list, no_pid_list)) {
7696345ddcc8SSteven Rostedt (Red Hat) 		unregister_trace_sched_switch(ftrace_filter_pid_sched_switch_probe, tr);
7697345ddcc8SSteven Rostedt (Red Hat) 		for_each_possible_cpu(cpu)
7698717e3f5eSSteven Rostedt (VMware) 			per_cpu_ptr(tr->array_buffer.data, cpu)->ftrace_ignore_pid = FTRACE_PID_TRACE;
7699b3b1e6edSSteven Rostedt (VMware) 	}
7700345ddcc8SSteven Rostedt (Red Hat) 
7701b3b1e6edSSteven Rostedt (VMware) 	if (type & TRACE_PIDS)
7702345ddcc8SSteven Rostedt (Red Hat) 		rcu_assign_pointer(tr->function_pids, NULL);
7703345ddcc8SSteven Rostedt (Red Hat) 
7704b3b1e6edSSteven Rostedt (VMware) 	if (type & TRACE_NO_PIDS)
7705b3b1e6edSSteven Rostedt (VMware) 		rcu_assign_pointer(tr->function_no_pids, NULL);
7706b3b1e6edSSteven Rostedt (VMware) 
7707345ddcc8SSteven Rostedt (Red Hat) 	/* Wait till all users are no longer using pid filtering */
770874401729SPaul E. McKenney 	synchronize_rcu();
7709345ddcc8SSteven Rostedt (Red Hat) 
7710b3b1e6edSSteven Rostedt (VMware) 	if ((type & TRACE_PIDS) && pid_list)
77116954e415SSteven Rostedt (VMware) 		trace_pid_list_free(pid_list);
7712b3b1e6edSSteven Rostedt (VMware) 
7713b3b1e6edSSteven Rostedt (VMware) 	if ((type & TRACE_NO_PIDS) && no_pid_list)
77146954e415SSteven Rostedt (VMware) 		trace_pid_list_free(no_pid_list);
7715e32d8956SSteven Rostedt }
7716e32d8956SSteven Rostedt 
7717d879d0b8SNamhyung Kim void ftrace_clear_pids(struct trace_array *tr)
7718d879d0b8SNamhyung Kim {
7719d879d0b8SNamhyung Kim 	mutex_lock(&ftrace_lock);
7720d879d0b8SNamhyung Kim 
7721b3b1e6edSSteven Rostedt (VMware) 	clear_ftrace_pids(tr, TRACE_PIDS | TRACE_NO_PIDS);
7722d879d0b8SNamhyung Kim 
7723d879d0b8SNamhyung Kim 	mutex_unlock(&ftrace_lock);
7724d879d0b8SNamhyung Kim }
7725d879d0b8SNamhyung Kim 
7726b3b1e6edSSteven Rostedt (VMware) static void ftrace_pid_reset(struct trace_array *tr, int type)
7727e32d8956SSteven Rostedt {
7728756d17eeS[email protected] 	mutex_lock(&ftrace_lock);
7729b3b1e6edSSteven Rostedt (VMware) 	clear_ftrace_pids(tr, type);
7730756d17eeS[email protected] 
7731756d17eeS[email protected] 	ftrace_update_pid_func();
7732e1effa01SSteven Rostedt (Red Hat) 	ftrace_startup_all(0);
7733756d17eeS[email protected] 
7734756d17eeS[email protected] 	mutex_unlock(&ftrace_lock);
7735756d17eeS[email protected] }
7736756d17eeS[email protected] 
7737345ddcc8SSteven Rostedt (Red Hat) /* Greater than any max PID */
7738345ddcc8SSteven Rostedt (Red Hat) #define FTRACE_NO_PIDS		(void *)(PID_MAX_LIMIT + 1)
7739345ddcc8SSteven Rostedt (Red Hat) 
7740756d17eeS[email protected] static void *fpid_start(struct seq_file *m, loff_t *pos)
7741345ddcc8SSteven Rostedt (Red Hat) 	__acquires(RCU)
7742756d17eeS[email protected] {
7743345ddcc8SSteven Rostedt (Red Hat) 	struct trace_pid_list *pid_list;
7744345ddcc8SSteven Rostedt (Red Hat) 	struct trace_array *tr = m->private;
7745345ddcc8SSteven Rostedt (Red Hat) 
7746756d17eeS[email protected] 	mutex_lock(&ftrace_lock);
7747345ddcc8SSteven Rostedt (Red Hat) 	rcu_read_lock_sched();
7748756d17eeS[email protected] 
7749345ddcc8SSteven Rostedt (Red Hat) 	pid_list = rcu_dereference_sched(tr->function_pids);
7750756d17eeS[email protected] 
7751345ddcc8SSteven Rostedt (Red Hat) 	if (!pid_list)
7752345ddcc8SSteven Rostedt (Red Hat) 		return !(*pos) ? FTRACE_NO_PIDS : NULL;
7753345ddcc8SSteven Rostedt (Red Hat) 
7754345ddcc8SSteven Rostedt (Red Hat) 	return trace_pid_start(pid_list, pos);
7755756d17eeS[email protected] }
7756756d17eeS[email protected] 
7757756d17eeS[email protected] static void *fpid_next(struct seq_file *m, void *v, loff_t *pos)
7758756d17eeS[email protected] {
7759345ddcc8SSteven Rostedt (Red Hat) 	struct trace_array *tr = m->private;
7760345ddcc8SSteven Rostedt (Red Hat) 	struct trace_pid_list *pid_list = rcu_dereference_sched(tr->function_pids);
7761345ddcc8SSteven Rostedt (Red Hat) 
7762e4075e8bSVasily Averin 	if (v == FTRACE_NO_PIDS) {
7763e4075e8bSVasily Averin 		(*pos)++;
7764756d17eeS[email protected] 		return NULL;
7765e4075e8bSVasily Averin 	}
7766345ddcc8SSteven Rostedt (Red Hat) 	return trace_pid_next(pid_list, v, pos);
7767756d17eeS[email protected] }
7768756d17eeS[email protected] 
7769756d17eeS[email protected] static void fpid_stop(struct seq_file *m, void *p)
7770345ddcc8SSteven Rostedt (Red Hat) 	__releases(RCU)
7771756d17eeS[email protected] {
7772345ddcc8SSteven Rostedt (Red Hat) 	rcu_read_unlock_sched();
7773756d17eeS[email protected] 	mutex_unlock(&ftrace_lock);
7774756d17eeS[email protected] }
7775756d17eeS[email protected] 
7776756d17eeS[email protected] static int fpid_show(struct seq_file *m, void *v)
7777756d17eeS[email protected] {
7778345ddcc8SSteven Rostedt (Red Hat) 	if (v == FTRACE_NO_PIDS) {
7779fa6f0cc7SRasmus Villemoes 		seq_puts(m, "no pid\n");
7780756d17eeS[email protected] 		return 0;
7781756d17eeS[email protected] 	}
7782756d17eeS[email protected] 
7783345ddcc8SSteven Rostedt (Red Hat) 	return trace_pid_show(m, v);
7784756d17eeS[email protected] }
7785756d17eeS[email protected] 
7786756d17eeS[email protected] static const struct seq_operations ftrace_pid_sops = {
7787756d17eeS[email protected] 	.start = fpid_start,
7788756d17eeS[email protected] 	.next = fpid_next,
7789756d17eeS[email protected] 	.stop = fpid_stop,
7790756d17eeS[email protected] 	.show = fpid_show,
7791756d17eeS[email protected] };
7792756d17eeS[email protected] 
7793b3b1e6edSSteven Rostedt (VMware) static void *fnpid_start(struct seq_file *m, loff_t *pos)
7794b3b1e6edSSteven Rostedt (VMware) 	__acquires(RCU)
7795756d17eeS[email protected] {
7796b3b1e6edSSteven Rostedt (VMware) 	struct trace_pid_list *pid_list;
7797b3b1e6edSSteven Rostedt (VMware) 	struct trace_array *tr = m->private;
7798b3b1e6edSSteven Rostedt (VMware) 
7799b3b1e6edSSteven Rostedt (VMware) 	mutex_lock(&ftrace_lock);
7800b3b1e6edSSteven Rostedt (VMware) 	rcu_read_lock_sched();
7801b3b1e6edSSteven Rostedt (VMware) 
7802b3b1e6edSSteven Rostedt (VMware) 	pid_list = rcu_dereference_sched(tr->function_no_pids);
7803b3b1e6edSSteven Rostedt (VMware) 
7804b3b1e6edSSteven Rostedt (VMware) 	if (!pid_list)
7805b3b1e6edSSteven Rostedt (VMware) 		return !(*pos) ? FTRACE_NO_PIDS : NULL;
7806b3b1e6edSSteven Rostedt (VMware) 
7807b3b1e6edSSteven Rostedt (VMware) 	return trace_pid_start(pid_list, pos);
7808b3b1e6edSSteven Rostedt (VMware) }
7809b3b1e6edSSteven Rostedt (VMware) 
7810b3b1e6edSSteven Rostedt (VMware) static void *fnpid_next(struct seq_file *m, void *v, loff_t *pos)
7811b3b1e6edSSteven Rostedt (VMware) {
7812b3b1e6edSSteven Rostedt (VMware) 	struct trace_array *tr = m->private;
7813b3b1e6edSSteven Rostedt (VMware) 	struct trace_pid_list *pid_list = rcu_dereference_sched(tr->function_no_pids);
7814b3b1e6edSSteven Rostedt (VMware) 
7815b3b1e6edSSteven Rostedt (VMware) 	if (v == FTRACE_NO_PIDS) {
7816b3b1e6edSSteven Rostedt (VMware) 		(*pos)++;
7817b3b1e6edSSteven Rostedt (VMware) 		return NULL;
7818b3b1e6edSSteven Rostedt (VMware) 	}
7819b3b1e6edSSteven Rostedt (VMware) 	return trace_pid_next(pid_list, v, pos);
7820b3b1e6edSSteven Rostedt (VMware) }
7821b3b1e6edSSteven Rostedt (VMware) 
7822b3b1e6edSSteven Rostedt (VMware) static const struct seq_operations ftrace_no_pid_sops = {
7823b3b1e6edSSteven Rostedt (VMware) 	.start = fnpid_start,
7824b3b1e6edSSteven Rostedt (VMware) 	.next = fnpid_next,
7825b3b1e6edSSteven Rostedt (VMware) 	.stop = fpid_stop,
7826b3b1e6edSSteven Rostedt (VMware) 	.show = fpid_show,
7827b3b1e6edSSteven Rostedt (VMware) };
7828b3b1e6edSSteven Rostedt (VMware) 
7829b3b1e6edSSteven Rostedt (VMware) static int pid_open(struct inode *inode, struct file *file, int type)
7830b3b1e6edSSteven Rostedt (VMware) {
7831b3b1e6edSSteven Rostedt (VMware) 	const struct seq_operations *seq_ops;
7832345ddcc8SSteven Rostedt (Red Hat) 	struct trace_array *tr = inode->i_private;
7833345ddcc8SSteven Rostedt (Red Hat) 	struct seq_file *m;
7834756d17eeS[email protected] 	int ret = 0;
7835756d17eeS[email protected] 
78368530dec6SSteven Rostedt (VMware) 	ret = tracing_check_open_get_tr(tr);
78378530dec6SSteven Rostedt (VMware) 	if (ret)
78388530dec6SSteven Rostedt (VMware) 		return ret;
7839345ddcc8SSteven Rostedt (Red Hat) 
7840756d17eeS[email protected] 	if ((file->f_mode & FMODE_WRITE) &&
7841756d17eeS[email protected] 	    (file->f_flags & O_TRUNC))
7842b3b1e6edSSteven Rostedt (VMware) 		ftrace_pid_reset(tr, type);
7843756d17eeS[email protected] 
7844b3b1e6edSSteven Rostedt (VMware) 	switch (type) {
7845b3b1e6edSSteven Rostedt (VMware) 	case TRACE_PIDS:
7846b3b1e6edSSteven Rostedt (VMware) 		seq_ops = &ftrace_pid_sops;
7847b3b1e6edSSteven Rostedt (VMware) 		break;
7848b3b1e6edSSteven Rostedt (VMware) 	case TRACE_NO_PIDS:
7849b3b1e6edSSteven Rostedt (VMware) 		seq_ops = &ftrace_no_pid_sops;
7850b3b1e6edSSteven Rostedt (VMware) 		break;
7851026bb845SKaitao Cheng 	default:
7852026bb845SKaitao Cheng 		trace_array_put(tr);
7853026bb845SKaitao Cheng 		WARN_ON_ONCE(1);
7854026bb845SKaitao Cheng 		return -EINVAL;
7855b3b1e6edSSteven Rostedt (VMware) 	}
7856b3b1e6edSSteven Rostedt (VMware) 
7857b3b1e6edSSteven Rostedt (VMware) 	ret = seq_open(file, seq_ops);
7858345ddcc8SSteven Rostedt (Red Hat) 	if (ret < 0) {
7859345ddcc8SSteven Rostedt (Red Hat) 		trace_array_put(tr);
7860345ddcc8SSteven Rostedt (Red Hat) 	} else {
7861345ddcc8SSteven Rostedt (Red Hat) 		m = file->private_data;
7862345ddcc8SSteven Rostedt (Red Hat) 		/* copy tr over to seq ops */
7863345ddcc8SSteven Rostedt (Red Hat) 		m->private = tr;
7864345ddcc8SSteven Rostedt (Red Hat) 	}
7865756d17eeS[email protected] 
7866756d17eeS[email protected] 	return ret;
7867756d17eeS[email protected] }
7868756d17eeS[email protected] 
7869b3b1e6edSSteven Rostedt (VMware) static int
7870b3b1e6edSSteven Rostedt (VMware) ftrace_pid_open(struct inode *inode, struct file *file)
7871b3b1e6edSSteven Rostedt (VMware) {
7872b3b1e6edSSteven Rostedt (VMware) 	return pid_open(inode, file, TRACE_PIDS);
7873b3b1e6edSSteven Rostedt (VMware) }
7874b3b1e6edSSteven Rostedt (VMware) 
7875b3b1e6edSSteven Rostedt (VMware) static int
7876b3b1e6edSSteven Rostedt (VMware) ftrace_no_pid_open(struct inode *inode, struct file *file)
7877b3b1e6edSSteven Rostedt (VMware) {
7878b3b1e6edSSteven Rostedt (VMware) 	return pid_open(inode, file, TRACE_NO_PIDS);
7879b3b1e6edSSteven Rostedt (VMware) }
7880b3b1e6edSSteven Rostedt (VMware) 
7881345ddcc8SSteven Rostedt (Red Hat) static void ignore_task_cpu(void *data)
7882345ddcc8SSteven Rostedt (Red Hat) {
7883345ddcc8SSteven Rostedt (Red Hat) 	struct trace_array *tr = data;
7884345ddcc8SSteven Rostedt (Red Hat) 	struct trace_pid_list *pid_list;
7885b3b1e6edSSteven Rostedt (VMware) 	struct trace_pid_list *no_pid_list;
7886345ddcc8SSteven Rostedt (Red Hat) 
7887345ddcc8SSteven Rostedt (Red Hat) 	/*
7888345ddcc8SSteven Rostedt (Red Hat) 	 * This function is called by on_each_cpu() while the
7889345ddcc8SSteven Rostedt (Red Hat) 	 * event_mutex is held.
7890345ddcc8SSteven Rostedt (Red Hat) 	 */
7891345ddcc8SSteven Rostedt (Red Hat) 	pid_list = rcu_dereference_protected(tr->function_pids,
7892345ddcc8SSteven Rostedt (Red Hat) 					     mutex_is_locked(&ftrace_lock));
7893b3b1e6edSSteven Rostedt (VMware) 	no_pid_list = rcu_dereference_protected(tr->function_no_pids,
7894b3b1e6edSSteven Rostedt (VMware) 						mutex_is_locked(&ftrace_lock));
7895345ddcc8SSteven Rostedt (Red Hat) 
7896b3b1e6edSSteven Rostedt (VMware) 	if (trace_ignore_this_task(pid_list, no_pid_list, current))
78971c5eb448SSteven Rostedt (VMware) 		this_cpu_write(tr->array_buffer.data->ftrace_ignore_pid,
7898717e3f5eSSteven Rostedt (VMware) 			       FTRACE_PID_IGNORE);
7899717e3f5eSSteven Rostedt (VMware) 	else
7900717e3f5eSSteven Rostedt (VMware) 		this_cpu_write(tr->array_buffer.data->ftrace_ignore_pid,
7901717e3f5eSSteven Rostedt (VMware) 			       current->pid);
7902345ddcc8SSteven Rostedt (Red Hat) }
7903345ddcc8SSteven Rostedt (Red Hat) 
7904df4fc315SSteven Rostedt static ssize_t
7905b3b1e6edSSteven Rostedt (VMware) pid_write(struct file *filp, const char __user *ubuf,
7906b3b1e6edSSteven Rostedt (VMware) 	  size_t cnt, loff_t *ppos, int type)
7907df4fc315SSteven Rostedt {
7908345ddcc8SSteven Rostedt (Red Hat) 	struct seq_file *m = filp->private_data;
7909345ddcc8SSteven Rostedt (Red Hat) 	struct trace_array *tr = m->private;
7910b3b1e6edSSteven Rostedt (VMware) 	struct trace_pid_list *filtered_pids;
7911b3b1e6edSSteven Rostedt (VMware) 	struct trace_pid_list *other_pids;
7912345ddcc8SSteven Rostedt (Red Hat) 	struct trace_pid_list *pid_list;
7913345ddcc8SSteven Rostedt (Red Hat) 	ssize_t ret;
7914df4fc315SSteven Rostedt 
7915345ddcc8SSteven Rostedt (Red Hat) 	if (!cnt)
7916345ddcc8SSteven Rostedt (Red Hat) 		return 0;
7917df4fc315SSteven Rostedt 
7918345ddcc8SSteven Rostedt (Red Hat) 	mutex_lock(&ftrace_lock);
7919df4fc315SSteven Rostedt 
7920b3b1e6edSSteven Rostedt (VMware) 	switch (type) {
7921b3b1e6edSSteven Rostedt (VMware) 	case TRACE_PIDS:
7922345ddcc8SSteven Rostedt (Red Hat) 		filtered_pids = rcu_dereference_protected(tr->function_pids,
7923345ddcc8SSteven Rostedt (Red Hat) 					     lockdep_is_held(&ftrace_lock));
7924b3b1e6edSSteven Rostedt (VMware) 		other_pids = rcu_dereference_protected(tr->function_no_pids,
7925b3b1e6edSSteven Rostedt (VMware) 					     lockdep_is_held(&ftrace_lock));
7926b3b1e6edSSteven Rostedt (VMware) 		break;
7927b3b1e6edSSteven Rostedt (VMware) 	case TRACE_NO_PIDS:
7928b3b1e6edSSteven Rostedt (VMware) 		filtered_pids = rcu_dereference_protected(tr->function_no_pids,
7929b3b1e6edSSteven Rostedt (VMware) 					     lockdep_is_held(&ftrace_lock));
7930b3b1e6edSSteven Rostedt (VMware) 		other_pids = rcu_dereference_protected(tr->function_pids,
7931b3b1e6edSSteven Rostedt (VMware) 					     lockdep_is_held(&ftrace_lock));
7932b3b1e6edSSteven Rostedt (VMware) 		break;
7933026bb845SKaitao Cheng 	default:
7934026bb845SKaitao Cheng 		ret = -EINVAL;
7935026bb845SKaitao Cheng 		WARN_ON_ONCE(1);
7936026bb845SKaitao Cheng 		goto out;
7937b3b1e6edSSteven Rostedt (VMware) 	}
7938345ddcc8SSteven Rostedt (Red Hat) 
7939345ddcc8SSteven Rostedt (Red Hat) 	ret = trace_pid_write(filtered_pids, &pid_list, ubuf, cnt);
7940345ddcc8SSteven Rostedt (Red Hat) 	if (ret < 0)
7941345ddcc8SSteven Rostedt (Red Hat) 		goto out;
7942345ddcc8SSteven Rostedt (Red Hat) 
7943b3b1e6edSSteven Rostedt (VMware) 	switch (type) {
7944b3b1e6edSSteven Rostedt (VMware) 	case TRACE_PIDS:
7945345ddcc8SSteven Rostedt (Red Hat) 		rcu_assign_pointer(tr->function_pids, pid_list);
7946b3b1e6edSSteven Rostedt (VMware) 		break;
7947b3b1e6edSSteven Rostedt (VMware) 	case TRACE_NO_PIDS:
7948b3b1e6edSSteven Rostedt (VMware) 		rcu_assign_pointer(tr->function_no_pids, pid_list);
7949b3b1e6edSSteven Rostedt (VMware) 		break;
7950b3b1e6edSSteven Rostedt (VMware) 	}
7951b3b1e6edSSteven Rostedt (VMware) 
7952345ddcc8SSteven Rostedt (Red Hat) 
7953345ddcc8SSteven Rostedt (Red Hat) 	if (filtered_pids) {
795474401729SPaul E. McKenney 		synchronize_rcu();
79556954e415SSteven Rostedt (VMware) 		trace_pid_list_free(filtered_pids);
7956b3b1e6edSSteven Rostedt (VMware) 	} else if (pid_list && !other_pids) {
7957345ddcc8SSteven Rostedt (Red Hat) 		/* Register a probe to set whether to ignore the tracing of a task */
7958345ddcc8SSteven Rostedt (Red Hat) 		register_trace_sched_switch(ftrace_filter_pid_sched_switch_probe, tr);
7959345ddcc8SSteven Rostedt (Red Hat) 	}
7960df4fc315SSteven Rostedt 
7961756d17eeS[email protected] 	/*
7962345ddcc8SSteven Rostedt (Red Hat) 	 * Ignoring of pids is done at task switch. But we have to
7963345ddcc8SSteven Rostedt (Red Hat) 	 * check for those tasks that are currently running.
7964345ddcc8SSteven Rostedt (Red Hat) 	 * Always do this in case a pid was appended or removed.
7965756d17eeS[email protected] 	 */
7966345ddcc8SSteven Rostedt (Red Hat) 	on_each_cpu(ignore_task_cpu, tr, 1);
7967756d17eeS[email protected] 
7968345ddcc8SSteven Rostedt (Red Hat) 	ftrace_update_pid_func();
7969345ddcc8SSteven Rostedt (Red Hat) 	ftrace_startup_all(0);
7970345ddcc8SSteven Rostedt (Red Hat)  out:
7971345ddcc8SSteven Rostedt (Red Hat) 	mutex_unlock(&ftrace_lock);
7972345ddcc8SSteven Rostedt (Red Hat) 
7973345ddcc8SSteven Rostedt (Red Hat) 	if (ret > 0)
7974345ddcc8SSteven Rostedt (Red Hat) 		*ppos += ret;
7975345ddcc8SSteven Rostedt (Red Hat) 
7976df4fc315SSteven Rostedt 	return ret;
7977e32d8956SSteven Rostedt }
7978978f3a45SSteven Rostedt 
7979b3b1e6edSSteven Rostedt (VMware) static ssize_t
7980b3b1e6edSSteven Rostedt (VMware) ftrace_pid_write(struct file *filp, const char __user *ubuf,
7981b3b1e6edSSteven Rostedt (VMware) 		 size_t cnt, loff_t *ppos)
7982b3b1e6edSSteven Rostedt (VMware) {
7983b3b1e6edSSteven Rostedt (VMware) 	return pid_write(filp, ubuf, cnt, ppos, TRACE_PIDS);
7984b3b1e6edSSteven Rostedt (VMware) }
7985b3b1e6edSSteven Rostedt (VMware) 
7986b3b1e6edSSteven Rostedt (VMware) static ssize_t
7987b3b1e6edSSteven Rostedt (VMware) ftrace_no_pid_write(struct file *filp, const char __user *ubuf,
7988b3b1e6edSSteven Rostedt (VMware) 		    size_t cnt, loff_t *ppos)
7989b3b1e6edSSteven Rostedt (VMware) {
7990b3b1e6edSSteven Rostedt (VMware) 	return pid_write(filp, ubuf, cnt, ppos, TRACE_NO_PIDS);
7991b3b1e6edSSteven Rostedt (VMware) }
7992b3b1e6edSSteven Rostedt (VMware) 
7993756d17eeS[email protected] static int
7994756d17eeS[email protected] ftrace_pid_release(struct inode *inode, struct file *file)
7995756d17eeS[email protected] {
7996345ddcc8SSteven Rostedt (Red Hat) 	struct trace_array *tr = inode->i_private;
7997978f3a45SSteven Rostedt 
7998345ddcc8SSteven Rostedt (Red Hat) 	trace_array_put(tr);
7999345ddcc8SSteven Rostedt (Red Hat) 
8000345ddcc8SSteven Rostedt (Red Hat) 	return seq_release(inode, file);
8001df4fc315SSteven Rostedt }
8002df4fc315SSteven Rostedt 
80035e2336a0SSteven Rostedt static const struct file_operations ftrace_pid_fops = {
8004756d17eeS[email protected] 	.open		= ftrace_pid_open,
8005df4fc315SSteven Rostedt 	.write		= ftrace_pid_write,
8006756d17eeS[email protected] 	.read		= seq_read,
8007098c879eSSteven Rostedt (Red Hat) 	.llseek		= tracing_lseek,
8008756d17eeS[email protected] 	.release	= ftrace_pid_release,
8009df4fc315SSteven Rostedt };
8010df4fc315SSteven Rostedt 
8011b3b1e6edSSteven Rostedt (VMware) static const struct file_operations ftrace_no_pid_fops = {
8012b3b1e6edSSteven Rostedt (VMware) 	.open		= ftrace_no_pid_open,
8013b3b1e6edSSteven Rostedt (VMware) 	.write		= ftrace_no_pid_write,
8014b3b1e6edSSteven Rostedt (VMware) 	.read		= seq_read,
8015b3b1e6edSSteven Rostedt (VMware) 	.llseek		= tracing_lseek,
8016b3b1e6edSSteven Rostedt (VMware) 	.release	= ftrace_pid_release,
8017b3b1e6edSSteven Rostedt (VMware) };
8018b3b1e6edSSteven Rostedt (VMware) 
8019345ddcc8SSteven Rostedt (Red Hat) void ftrace_init_tracefs(struct trace_array *tr, struct dentry *d_tracer)
8020df4fc315SSteven Rostedt {
802121ccc9cdSSteven Rostedt (VMware) 	trace_create_file("set_ftrace_pid", TRACE_MODE_WRITE, d_tracer,
8022345ddcc8SSteven Rostedt (Red Hat) 			    tr, &ftrace_pid_fops);
802321ccc9cdSSteven Rostedt (VMware) 	trace_create_file("set_ftrace_notrace_pid", TRACE_MODE_WRITE,
802421ccc9cdSSteven Rostedt (VMware) 			  d_tracer, tr, &ftrace_no_pid_fops);
8025df4fc315SSteven Rostedt }
8026df4fc315SSteven Rostedt 
8027501c2375SSteven Rostedt (Red Hat) void __init ftrace_init_tracefs_toplevel(struct trace_array *tr,
8028501c2375SSteven Rostedt (Red Hat) 					 struct dentry *d_tracer)
8029501c2375SSteven Rostedt (Red Hat) {
8030501c2375SSteven Rostedt (Red Hat) 	/* Only the top level directory has the dyn_tracefs and profile */
8031501c2375SSteven Rostedt (Red Hat) 	WARN_ON(!(tr->flags & TRACE_ARRAY_FL_GLOBAL));
8032501c2375SSteven Rostedt (Red Hat) 
8033501c2375SSteven Rostedt (Red Hat) 	ftrace_init_dyn_tracefs(d_tracer);
8034501c2375SSteven Rostedt (Red Hat) 	ftrace_profile_tracefs(d_tracer);
8035501c2375SSteven Rostedt (Red Hat) }
8036501c2375SSteven Rostedt (Red Hat) 
80373d083395SSteven Rostedt /**
803881adbdc0SSteven Rostedt  * ftrace_kill - kill ftrace
8039a2bb6a3dSSteven Rostedt  *
8040a2bb6a3dSSteven Rostedt  * This function should be used by panic code. It stops ftrace
8041a2bb6a3dSSteven Rostedt  * but in a not so nice way. If you need to simply kill ftrace
8042a2bb6a3dSSteven Rostedt  * from a non-atomic section, use ftrace_kill.
8043a2bb6a3dSSteven Rostedt  */
804481adbdc0SSteven Rostedt void ftrace_kill(void)
8045a2bb6a3dSSteven Rostedt {
8046a2bb6a3dSSteven Rostedt 	ftrace_disabled = 1;
8047a2bb6a3dSSteven Rostedt 	ftrace_enabled = 0;
80485ccba64aSYisheng Xie 	ftrace_trace_function = ftrace_stub;
8049a2bb6a3dSSteven Rostedt }
8050a2bb6a3dSSteven Rostedt 
8051a2bb6a3dSSteven Rostedt /**
80526130722fSSteven Rostedt (VMware)  * ftrace_is_dead - Test if ftrace is dead or not.
80536130722fSSteven Rostedt (VMware)  *
80546130722fSSteven Rostedt (VMware)  * Returns 1 if ftrace is "dead", zero otherwise.
8055e0a413f6SSteven Rostedt  */
8056e0a413f6SSteven Rostedt int ftrace_is_dead(void)
8057e0a413f6SSteven Rostedt {
8058e0a413f6SSteven Rostedt 	return ftrace_disabled;
8059e0a413f6SSteven Rostedt }
8060e0a413f6SSteven Rostedt 
806153cd885bSSong Liu #ifdef CONFIG_DYNAMIC_FTRACE_WITH_DIRECT_CALLS
806253cd885bSSong Liu /*
806353cd885bSSong Liu  * When registering ftrace_ops with IPMODIFY, it is necessary to make sure
806453cd885bSSong Liu  * it doesn't conflict with any direct ftrace_ops. If there is existing
806553cd885bSSong Liu  * direct ftrace_ops on a kernel function being patched, call
806653cd885bSSong Liu  * FTRACE_OPS_CMD_ENABLE_SHARE_IPMODIFY_PEER on it to enable sharing.
806753cd885bSSong Liu  *
806853cd885bSSong Liu  * @ops:     ftrace_ops being registered.
806953cd885bSSong Liu  *
807053cd885bSSong Liu  * Returns:
807153cd885bSSong Liu  *         0 on success;
807253cd885bSSong Liu  *         Negative on failure.
807353cd885bSSong Liu  */
807453cd885bSSong Liu static int prepare_direct_functions_for_ipmodify(struct ftrace_ops *ops)
807553cd885bSSong Liu {
807653cd885bSSong Liu 	struct ftrace_func_entry *entry;
807753cd885bSSong Liu 	struct ftrace_hash *hash;
807853cd885bSSong Liu 	struct ftrace_ops *op;
807953cd885bSSong Liu 	int size, i, ret;
808053cd885bSSong Liu 
808153cd885bSSong Liu 	lockdep_assert_held_once(&direct_mutex);
808253cd885bSSong Liu 
808353cd885bSSong Liu 	if (!(ops->flags & FTRACE_OPS_FL_IPMODIFY))
808453cd885bSSong Liu 		return 0;
808553cd885bSSong Liu 
808653cd885bSSong Liu 	hash = ops->func_hash->filter_hash;
808753cd885bSSong Liu 	size = 1 << hash->size_bits;
808853cd885bSSong Liu 	for (i = 0; i < size; i++) {
808953cd885bSSong Liu 		hlist_for_each_entry(entry, &hash->buckets[i], hlist) {
809053cd885bSSong Liu 			unsigned long ip = entry->ip;
809153cd885bSSong Liu 			bool found_op = false;
809253cd885bSSong Liu 
809353cd885bSSong Liu 			mutex_lock(&ftrace_lock);
809453cd885bSSong Liu 			do_for_each_ftrace_op(op, ftrace_ops_list) {
809553cd885bSSong Liu 				if (!(op->flags & FTRACE_OPS_FL_DIRECT))
809653cd885bSSong Liu 					continue;
809753cd885bSSong Liu 				if (ops_references_ip(op, ip)) {
809853cd885bSSong Liu 					found_op = true;
809953cd885bSSong Liu 					break;
810053cd885bSSong Liu 				}
810153cd885bSSong Liu 			} while_for_each_ftrace_op(op);
810253cd885bSSong Liu 			mutex_unlock(&ftrace_lock);
810353cd885bSSong Liu 
810453cd885bSSong Liu 			if (found_op) {
810553cd885bSSong Liu 				if (!op->ops_func)
810653cd885bSSong Liu 					return -EBUSY;
810753cd885bSSong Liu 
810853cd885bSSong Liu 				ret = op->ops_func(op, FTRACE_OPS_CMD_ENABLE_SHARE_IPMODIFY_PEER);
810953cd885bSSong Liu 				if (ret)
811053cd885bSSong Liu 					return ret;
811153cd885bSSong Liu 			}
811253cd885bSSong Liu 		}
811353cd885bSSong Liu 	}
811453cd885bSSong Liu 
811553cd885bSSong Liu 	return 0;
811653cd885bSSong Liu }
811753cd885bSSong Liu 
811853cd885bSSong Liu /*
811953cd885bSSong Liu  * Similar to prepare_direct_functions_for_ipmodify, clean up after ops
812053cd885bSSong Liu  * with IPMODIFY is unregistered. The cleanup is optional for most DIRECT
812153cd885bSSong Liu  * ops.
812253cd885bSSong Liu  */
812353cd885bSSong Liu static void cleanup_direct_functions_after_ipmodify(struct ftrace_ops *ops)
812453cd885bSSong Liu {
812553cd885bSSong Liu 	struct ftrace_func_entry *entry;
812653cd885bSSong Liu 	struct ftrace_hash *hash;
812753cd885bSSong Liu 	struct ftrace_ops *op;
812853cd885bSSong Liu 	int size, i;
812953cd885bSSong Liu 
813053cd885bSSong Liu 	if (!(ops->flags & FTRACE_OPS_FL_IPMODIFY))
813153cd885bSSong Liu 		return;
813253cd885bSSong Liu 
813353cd885bSSong Liu 	mutex_lock(&direct_mutex);
813453cd885bSSong Liu 
813553cd885bSSong Liu 	hash = ops->func_hash->filter_hash;
813653cd885bSSong Liu 	size = 1 << hash->size_bits;
813753cd885bSSong Liu 	for (i = 0; i < size; i++) {
813853cd885bSSong Liu 		hlist_for_each_entry(entry, &hash->buckets[i], hlist) {
813953cd885bSSong Liu 			unsigned long ip = entry->ip;
814053cd885bSSong Liu 			bool found_op = false;
814153cd885bSSong Liu 
814253cd885bSSong Liu 			mutex_lock(&ftrace_lock);
814353cd885bSSong Liu 			do_for_each_ftrace_op(op, ftrace_ops_list) {
814453cd885bSSong Liu 				if (!(op->flags & FTRACE_OPS_FL_DIRECT))
814553cd885bSSong Liu 					continue;
814653cd885bSSong Liu 				if (ops_references_ip(op, ip)) {
814753cd885bSSong Liu 					found_op = true;
814853cd885bSSong Liu 					break;
814953cd885bSSong Liu 				}
815053cd885bSSong Liu 			} while_for_each_ftrace_op(op);
815153cd885bSSong Liu 			mutex_unlock(&ftrace_lock);
815253cd885bSSong Liu 
815353cd885bSSong Liu 			/* The cleanup is optional, ignore any errors */
815453cd885bSSong Liu 			if (found_op && op->ops_func)
815553cd885bSSong Liu 				op->ops_func(op, FTRACE_OPS_CMD_DISABLE_SHARE_IPMODIFY_PEER);
815653cd885bSSong Liu 		}
815753cd885bSSong Liu 	}
815853cd885bSSong Liu 	mutex_unlock(&direct_mutex);
815953cd885bSSong Liu }
816053cd885bSSong Liu 
816153cd885bSSong Liu #define lock_direct_mutex()	mutex_lock(&direct_mutex)
816253cd885bSSong Liu #define unlock_direct_mutex()	mutex_unlock(&direct_mutex)
816353cd885bSSong Liu 
816453cd885bSSong Liu #else  /* CONFIG_DYNAMIC_FTRACE_WITH_DIRECT_CALLS */
816553cd885bSSong Liu 
816653cd885bSSong Liu static int prepare_direct_functions_for_ipmodify(struct ftrace_ops *ops)
816753cd885bSSong Liu {
816853cd885bSSong Liu 	return 0;
816953cd885bSSong Liu }
817053cd885bSSong Liu 
817153cd885bSSong Liu static void cleanup_direct_functions_after_ipmodify(struct ftrace_ops *ops)
817253cd885bSSong Liu {
817353cd885bSSong Liu }
817453cd885bSSong Liu 
817553cd885bSSong Liu #define lock_direct_mutex()	do { } while (0)
817653cd885bSSong Liu #define unlock_direct_mutex()	do { } while (0)
817753cd885bSSong Liu 
817853cd885bSSong Liu #endif  /* CONFIG_DYNAMIC_FTRACE_WITH_DIRECT_CALLS */
817953cd885bSSong Liu 
818053cd885bSSong Liu /*
818153cd885bSSong Liu  * Similar to register_ftrace_function, except we don't lock direct_mutex.
818253cd885bSSong Liu  */
818353cd885bSSong Liu static int register_ftrace_function_nolock(struct ftrace_ops *ops)
818453cd885bSSong Liu {
818553cd885bSSong Liu 	int ret;
818653cd885bSSong Liu 
818753cd885bSSong Liu 	ftrace_ops_init(ops);
818853cd885bSSong Liu 
818953cd885bSSong Liu 	mutex_lock(&ftrace_lock);
819053cd885bSSong Liu 
819153cd885bSSong Liu 	ret = ftrace_startup(ops, 0);
819253cd885bSSong Liu 
819353cd885bSSong Liu 	mutex_unlock(&ftrace_lock);
819453cd885bSSong Liu 
819553cd885bSSong Liu 	return ret;
819653cd885bSSong Liu }
819753cd885bSSong Liu 
8198e0a413f6SSteven Rostedt /**
81993d083395SSteven Rostedt  * register_ftrace_function - register a function for profiling
820078cbc651SJiapeng Chong  * @ops:	ops structure that holds the function for profiling.
82013d083395SSteven Rostedt  *
82023d083395SSteven Rostedt  * Register a function to be called by all functions in the
82033d083395SSteven Rostedt  * kernel.
82043d083395SSteven Rostedt  *
82053d083395SSteven Rostedt  * Note: @ops->func and all the functions it calls must be labeled
82063d083395SSteven Rostedt  *       with "notrace", otherwise it will go into a
82073d083395SSteven Rostedt  *       recursive loop.
82083d083395SSteven Rostedt  */
82093d083395SSteven Rostedt int register_ftrace_function(struct ftrace_ops *ops)
82103d083395SSteven Rostedt {
82113b1a8f45SColin Ian King 	int ret;
82124eebcc81SSteven Rostedt 
821353cd885bSSong Liu 	lock_direct_mutex();
821453cd885bSSong Liu 	ret = prepare_direct_functions_for_ipmodify(ops);
821553cd885bSSong Liu 	if (ret < 0)
821653cd885bSSong Liu 		goto out_unlock;
8217f04f24fbSMasami Hiramatsu 
821853cd885bSSong Liu 	ret = register_ftrace_function_nolock(ops);
8219e7d3737eSFrederic Weisbecker 
822053cd885bSSong Liu out_unlock:
822153cd885bSSong Liu 	unlock_direct_mutex();
8222b0fc494fSSteven Rostedt 	return ret;
82233d083395SSteven Rostedt }
8224cdbe61bfSSteven Rostedt EXPORT_SYMBOL_GPL(register_ftrace_function);
82253d083395SSteven Rostedt 
82263d083395SSteven Rostedt /**
822732632920SUwe Kleine-Koenig  * unregister_ftrace_function - unregister a function for profiling.
822878cbc651SJiapeng Chong  * @ops:	ops structure that holds the function to unregister
82293d083395SSteven Rostedt  *
82303d083395SSteven Rostedt  * Unregister a function that was added to be called by ftrace profiling.
82313d083395SSteven Rostedt  */
82323d083395SSteven Rostedt int unregister_ftrace_function(struct ftrace_ops *ops)
82333d083395SSteven Rostedt {
82343d083395SSteven Rostedt 	int ret;
82353d083395SSteven Rostedt 
8236e6ea44e9SSteven Rostedt 	mutex_lock(&ftrace_lock);
82378a56d776SSteven Rostedt (Red Hat) 	ret = ftrace_shutdown(ops, 0);
8238e6ea44e9SSteven Rostedt 	mutex_unlock(&ftrace_lock);
8239b0fc494fSSteven Rostedt 
824053cd885bSSong Liu 	cleanup_direct_functions_after_ipmodify(ops);
8241b0fc494fSSteven Rostedt 	return ret;
8242b0fc494fSSteven Rostedt }
8243cdbe61bfSSteven Rostedt EXPORT_SYMBOL_GPL(unregister_ftrace_function);
8244b0fc494fSSteven Rostedt 
8245bed0d9a5SJiri Olsa static int symbols_cmp(const void *a, const void *b)
8246bed0d9a5SJiri Olsa {
8247bed0d9a5SJiri Olsa 	const char **str_a = (const char **) a;
8248bed0d9a5SJiri Olsa 	const char **str_b = (const char **) b;
8249bed0d9a5SJiri Olsa 
8250bed0d9a5SJiri Olsa 	return strcmp(*str_a, *str_b);
8251bed0d9a5SJiri Olsa }
8252bed0d9a5SJiri Olsa 
8253bed0d9a5SJiri Olsa struct kallsyms_data {
8254bed0d9a5SJiri Olsa 	unsigned long *addrs;
8255bed0d9a5SJiri Olsa 	const char **syms;
8256bed0d9a5SJiri Olsa 	size_t cnt;
8257bed0d9a5SJiri Olsa 	size_t found;
8258bed0d9a5SJiri Olsa };
8259bed0d9a5SJiri Olsa 
8260bed0d9a5SJiri Olsa static int kallsyms_callback(void *data, const char *name,
8261bed0d9a5SJiri Olsa 			     struct module *mod, unsigned long addr)
8262bed0d9a5SJiri Olsa {
8263bed0d9a5SJiri Olsa 	struct kallsyms_data *args = data;
8264eb1b2985SJiri Olsa 	const char **sym;
8265eb1b2985SJiri Olsa 	int idx;
8266bed0d9a5SJiri Olsa 
8267eb1b2985SJiri Olsa 	sym = bsearch(&name, args->syms, args->cnt, sizeof(*args->syms), symbols_cmp);
8268eb1b2985SJiri Olsa 	if (!sym)
8269eb1b2985SJiri Olsa 		return 0;
8270eb1b2985SJiri Olsa 
8271eb1b2985SJiri Olsa 	idx = sym - args->syms;
8272eb1b2985SJiri Olsa 	if (args->addrs[idx])
8273bed0d9a5SJiri Olsa 		return 0;
8274bed0d9a5SJiri Olsa 
82759d68c19cSJiri Olsa 	if (!ftrace_location(addr))
8276bed0d9a5SJiri Olsa 		return 0;
8277bed0d9a5SJiri Olsa 
8278eb1b2985SJiri Olsa 	args->addrs[idx] = addr;
8279eb1b2985SJiri Olsa 	args->found++;
8280bed0d9a5SJiri Olsa 	return args->found == args->cnt ? 1 : 0;
8281bed0d9a5SJiri Olsa }
8282bed0d9a5SJiri Olsa 
8283bed0d9a5SJiri Olsa /**
8284bed0d9a5SJiri Olsa  * ftrace_lookup_symbols - Lookup addresses for array of symbols
8285bed0d9a5SJiri Olsa  *
8286bed0d9a5SJiri Olsa  * @sorted_syms: array of symbols pointers symbols to resolve,
8287bed0d9a5SJiri Olsa  * must be alphabetically sorted
8288bed0d9a5SJiri Olsa  * @cnt: number of symbols/addresses in @syms/@addrs arrays
8289bed0d9a5SJiri Olsa  * @addrs: array for storing resulting addresses
8290bed0d9a5SJiri Olsa  *
8291bed0d9a5SJiri Olsa  * This function looks up addresses for array of symbols provided in
8292bed0d9a5SJiri Olsa  * @syms array (must be alphabetically sorted) and stores them in
8293bed0d9a5SJiri Olsa  * @addrs array, which needs to be big enough to store at least @cnt
8294bed0d9a5SJiri Olsa  * addresses.
8295bed0d9a5SJiri Olsa  *
8296bed0d9a5SJiri Olsa  * This function returns 0 if all provided symbols are found,
8297bed0d9a5SJiri Olsa  * -ESRCH otherwise.
8298bed0d9a5SJiri Olsa  */
8299bed0d9a5SJiri Olsa int ftrace_lookup_symbols(const char **sorted_syms, size_t cnt, unsigned long *addrs)
8300bed0d9a5SJiri Olsa {
8301bed0d9a5SJiri Olsa 	struct kallsyms_data args;
8302bed0d9a5SJiri Olsa 	int err;
8303bed0d9a5SJiri Olsa 
8304eb1b2985SJiri Olsa 	memset(addrs, 0, sizeof(*addrs) * cnt);
8305bed0d9a5SJiri Olsa 	args.addrs = addrs;
8306bed0d9a5SJiri Olsa 	args.syms = sorted_syms;
8307bed0d9a5SJiri Olsa 	args.cnt = cnt;
8308bed0d9a5SJiri Olsa 	args.found = 0;
8309bed0d9a5SJiri Olsa 	err = kallsyms_on_each_symbol(kallsyms_callback, &args);
8310bed0d9a5SJiri Olsa 	if (err < 0)
8311bed0d9a5SJiri Olsa 		return err;
8312bed0d9a5SJiri Olsa 	return args.found == args.cnt ? 0 : -ESRCH;
8313bed0d9a5SJiri Olsa }
831444d35720SLinus Torvalds 
83155d79fa0dSYueHaibing #ifdef CONFIG_SYSCTL
83168fd7c214SLuis Chamberlain 
83178fd7c214SLuis Chamberlain #ifdef CONFIG_DYNAMIC_FTRACE
8318f8b7d2b4SLuis Chamberlain static void ftrace_startup_sysctl(void)
8319f8b7d2b4SLuis Chamberlain {
8320f8b7d2b4SLuis Chamberlain 	int command;
8321f8b7d2b4SLuis Chamberlain 
8322f8b7d2b4SLuis Chamberlain 	if (unlikely(ftrace_disabled))
8323f8b7d2b4SLuis Chamberlain 		return;
8324f8b7d2b4SLuis Chamberlain 
8325f8b7d2b4SLuis Chamberlain 	/* Force update next time */
8326f8b7d2b4SLuis Chamberlain 	saved_ftrace_func = NULL;
8327f8b7d2b4SLuis Chamberlain 	/* ftrace_start_up is true if we want ftrace running */
8328f8b7d2b4SLuis Chamberlain 	if (ftrace_start_up) {
8329f8b7d2b4SLuis Chamberlain 		command = FTRACE_UPDATE_CALLS;
8330f8b7d2b4SLuis Chamberlain 		if (ftrace_graph_active)
8331f8b7d2b4SLuis Chamberlain 			command |= FTRACE_START_FUNC_RET;
8332f8b7d2b4SLuis Chamberlain 		ftrace_startup_enable(command);
8333f8b7d2b4SLuis Chamberlain 	}
8334f8b7d2b4SLuis Chamberlain }
8335f8b7d2b4SLuis Chamberlain 
8336f8b7d2b4SLuis Chamberlain static void ftrace_shutdown_sysctl(void)
8337f8b7d2b4SLuis Chamberlain {
8338f8b7d2b4SLuis Chamberlain 	int command;
8339f8b7d2b4SLuis Chamberlain 
8340f8b7d2b4SLuis Chamberlain 	if (unlikely(ftrace_disabled))
8341f8b7d2b4SLuis Chamberlain 		return;
8342f8b7d2b4SLuis Chamberlain 
8343f8b7d2b4SLuis Chamberlain 	/* ftrace_start_up is true if ftrace is running */
8344f8b7d2b4SLuis Chamberlain 	if (ftrace_start_up) {
8345f8b7d2b4SLuis Chamberlain 		command = FTRACE_DISABLE_CALLS;
8346f8b7d2b4SLuis Chamberlain 		if (ftrace_graph_active)
8347f8b7d2b4SLuis Chamberlain 			command |= FTRACE_STOP_FUNC_RET;
8348f8b7d2b4SLuis Chamberlain 		ftrace_run_update_code(command);
8349f8b7d2b4SLuis Chamberlain 	}
8350f8b7d2b4SLuis Chamberlain }
83518fd7c214SLuis Chamberlain #else
83528fd7c214SLuis Chamberlain # define ftrace_startup_sysctl()       do { } while (0)
83538fd7c214SLuis Chamberlain # define ftrace_shutdown_sysctl()      do { } while (0)
83548fd7c214SLuis Chamberlain #endif /* CONFIG_DYNAMIC_FTRACE */
8355f8b7d2b4SLuis Chamberlain 
83567162431dSMiroslav Benes static bool is_permanent_ops_registered(void)
83577162431dSMiroslav Benes {
83587162431dSMiroslav Benes 	struct ftrace_ops *op;
83597162431dSMiroslav Benes 
83607162431dSMiroslav Benes 	do_for_each_ftrace_op(op, ftrace_ops_list) {
83617162431dSMiroslav Benes 		if (op->flags & FTRACE_OPS_FL_PERMANENT)
83627162431dSMiroslav Benes 			return true;
83637162431dSMiroslav Benes 	} while_for_each_ftrace_op(op);
83647162431dSMiroslav Benes 
83657162431dSMiroslav Benes 	return false;
83667162431dSMiroslav Benes }
83677162431dSMiroslav Benes 
83688e4e83b2SWei Xiao static int
8369b0fc494fSSteven Rostedt ftrace_enable_sysctl(struct ctl_table *table, int write,
837054fa9ba5STobias Klauser 		     void *buffer, size_t *lenp, loff_t *ppos)
8371b0fc494fSSteven Rostedt {
837245a4a237SSteven Rostedt 	int ret = -ENODEV;
83734eebcc81SSteven Rostedt 
8374e6ea44e9SSteven Rostedt 	mutex_lock(&ftrace_lock);
8375b0fc494fSSteven Rostedt 
837645a4a237SSteven Rostedt 	if (unlikely(ftrace_disabled))
837745a4a237SSteven Rostedt 		goto out;
837845a4a237SSteven Rostedt 
83798d65af78SAlexey Dobriyan 	ret = proc_dointvec(table, write, buffer, lenp, ppos);
8380b0fc494fSSteven Rostedt 
8381a32c7765SLi Zefan 	if (ret || !write || (last_ftrace_enabled == !!ftrace_enabled))
8382b0fc494fSSteven Rostedt 		goto out;
8383b0fc494fSSteven Rostedt 
8384b0fc494fSSteven Rostedt 	if (ftrace_enabled) {
8385b0fc494fSSteven Rostedt 
8386b0fc494fSSteven Rostedt 		/* we are starting ftrace again */
8387f86f4180SChunyan Zhang 		if (rcu_dereference_protected(ftrace_ops_list,
8388f86f4180SChunyan Zhang 			lockdep_is_held(&ftrace_lock)) != &ftrace_list_end)
83895000c418SJan Kiszka 			update_ftrace_function();
8390b0fc494fSSteven Rostedt 
8391524a3868SSteven Rostedt (Red Hat) 		ftrace_startup_sysctl();
8392524a3868SSteven Rostedt (Red Hat) 
8393b0fc494fSSteven Rostedt 	} else {
83947162431dSMiroslav Benes 		if (is_permanent_ops_registered()) {
83957162431dSMiroslav Benes 			ftrace_enabled = true;
83967162431dSMiroslav Benes 			ret = -EBUSY;
83977162431dSMiroslav Benes 			goto out;
83987162431dSMiroslav Benes 		}
83997162431dSMiroslav Benes 
8400b0fc494fSSteven Rostedt 		/* stopping ftrace calls (just send to ftrace_stub) */
8401b0fc494fSSteven Rostedt 		ftrace_trace_function = ftrace_stub;
8402b0fc494fSSteven Rostedt 
8403b0fc494fSSteven Rostedt 		ftrace_shutdown_sysctl();
8404b0fc494fSSteven Rostedt 	}
8405b0fc494fSSteven Rostedt 
84067162431dSMiroslav Benes 	last_ftrace_enabled = !!ftrace_enabled;
8407b0fc494fSSteven Rostedt  out:
8408e6ea44e9SSteven Rostedt 	mutex_unlock(&ftrace_lock);
84093d083395SSteven Rostedt 	return ret;
841016444a8aSArnaldo Carvalho de Melo }
84118e4e83b2SWei Xiao 
84128e4e83b2SWei Xiao static struct ctl_table ftrace_sysctls[] = {
84138e4e83b2SWei Xiao 	{
84148e4e83b2SWei Xiao 		.procname       = "ftrace_enabled",
84158e4e83b2SWei Xiao 		.data           = &ftrace_enabled,
84168e4e83b2SWei Xiao 		.maxlen         = sizeof(int),
84178e4e83b2SWei Xiao 		.mode           = 0644,
84188e4e83b2SWei Xiao 		.proc_handler   = ftrace_enable_sysctl,
84198e4e83b2SWei Xiao 	},
84208e4e83b2SWei Xiao 	{}
84218e4e83b2SWei Xiao };
84228e4e83b2SWei Xiao 
84238e4e83b2SWei Xiao static int __init ftrace_sysctl_init(void)
84248e4e83b2SWei Xiao {
84258e4e83b2SWei Xiao 	register_sysctl_init("kernel", ftrace_sysctls);
84268e4e83b2SWei Xiao 	return 0;
84278e4e83b2SWei Xiao }
84288e4e83b2SWei Xiao late_initcall(ftrace_sysctl_init);
84298e4e83b2SWei Xiao #endif
8430