xref: /linux-6.15/kernel/trace/ftrace.c (revision df3ec5da)
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 
48e11b521aSSteven Rostedt (Google) /* Flags that do not get reset */
496ce2c04fSSteven Rostedt (Google) #define FTRACE_NOCLEAR_FLAGS	(FTRACE_FL_DISABLED | FTRACE_FL_TOUCHED | \
506ce2c04fSSteven Rostedt (Google) 				 FTRACE_FL_MODIFIED)
51e11b521aSSteven Rostedt (Google) 
52b39181f7SSteven Rostedt (Google) #define FTRACE_INVALID_FUNCTION		"__ftrace_invalid_address__"
53b39181f7SSteven Rostedt (Google) 
546912896eSSteven Rostedt #define FTRACE_WARN_ON(cond)			\
550778d9adSSteven Rostedt 	({					\
560778d9adSSteven Rostedt 		int ___r = cond;		\
570778d9adSSteven Rostedt 		if (WARN_ON(___r))		\
586912896eSSteven Rostedt 			ftrace_kill();		\
590778d9adSSteven Rostedt 		___r;				\
600778d9adSSteven Rostedt 	})
616912896eSSteven Rostedt 
626912896eSSteven Rostedt #define FTRACE_WARN_ON_ONCE(cond)		\
630778d9adSSteven Rostedt 	({					\
640778d9adSSteven Rostedt 		int ___r = cond;		\
650778d9adSSteven Rostedt 		if (WARN_ON_ONCE(___r))		\
666912896eSSteven Rostedt 			ftrace_kill();		\
670778d9adSSteven Rostedt 		___r;				\
680778d9adSSteven Rostedt 	})
696912896eSSteven Rostedt 
708fc0c701SSteven Rostedt /* hash bits for specific function selection */
7133dc9b12SSteven Rostedt #define FTRACE_HASH_DEFAULT_BITS 10
7233dc9b12SSteven Rostedt #define FTRACE_HASH_MAX_BITS 12
738fc0c701SSteven Rostedt 
74f04f24fbSMasami Hiramatsu #ifdef CONFIG_DYNAMIC_FTRACE
7533b7f99cSSteven Rostedt (Red Hat) #define INIT_OPS_HASH(opsname)	\
7633b7f99cSSteven Rostedt (Red Hat) 	.func_hash		= &opsname.local_hash,			\
775fccc755SSteven Rostedt (Google) 	.local_hash.regex_lock	= __MUTEX_INITIALIZER(opsname.local_hash.regex_lock), \
785fccc755SSteven Rostedt (Google) 	.subop_list		= LIST_HEAD_INIT(opsname.subop_list),
79f04f24fbSMasami Hiramatsu #else
8033b7f99cSSteven Rostedt (Red Hat) #define INIT_OPS_HASH(opsname)
81f04f24fbSMasami Hiramatsu #endif
82f04f24fbSMasami Hiramatsu 
83a0572f68SSteven Rostedt (VMware) enum {
84a0572f68SSteven Rostedt (VMware) 	FTRACE_MODIFY_ENABLE_FL		= (1 << 0),
85a0572f68SSteven Rostedt (VMware) 	FTRACE_MODIFY_MAY_SLEEP_FL	= (1 << 1),
86a0572f68SSteven Rostedt (VMware) };
87a0572f68SSteven Rostedt (VMware) 
883306fc4aSSteven Rostedt (VMware) struct ftrace_ops ftrace_list_end __read_mostly = {
892f5f6ad9SSteven Rostedt 	.func		= ftrace_stub,
90a25d036dSSteven Rostedt (VMware) 	.flags		= FTRACE_OPS_FL_STUB,
9133b7f99cSSteven Rostedt (Red Hat) 	INIT_OPS_HASH(ftrace_list_end)
922f5f6ad9SSteven Rostedt };
932f5f6ad9SSteven Rostedt 
944eebcc81SSteven Rostedt /* ftrace_enabled is a method to turn ftrace on or off */
954eebcc81SSteven Rostedt int ftrace_enabled __read_mostly;
965d79fa0dSYueHaibing static int __maybe_unused last_ftrace_enabled;
97b0fc494fSSteven Rostedt 
982f5f6ad9SSteven Rostedt /* Current function tracing op */
992f5f6ad9SSteven Rostedt struct ftrace_ops *function_trace_op __read_mostly = &ftrace_list_end;
100405e1d83SSteven Rostedt (Red Hat) /* What to set function_trace_op to */
101405e1d83SSteven Rostedt (Red Hat) static struct ftrace_ops *set_function_trace_op;
10260a7ecf4SSteven Rostedt 
103*df3ec5daSSteven Rostedt (Google) bool ftrace_pids_enabled(struct ftrace_ops *ops)
104e3eea140SSteven Rostedt (Red Hat) {
105345ddcc8SSteven Rostedt (Red Hat) 	struct trace_array *tr;
106345ddcc8SSteven Rostedt (Red Hat) 
107345ddcc8SSteven Rostedt (Red Hat) 	if (!(ops->flags & FTRACE_OPS_FL_PID) || !ops->private)
108345ddcc8SSteven Rostedt (Red Hat) 		return false;
109345ddcc8SSteven Rostedt (Red Hat) 
110345ddcc8SSteven Rostedt (Red Hat) 	tr = ops->private;
111345ddcc8SSteven Rostedt (Red Hat) 
112b3b1e6edSSteven Rostedt (VMware) 	return tr->function_pids != NULL || tr->function_no_pids != NULL;
113e3eea140SSteven Rostedt (Red Hat) }
114e3eea140SSteven Rostedt (Red Hat) 
115e3eea140SSteven Rostedt (Red Hat) static void ftrace_update_trampoline(struct ftrace_ops *ops);
116e3eea140SSteven Rostedt (Red Hat) 
1174eebcc81SSteven Rostedt /*
1184eebcc81SSteven Rostedt  * ftrace_disabled is set when an anomaly is discovered.
1194eebcc81SSteven Rostedt  * ftrace_disabled is much stronger than ftrace_enabled.
1204eebcc81SSteven Rostedt  */
1214eebcc81SSteven Rostedt static int ftrace_disabled __read_mostly;
1224eebcc81SSteven Rostedt 
1233306fc4aSSteven Rostedt (VMware) DEFINE_MUTEX(ftrace_lock);
124b0fc494fSSteven Rostedt 
1253306fc4aSSteven Rostedt (VMware) struct ftrace_ops __rcu *ftrace_ops_list __read_mostly = &ftrace_list_end;
12616444a8aSArnaldo Carvalho de Melo ftrace_func_t ftrace_trace_function __read_mostly = ftrace_stub;
1273306fc4aSSteven Rostedt (VMware) struct ftrace_ops global_ops;
12816444a8aSArnaldo Carvalho de Melo 
12950c69781SJulia Lawall /* Defined by vmlinux.lds.h see the comment above arch_ftrace_ops_list_func for details */
13034cdd18bSSteven Rostedt (VMware) void ftrace_ops_list_func(unsigned long ip, unsigned long parent_ip,
131d19ad077SSteven Rostedt (VMware) 			  struct ftrace_ops *op, struct ftrace_regs *fregs);
132b848914cSSteven Rostedt 
133cbad0fb2SMark Rutland #ifdef CONFIG_DYNAMIC_FTRACE_WITH_CALL_OPS
134cbad0fb2SMark Rutland /*
135cbad0fb2SMark Rutland  * Stub used to invoke the list ops without requiring a separate trampoline.
136cbad0fb2SMark Rutland  */
137cbad0fb2SMark Rutland const struct ftrace_ops ftrace_list_ops = {
138cbad0fb2SMark Rutland 	.func	= ftrace_ops_list_func,
139cbad0fb2SMark Rutland 	.flags	= FTRACE_OPS_FL_STUB,
140cbad0fb2SMark Rutland };
141cbad0fb2SMark Rutland 
142cbad0fb2SMark Rutland static void ftrace_ops_nop_func(unsigned long ip, unsigned long parent_ip,
143cbad0fb2SMark Rutland 				struct ftrace_ops *op,
144cbad0fb2SMark Rutland 				struct ftrace_regs *fregs)
145cbad0fb2SMark Rutland {
146cbad0fb2SMark Rutland 	/* do nothing */
147cbad0fb2SMark Rutland }
148cbad0fb2SMark Rutland 
149cbad0fb2SMark Rutland /*
150cbad0fb2SMark Rutland  * Stub used when a call site is disabled. May be called transiently by threads
151cbad0fb2SMark Rutland  * which have made it into ftrace_caller but haven't yet recovered the ops at
152cbad0fb2SMark Rutland  * the point the call site is disabled.
153cbad0fb2SMark Rutland  */
154cbad0fb2SMark Rutland const struct ftrace_ops ftrace_nop_ops = {
155cbad0fb2SMark Rutland 	.func	= ftrace_ops_nop_func,
156cbad0fb2SMark Rutland 	.flags  = FTRACE_OPS_FL_STUB,
157cbad0fb2SMark Rutland };
158cbad0fb2SMark Rutland #endif
159cbad0fb2SMark Rutland 
160f04f24fbSMasami Hiramatsu static inline void ftrace_ops_init(struct ftrace_ops *ops)
161f04f24fbSMasami Hiramatsu {
162f04f24fbSMasami Hiramatsu #ifdef CONFIG_DYNAMIC_FTRACE
163f04f24fbSMasami Hiramatsu 	if (!(ops->flags & FTRACE_OPS_FL_INITIALIZED)) {
16433b7f99cSSteven Rostedt (Red Hat) 		mutex_init(&ops->local_hash.regex_lock);
1655fccc755SSteven Rostedt (Google) 		INIT_LIST_HEAD(&ops->subop_list);
16633b7f99cSSteven Rostedt (Red Hat) 		ops->func_hash = &ops->local_hash;
167f04f24fbSMasami Hiramatsu 		ops->flags |= FTRACE_OPS_FL_INITIALIZED;
168f04f24fbSMasami Hiramatsu 	}
169f04f24fbSMasami Hiramatsu #endif
170f04f24fbSMasami Hiramatsu }
171f04f24fbSMasami Hiramatsu 
1722f5f6ad9SSteven Rostedt static void ftrace_pid_func(unsigned long ip, unsigned long parent_ip,
173d19ad077SSteven Rostedt (VMware) 			    struct ftrace_ops *op, struct ftrace_regs *fregs)
174df4fc315SSteven Rostedt {
175345ddcc8SSteven Rostedt (Red Hat) 	struct trace_array *tr = op->private;
176717e3f5eSSteven Rostedt (VMware) 	int pid;
177345ddcc8SSteven Rostedt (Red Hat) 
178717e3f5eSSteven Rostedt (VMware) 	if (tr) {
179717e3f5eSSteven Rostedt (VMware) 		pid = this_cpu_read(tr->array_buffer.data->ftrace_ignore_pid);
180717e3f5eSSteven Rostedt (VMware) 		if (pid == FTRACE_PID_IGNORE)
181df4fc315SSteven Rostedt 			return;
182717e3f5eSSteven Rostedt (VMware) 		if (pid != FTRACE_PID_TRACE &&
183717e3f5eSSteven Rostedt (VMware) 		    pid != current->pid)
184717e3f5eSSteven Rostedt (VMware) 			return;
185717e3f5eSSteven Rostedt (VMware) 	}
186df4fc315SSteven Rostedt 
187d19ad077SSteven Rostedt (VMware) 	op->saved_func(ip, parent_ip, op, fregs);
188df4fc315SSteven Rostedt }
189df4fc315SSteven Rostedt 
190405e1d83SSteven Rostedt (Red Hat) static void ftrace_sync_ipi(void *data)
191405e1d83SSteven Rostedt (Red Hat) {
192405e1d83SSteven Rostedt (Red Hat) 	/* Probably not needed, but do it anyway */
193405e1d83SSteven Rostedt (Red Hat) 	smp_rmb();
194405e1d83SSteven Rostedt (Red Hat) }
195405e1d83SSteven Rostedt (Red Hat) 
19600ccbf2fSSteven Rostedt (Red Hat) static ftrace_func_t ftrace_ops_get_list_func(struct ftrace_ops *ops)
19700ccbf2fSSteven Rostedt (Red Hat) {
19800ccbf2fSSteven Rostedt (Red Hat) 	/*
19978a01febSZheng Yejian 	 * If this is a dynamic or RCU ops, or we force list func,
20000ccbf2fSSteven Rostedt (Red Hat) 	 * then it needs to call the list anyway.
20100ccbf2fSSteven Rostedt (Red Hat) 	 */
202b3a88803SPeter Zijlstra 	if (ops->flags & (FTRACE_OPS_FL_DYNAMIC | FTRACE_OPS_FL_RCU) ||
203b3a88803SPeter Zijlstra 	    FTRACE_FORCE_LIST_FUNC)
20400ccbf2fSSteven Rostedt (Red Hat) 		return ftrace_ops_list_func;
20500ccbf2fSSteven Rostedt (Red Hat) 
20600ccbf2fSSteven Rostedt (Red Hat) 	return ftrace_ops_get_func(ops);
20700ccbf2fSSteven Rostedt (Red Hat) }
20800ccbf2fSSteven Rostedt (Red Hat) 
2092b499381SSteven Rostedt static void update_ftrace_function(void)
2102b499381SSteven Rostedt {
2112b499381SSteven Rostedt 	ftrace_func_t func;
2122b499381SSteven Rostedt 
213cdbe61bfSSteven Rostedt 	/*
214f7aad4e1SSteven Rostedt (Red Hat) 	 * Prepare the ftrace_ops that the arch callback will use.
215f7aad4e1SSteven Rostedt (Red Hat) 	 * If there's only one ftrace_ops registered, the ftrace_ops_list
216f7aad4e1SSteven Rostedt (Red Hat) 	 * will point to the ops we want.
217f7aad4e1SSteven Rostedt (Red Hat) 	 */
218f86f4180SChunyan Zhang 	set_function_trace_op = rcu_dereference_protected(ftrace_ops_list,
219f86f4180SChunyan Zhang 						lockdep_is_held(&ftrace_lock));
220f7aad4e1SSteven Rostedt (Red Hat) 
221f7aad4e1SSteven Rostedt (Red Hat) 	/* If there's no ftrace_ops registered, just call the stub function */
222f86f4180SChunyan Zhang 	if (set_function_trace_op == &ftrace_list_end) {
223f7aad4e1SSteven Rostedt (Red Hat) 		func = ftrace_stub;
224f7aad4e1SSteven Rostedt (Red Hat) 
225f7aad4e1SSteven Rostedt (Red Hat) 	/*
226cdbe61bfSSteven Rostedt 	 * If we are at the end of the list and this ops is
2274740974aSSteven Rostedt 	 * recursion safe and not dynamic and the arch supports passing ops,
2284740974aSSteven Rostedt 	 * then have the mcount trampoline call the function directly.
229cdbe61bfSSteven Rostedt 	 */
230f86f4180SChunyan Zhang 	} else if (rcu_dereference_protected(ftrace_ops_list->next,
231f86f4180SChunyan Zhang 			lockdep_is_held(&ftrace_lock)) == &ftrace_list_end) {
23200ccbf2fSSteven Rostedt (Red Hat) 		func = ftrace_ops_get_list_func(ftrace_ops_list);
233f7aad4e1SSteven Rostedt (Red Hat) 
2342f5f6ad9SSteven Rostedt 	} else {
2352f5f6ad9SSteven Rostedt 		/* Just use the default ftrace_ops */
236405e1d83SSteven Rostedt (Red Hat) 		set_function_trace_op = &ftrace_list_end;
237b848914cSSteven Rostedt 		func = ftrace_ops_list_func;
2382f5f6ad9SSteven Rostedt 	}
2392b499381SSteven Rostedt 
240405e1d83SSteven Rostedt (Red Hat) 	/* If there's no change, then do nothing more here */
241405e1d83SSteven Rostedt (Red Hat) 	if (ftrace_trace_function == func)
242405e1d83SSteven Rostedt (Red Hat) 		return;
243405e1d83SSteven Rostedt (Red Hat) 
244405e1d83SSteven Rostedt (Red Hat) 	/*
245405e1d83SSteven Rostedt (Red Hat) 	 * If we are using the list function, it doesn't care
246405e1d83SSteven Rostedt (Red Hat) 	 * about the function_trace_ops.
247405e1d83SSteven Rostedt (Red Hat) 	 */
248405e1d83SSteven Rostedt (Red Hat) 	if (func == ftrace_ops_list_func) {
249405e1d83SSteven Rostedt (Red Hat) 		ftrace_trace_function = func;
250405e1d83SSteven Rostedt (Red Hat) 		/*
251405e1d83SSteven Rostedt (Red Hat) 		 * Don't even bother setting function_trace_ops,
252405e1d83SSteven Rostedt (Red Hat) 		 * it would be racy to do so anyway.
253405e1d83SSteven Rostedt (Red Hat) 		 */
254405e1d83SSteven Rostedt (Red Hat) 		return;
255405e1d83SSteven Rostedt (Red Hat) 	}
256405e1d83SSteven Rostedt (Red Hat) 
257405e1d83SSteven Rostedt (Red Hat) #ifndef CONFIG_DYNAMIC_FTRACE
258405e1d83SSteven Rostedt (Red Hat) 	/*
259405e1d83SSteven Rostedt (Red Hat) 	 * For static tracing, we need to be a bit more careful.
260405e1d83SSteven Rostedt (Red Hat) 	 * The function change takes affect immediately. Thus,
261fdda88d3SQiujun Huang 	 * we need to coordinate the setting of the function_trace_ops
262405e1d83SSteven Rostedt (Red Hat) 	 * with the setting of the ftrace_trace_function.
263405e1d83SSteven Rostedt (Red Hat) 	 *
264405e1d83SSteven Rostedt (Red Hat) 	 * Set the function to the list ops, which will call the
265405e1d83SSteven Rostedt (Red Hat) 	 * function we want, albeit indirectly, but it handles the
266405e1d83SSteven Rostedt (Red Hat) 	 * ftrace_ops and doesn't depend on function_trace_op.
267405e1d83SSteven Rostedt (Red Hat) 	 */
268405e1d83SSteven Rostedt (Red Hat) 	ftrace_trace_function = ftrace_ops_list_func;
269405e1d83SSteven Rostedt (Red Hat) 	/*
270405e1d83SSteven Rostedt (Red Hat) 	 * Make sure all CPUs see this. Yes this is slow, but static
271405e1d83SSteven Rostedt (Red Hat) 	 * tracing is slow and nasty to have enabled.
272405e1d83SSteven Rostedt (Red Hat) 	 */
273e5a971d7SPaul E. McKenney 	synchronize_rcu_tasks_rude();
274405e1d83SSteven Rostedt (Red Hat) 	/* Now all cpus are using the list ops. */
275405e1d83SSteven Rostedt (Red Hat) 	function_trace_op = set_function_trace_op;
276405e1d83SSteven Rostedt (Red Hat) 	/* Make sure the function_trace_op is visible on all CPUs */
277405e1d83SSteven Rostedt (Red Hat) 	smp_wmb();
278405e1d83SSteven Rostedt (Red Hat) 	/* Nasty way to force a rmb on all cpus */
279405e1d83SSteven Rostedt (Red Hat) 	smp_call_function(ftrace_sync_ipi, NULL, 1);
280405e1d83SSteven Rostedt (Red Hat) 	/* OK, we are all set to update the ftrace_trace_function now! */
281405e1d83SSteven Rostedt (Red Hat) #endif /* !CONFIG_DYNAMIC_FTRACE */
282405e1d83SSteven Rostedt (Red Hat) 
283491d0dcfSSteven Rostedt 	ftrace_trace_function = func;
284491d0dcfSSteven Rostedt }
285491d0dcfSSteven Rostedt 
286f86f4180SChunyan Zhang static void add_ftrace_ops(struct ftrace_ops __rcu **list,
287f86f4180SChunyan Zhang 			   struct ftrace_ops *ops)
2883d083395SSteven Rostedt {
289f86f4180SChunyan Zhang 	rcu_assign_pointer(ops->next, *list);
290f86f4180SChunyan Zhang 
29116444a8aSArnaldo Carvalho de Melo 	/*
292b848914cSSteven Rostedt 	 * We are entering ops into the list but another
29316444a8aSArnaldo Carvalho de Melo 	 * CPU might be walking that list. We need to make sure
29416444a8aSArnaldo Carvalho de Melo 	 * the ops->next pointer is valid before another CPU sees
295b848914cSSteven Rostedt 	 * the ops pointer included into the list.
29616444a8aSArnaldo Carvalho de Melo 	 */
2972b499381SSteven Rostedt 	rcu_assign_pointer(*list, ops);
2982b499381SSteven Rostedt }
2993d083395SSteven Rostedt 
300f86f4180SChunyan Zhang static int remove_ftrace_ops(struct ftrace_ops __rcu **list,
301f86f4180SChunyan Zhang 			     struct ftrace_ops *ops)
3022b499381SSteven Rostedt {
3032b499381SSteven Rostedt 	struct ftrace_ops **p;
3042b499381SSteven Rostedt 
3052b499381SSteven Rostedt 	/*
3062b499381SSteven Rostedt 	 * If we are removing the last function, then simply point
3072b499381SSteven Rostedt 	 * to the ftrace_stub.
3082b499381SSteven Rostedt 	 */
309f86f4180SChunyan Zhang 	if (rcu_dereference_protected(*list,
310f86f4180SChunyan Zhang 			lockdep_is_held(&ftrace_lock)) == ops &&
311f86f4180SChunyan Zhang 	    rcu_dereference_protected(ops->next,
312f86f4180SChunyan Zhang 			lockdep_is_held(&ftrace_lock)) == &ftrace_list_end) {
3132b499381SSteven Rostedt 		*list = &ftrace_list_end;
3142b499381SSteven Rostedt 		return 0;
3152b499381SSteven Rostedt 	}
3162b499381SSteven Rostedt 
3172b499381SSteven Rostedt 	for (p = list; *p != &ftrace_list_end; p = &(*p)->next)
3182b499381SSteven Rostedt 		if (*p == ops)
3192b499381SSteven Rostedt 			break;
3202b499381SSteven Rostedt 
3212b499381SSteven Rostedt 	if (*p != ops)
3222b499381SSteven Rostedt 		return -1;
3232b499381SSteven Rostedt 
3242b499381SSteven Rostedt 	*p = (*p)->next;
3252b499381SSteven Rostedt 	return 0;
3262b499381SSteven Rostedt }
3272b499381SSteven Rostedt 
328f3bea491SSteven Rostedt (Red Hat) static void ftrace_update_trampoline(struct ftrace_ops *ops);
329f3bea491SSteven Rostedt (Red Hat) 
3303306fc4aSSteven Rostedt (VMware) int __register_ftrace_function(struct ftrace_ops *ops)
3312b499381SSteven Rostedt {
332591dffdaSSteven Rostedt (Red Hat) 	if (ops->flags & FTRACE_OPS_FL_DELETED)
333591dffdaSSteven Rostedt (Red Hat) 		return -EINVAL;
334591dffdaSSteven Rostedt (Red Hat) 
335b848914cSSteven Rostedt 	if (WARN_ON(ops->flags & FTRACE_OPS_FL_ENABLED))
336b848914cSSteven Rostedt 		return -EBUSY;
337b848914cSSteven Rostedt 
33806aeaaeaSMasami Hiramatsu #ifndef CONFIG_DYNAMIC_FTRACE_WITH_REGS
33908f6fba5SSteven Rostedt 	/*
34008f6fba5SSteven Rostedt 	 * If the ftrace_ops specifies SAVE_REGS, then it only can be used
34108f6fba5SSteven Rostedt 	 * if the arch supports it, or SAVE_REGS_IF_SUPPORTED is also set.
34208f6fba5SSteven Rostedt 	 * Setting SAVE_REGS_IF_SUPPORTED makes SAVE_REGS irrelevant.
34308f6fba5SSteven Rostedt 	 */
34408f6fba5SSteven Rostedt 	if (ops->flags & FTRACE_OPS_FL_SAVE_REGS &&
34508f6fba5SSteven Rostedt 	    !(ops->flags & FTRACE_OPS_FL_SAVE_REGS_IF_SUPPORTED))
34608f6fba5SSteven Rostedt 		return -EINVAL;
34708f6fba5SSteven Rostedt 
34808f6fba5SSteven Rostedt 	if (ops->flags & FTRACE_OPS_FL_SAVE_REGS_IF_SUPPORTED)
34908f6fba5SSteven Rostedt 		ops->flags |= FTRACE_OPS_FL_SAVE_REGS;
35008f6fba5SSteven Rostedt #endif
3517162431dSMiroslav Benes 	if (!ftrace_enabled && (ops->flags & FTRACE_OPS_FL_PERMANENT))
3527162431dSMiroslav Benes 		return -EBUSY;
35308f6fba5SSteven Rostedt 
354a20deb3aSKefeng Wang 	if (!is_kernel_core_data((unsigned long)ops))
355cdbe61bfSSteven Rostedt 		ops->flags |= FTRACE_OPS_FL_DYNAMIC;
356cdbe61bfSSteven Rostedt 
357b848914cSSteven Rostedt 	add_ftrace_ops(&ftrace_ops_list, ops);
358b848914cSSteven Rostedt 
359e3eea140SSteven Rostedt (Red Hat) 	/* Always save the function, and reset at unregistering */
360e3eea140SSteven Rostedt (Red Hat) 	ops->saved_func = ops->func;
361e3eea140SSteven Rostedt (Red Hat) 
362345ddcc8SSteven Rostedt (Red Hat) 	if (ftrace_pids_enabled(ops))
363e3eea140SSteven Rostedt (Red Hat) 		ops->func = ftrace_pid_func;
364e3eea140SSteven Rostedt (Red Hat) 
365f3bea491SSteven Rostedt (Red Hat) 	ftrace_update_trampoline(ops);
366f3bea491SSteven Rostedt (Red Hat) 
367491d0dcfSSteven Rostedt 	if (ftrace_enabled)
368491d0dcfSSteven Rostedt 		update_ftrace_function();
3693d083395SSteven Rostedt 
37016444a8aSArnaldo Carvalho de Melo 	return 0;
37116444a8aSArnaldo Carvalho de Melo }
37216444a8aSArnaldo Carvalho de Melo 
3733306fc4aSSteven Rostedt (VMware) int __unregister_ftrace_function(struct ftrace_ops *ops)
37416444a8aSArnaldo Carvalho de Melo {
3752b499381SSteven Rostedt 	int ret;
37616444a8aSArnaldo Carvalho de Melo 
377b848914cSSteven Rostedt 	if (WARN_ON(!(ops->flags & FTRACE_OPS_FL_ENABLED)))
378b848914cSSteven Rostedt 		return -EBUSY;
379b848914cSSteven Rostedt 
380b848914cSSteven Rostedt 	ret = remove_ftrace_ops(&ftrace_ops_list, ops);
381b848914cSSteven Rostedt 
3822b499381SSteven Rostedt 	if (ret < 0)
3832b499381SSteven Rostedt 		return ret;
384b848914cSSteven Rostedt 
385491d0dcfSSteven Rostedt 	if (ftrace_enabled)
386491d0dcfSSteven Rostedt 		update_ftrace_function();
38716444a8aSArnaldo Carvalho de Melo 
388e3eea140SSteven Rostedt (Red Hat) 	ops->func = ops->saved_func;
389e3eea140SSteven Rostedt (Red Hat) 
390e6ea44e9SSteven Rostedt 	return 0;
3913d083395SSteven Rostedt }
3923d083395SSteven Rostedt 
393df4fc315SSteven Rostedt static void ftrace_update_pid_func(void)
394df4fc315SSteven Rostedt {
395e3eea140SSteven Rostedt (Red Hat) 	struct ftrace_ops *op;
396e3eea140SSteven Rostedt (Red Hat) 
397491d0dcfSSteven Rostedt 	/* Only do something if we are tracing something */
398df4fc315SSteven Rostedt 	if (ftrace_trace_function == ftrace_stub)
39910dd3ebeSKOSAKI Motohiro 		return;
400df4fc315SSteven Rostedt 
401e3eea140SSteven Rostedt (Red Hat) 	do_for_each_ftrace_op(op, ftrace_ops_list) {
402e3eea140SSteven Rostedt (Red Hat) 		if (op->flags & FTRACE_OPS_FL_PID) {
403345ddcc8SSteven Rostedt (Red Hat) 			op->func = ftrace_pids_enabled(op) ?
404345ddcc8SSteven Rostedt (Red Hat) 				ftrace_pid_func : op->saved_func;
405e3eea140SSteven Rostedt (Red Hat) 		}
406e3eea140SSteven Rostedt (Red Hat) 	} while_for_each_ftrace_op(op);
407e3eea140SSteven Rostedt (Red Hat) 
408*df3ec5daSSteven Rostedt (Google) 	fgraph_update_pid_func();
409*df3ec5daSSteven Rostedt (Google) 
410491d0dcfSSteven Rostedt 	update_ftrace_function();
411df4fc315SSteven Rostedt }
412df4fc315SSteven Rostedt 
413493762fcSSteven Rostedt #ifdef CONFIG_FUNCTION_PROFILER
414493762fcSSteven Rostedt struct ftrace_profile {
415493762fcSSteven Rostedt 	struct hlist_node		node;
416493762fcSSteven Rostedt 	unsigned long			ip;
417493762fcSSteven Rostedt 	unsigned long			counter;
4180706f1c4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
4190706f1c4SSteven Rostedt 	unsigned long long		time;
420e330b3bcSChase Douglas 	unsigned long long		time_squared;
4210706f1c4SSteven Rostedt #endif
422493762fcSSteven Rostedt };
423493762fcSSteven Rostedt 
424493762fcSSteven Rostedt struct ftrace_profile_page {
425493762fcSSteven Rostedt 	struct ftrace_profile_page	*next;
426493762fcSSteven Rostedt 	unsigned long			index;
427493762fcSSteven Rostedt 	struct ftrace_profile		records[];
428493762fcSSteven Rostedt };
429493762fcSSteven Rostedt 
430cafb168aSSteven Rostedt struct ftrace_profile_stat {
431cafb168aSSteven Rostedt 	atomic_t			disabled;
432cafb168aSSteven Rostedt 	struct hlist_head		*hash;
433cafb168aSSteven Rostedt 	struct ftrace_profile_page	*pages;
434cafb168aSSteven Rostedt 	struct ftrace_profile_page	*start;
435cafb168aSSteven Rostedt 	struct tracer_stat		stat;
436cafb168aSSteven Rostedt };
437cafb168aSSteven Rostedt 
438493762fcSSteven Rostedt #define PROFILE_RECORDS_SIZE						\
439493762fcSSteven Rostedt 	(PAGE_SIZE - offsetof(struct ftrace_profile_page, records))
440493762fcSSteven Rostedt 
441493762fcSSteven Rostedt #define PROFILES_PER_PAGE					\
442493762fcSSteven Rostedt 	(PROFILE_RECORDS_SIZE / sizeof(struct ftrace_profile))
443493762fcSSteven Rostedt 
444fb9fb015SSteven Rostedt static int ftrace_profile_enabled __read_mostly;
445fb9fb015SSteven Rostedt 
446fb9fb015SSteven Rostedt /* ftrace_profile_lock - synchronize the enable and disable of the profiler */
447493762fcSSteven Rostedt static DEFINE_MUTEX(ftrace_profile_lock);
448493762fcSSteven Rostedt 
449cafb168aSSteven Rostedt static DEFINE_PER_CPU(struct ftrace_profile_stat, ftrace_profile_stats);
450493762fcSSteven Rostedt 
45120079ebeSNamhyung Kim #define FTRACE_PROFILE_HASH_BITS 10
45220079ebeSNamhyung Kim #define FTRACE_PROFILE_HASH_SIZE (1 << FTRACE_PROFILE_HASH_BITS)
453493762fcSSteven Rostedt 
454493762fcSSteven Rostedt static void *
455493762fcSSteven Rostedt function_stat_next(void *v, int idx)
456493762fcSSteven Rostedt {
457493762fcSSteven Rostedt 	struct ftrace_profile *rec = v;
458493762fcSSteven Rostedt 	struct ftrace_profile_page *pg;
459493762fcSSteven Rostedt 
460493762fcSSteven Rostedt 	pg = (struct ftrace_profile_page *)((unsigned long)rec & PAGE_MASK);
461493762fcSSteven Rostedt 
462493762fcSSteven Rostedt  again:
4630296e425SLi Zefan 	if (idx != 0)
464493762fcSSteven Rostedt 		rec++;
4650296e425SLi Zefan 
466493762fcSSteven Rostedt 	if ((void *)rec >= (void *)&pg->records[pg->index]) {
467493762fcSSteven Rostedt 		pg = pg->next;
468493762fcSSteven Rostedt 		if (!pg)
469493762fcSSteven Rostedt 			return NULL;
470493762fcSSteven Rostedt 		rec = &pg->records[0];
471493762fcSSteven Rostedt 		if (!rec->counter)
472493762fcSSteven Rostedt 			goto again;
473493762fcSSteven Rostedt 	}
474493762fcSSteven Rostedt 
475493762fcSSteven Rostedt 	return rec;
476493762fcSSteven Rostedt }
477493762fcSSteven Rostedt 
478493762fcSSteven Rostedt static void *function_stat_start(struct tracer_stat *trace)
479493762fcSSteven Rostedt {
480cafb168aSSteven Rostedt 	struct ftrace_profile_stat *stat =
481cafb168aSSteven Rostedt 		container_of(trace, struct ftrace_profile_stat, stat);
482cafb168aSSteven Rostedt 
483cafb168aSSteven Rostedt 	if (!stat || !stat->start)
484cafb168aSSteven Rostedt 		return NULL;
485cafb168aSSteven Rostedt 
486cafb168aSSteven Rostedt 	return function_stat_next(&stat->start->records[0], 0);
487493762fcSSteven Rostedt }
488493762fcSSteven Rostedt 
4890706f1c4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
4900706f1c4SSteven Rostedt /* function graph compares on total time */
49180042c8fSAndy Shevchenko static int function_stat_cmp(const void *p1, const void *p2)
4920706f1c4SSteven Rostedt {
49380042c8fSAndy Shevchenko 	const struct ftrace_profile *a = p1;
49480042c8fSAndy Shevchenko 	const struct ftrace_profile *b = p2;
4950706f1c4SSteven Rostedt 
4960706f1c4SSteven Rostedt 	if (a->time < b->time)
4970706f1c4SSteven Rostedt 		return -1;
4980706f1c4SSteven Rostedt 	if (a->time > b->time)
4990706f1c4SSteven Rostedt 		return 1;
5000706f1c4SSteven Rostedt 	else
5010706f1c4SSteven Rostedt 		return 0;
5020706f1c4SSteven Rostedt }
5030706f1c4SSteven Rostedt #else
5040706f1c4SSteven Rostedt /* not function graph compares against hits */
50580042c8fSAndy Shevchenko static int function_stat_cmp(const void *p1, const void *p2)
506493762fcSSteven Rostedt {
50780042c8fSAndy Shevchenko 	const struct ftrace_profile *a = p1;
50880042c8fSAndy Shevchenko 	const struct ftrace_profile *b = p2;
509493762fcSSteven Rostedt 
510493762fcSSteven Rostedt 	if (a->counter < b->counter)
511493762fcSSteven Rostedt 		return -1;
512493762fcSSteven Rostedt 	if (a->counter > b->counter)
513493762fcSSteven Rostedt 		return 1;
514493762fcSSteven Rostedt 	else
515493762fcSSteven Rostedt 		return 0;
516493762fcSSteven Rostedt }
5170706f1c4SSteven Rostedt #endif
518493762fcSSteven Rostedt 
519493762fcSSteven Rostedt static int function_stat_headers(struct seq_file *m)
520493762fcSSteven Rostedt {
5210706f1c4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
522fa6f0cc7SRasmus Villemoes 	seq_puts(m, "  Function                               "
523e330b3bcSChase Douglas 		 "Hit    Time            Avg             s^2\n"
52434886c8bSSteven Rostedt 		    "  --------                               "
525e330b3bcSChase Douglas 		 "---    ----            ---             ---\n");
5260706f1c4SSteven Rostedt #else
527fa6f0cc7SRasmus Villemoes 	seq_puts(m, "  Function                               Hit\n"
528493762fcSSteven Rostedt 		    "  --------                               ---\n");
5290706f1c4SSteven Rostedt #endif
530493762fcSSteven Rostedt 	return 0;
531493762fcSSteven Rostedt }
532493762fcSSteven Rostedt 
533493762fcSSteven Rostedt static int function_stat_show(struct seq_file *m, void *v)
534493762fcSSteven Rostedt {
535493762fcSSteven Rostedt 	struct ftrace_profile *rec = v;
536493762fcSSteven Rostedt 	char str[KSYM_SYMBOL_LEN];
5373aaba20fSLi Zefan 	int ret = 0;
5380706f1c4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
53934886c8bSSteven Rostedt 	static struct trace_seq s;
54034886c8bSSteven Rostedt 	unsigned long long avg;
541e330b3bcSChase Douglas 	unsigned long long stddev;
5420706f1c4SSteven Rostedt #endif
5433aaba20fSLi Zefan 	mutex_lock(&ftrace_profile_lock);
5443aaba20fSLi Zefan 
5453aaba20fSLi Zefan 	/* we raced with function_profile_reset() */
5463aaba20fSLi Zefan 	if (unlikely(rec->counter == 0)) {
5473aaba20fSLi Zefan 		ret = -EBUSY;
5483aaba20fSLi Zefan 		goto out;
5493aaba20fSLi Zefan 	}
550493762fcSSteven Rostedt 
5518e436ca0SUmesh Tiwari #ifdef CONFIG_FUNCTION_GRAPH_TRACER
552e31f7939SWen Yang 	avg = div64_ul(rec->time, rec->counter);
5538e436ca0SUmesh Tiwari 	if (tracing_thresh && (avg < tracing_thresh))
5548e436ca0SUmesh Tiwari 		goto out;
5558e436ca0SUmesh Tiwari #endif
5568e436ca0SUmesh Tiwari 
557493762fcSSteven Rostedt 	kallsyms_lookup(rec->ip, NULL, NULL, NULL, str);
5580706f1c4SSteven Rostedt 	seq_printf(m, "  %-30.30s  %10lu", str, rec->counter);
559493762fcSSteven Rostedt 
5600706f1c4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
561fa6f0cc7SRasmus Villemoes 	seq_puts(m, "    ");
56234886c8bSSteven Rostedt 
563e330b3bcSChase Douglas 	/* Sample standard deviation (s^2) */
564e330b3bcSChase Douglas 	if (rec->counter <= 1)
565e330b3bcSChase Douglas 		stddev = 0;
566e330b3bcSChase Douglas 	else {
56752d85d76SJuri Lelli 		/*
56852d85d76SJuri Lelli 		 * Apply Welford's method:
56952d85d76SJuri Lelli 		 * s^2 = 1 / (n * (n-1)) * (n * \Sum (x_i)^2 - (\Sum x_i)^2)
57052d85d76SJuri Lelli 		 */
57152d85d76SJuri Lelli 		stddev = rec->counter * rec->time_squared -
57252d85d76SJuri Lelli 			 rec->time * rec->time;
57352d85d76SJuri Lelli 
574e330b3bcSChase Douglas 		/*
575e330b3bcSChase Douglas 		 * Divide only 1000 for ns^2 -> us^2 conversion.
576e330b3bcSChase Douglas 		 * trace_print_graph_duration will divide 1000 again.
577e330b3bcSChase Douglas 		 */
578e31f7939SWen Yang 		stddev = div64_ul(stddev,
579e31f7939SWen Yang 				  rec->counter * (rec->counter - 1) * 1000);
580e330b3bcSChase Douglas 	}
581e330b3bcSChase Douglas 
58234886c8bSSteven Rostedt 	trace_seq_init(&s);
58334886c8bSSteven Rostedt 	trace_print_graph_duration(rec->time, &s);
58434886c8bSSteven Rostedt 	trace_seq_puts(&s, "    ");
58534886c8bSSteven Rostedt 	trace_print_graph_duration(avg, &s);
586e330b3bcSChase Douglas 	trace_seq_puts(&s, "    ");
587e330b3bcSChase Douglas 	trace_print_graph_duration(stddev, &s);
5880706f1c4SSteven Rostedt 	trace_print_seq(m, &s);
5890706f1c4SSteven Rostedt #endif
5900706f1c4SSteven Rostedt 	seq_putc(m, '\n');
5913aaba20fSLi Zefan out:
5923aaba20fSLi Zefan 	mutex_unlock(&ftrace_profile_lock);
5930706f1c4SSteven Rostedt 
5943aaba20fSLi Zefan 	return ret;
595493762fcSSteven Rostedt }
596493762fcSSteven Rostedt 
597cafb168aSSteven Rostedt static void ftrace_profile_reset(struct ftrace_profile_stat *stat)
598493762fcSSteven Rostedt {
599493762fcSSteven Rostedt 	struct ftrace_profile_page *pg;
600493762fcSSteven Rostedt 
601cafb168aSSteven Rostedt 	pg = stat->pages = stat->start;
602493762fcSSteven Rostedt 
603493762fcSSteven Rostedt 	while (pg) {
604493762fcSSteven Rostedt 		memset(pg->records, 0, PROFILE_RECORDS_SIZE);
605493762fcSSteven Rostedt 		pg->index = 0;
606493762fcSSteven Rostedt 		pg = pg->next;
607493762fcSSteven Rostedt 	}
608493762fcSSteven Rostedt 
609cafb168aSSteven Rostedt 	memset(stat->hash, 0,
610493762fcSSteven Rostedt 	       FTRACE_PROFILE_HASH_SIZE * sizeof(struct hlist_head));
611493762fcSSteven Rostedt }
612493762fcSSteven Rostedt 
613172f7ba9Schongjiapeng static int ftrace_profile_pages_init(struct ftrace_profile_stat *stat)
614493762fcSSteven Rostedt {
615493762fcSSteven Rostedt 	struct ftrace_profile_page *pg;
616318e0a73SSteven Rostedt 	int functions;
617318e0a73SSteven Rostedt 	int pages;
618493762fcSSteven Rostedt 	int i;
619493762fcSSteven Rostedt 
620493762fcSSteven Rostedt 	/* If we already allocated, do nothing */
621cafb168aSSteven Rostedt 	if (stat->pages)
622493762fcSSteven Rostedt 		return 0;
623493762fcSSteven Rostedt 
624cafb168aSSteven Rostedt 	stat->pages = (void *)get_zeroed_page(GFP_KERNEL);
625cafb168aSSteven Rostedt 	if (!stat->pages)
626493762fcSSteven Rostedt 		return -ENOMEM;
627493762fcSSteven Rostedt 
628318e0a73SSteven Rostedt #ifdef CONFIG_DYNAMIC_FTRACE
629318e0a73SSteven Rostedt 	functions = ftrace_update_tot_cnt;
630318e0a73SSteven Rostedt #else
631318e0a73SSteven Rostedt 	/*
632318e0a73SSteven Rostedt 	 * We do not know the number of functions that exist because
633318e0a73SSteven Rostedt 	 * dynamic tracing is what counts them. With past experience
634318e0a73SSteven Rostedt 	 * we have around 20K functions. That should be more than enough.
635318e0a73SSteven Rostedt 	 * It is highly unlikely we will execute every function in
636318e0a73SSteven Rostedt 	 * the kernel.
637318e0a73SSteven Rostedt 	 */
638318e0a73SSteven Rostedt 	functions = 20000;
639318e0a73SSteven Rostedt #endif
640318e0a73SSteven Rostedt 
641cafb168aSSteven Rostedt 	pg = stat->start = stat->pages;
642493762fcSSteven Rostedt 
643318e0a73SSteven Rostedt 	pages = DIV_ROUND_UP(functions, PROFILES_PER_PAGE);
644318e0a73SSteven Rostedt 
64539e30cd1SNamhyung Kim 	for (i = 1; i < pages; i++) {
646493762fcSSteven Rostedt 		pg->next = (void *)get_zeroed_page(GFP_KERNEL);
647493762fcSSteven Rostedt 		if (!pg->next)
648318e0a73SSteven Rostedt 			goto out_free;
649493762fcSSteven Rostedt 		pg = pg->next;
650493762fcSSteven Rostedt 	}
651493762fcSSteven Rostedt 
652493762fcSSteven Rostedt 	return 0;
653318e0a73SSteven Rostedt 
654318e0a73SSteven Rostedt  out_free:
655318e0a73SSteven Rostedt 	pg = stat->start;
656318e0a73SSteven Rostedt 	while (pg) {
657318e0a73SSteven Rostedt 		unsigned long tmp = (unsigned long)pg;
658318e0a73SSteven Rostedt 
659318e0a73SSteven Rostedt 		pg = pg->next;
660318e0a73SSteven Rostedt 		free_page(tmp);
661318e0a73SSteven Rostedt 	}
662318e0a73SSteven Rostedt 
663318e0a73SSteven Rostedt 	stat->pages = NULL;
664318e0a73SSteven Rostedt 	stat->start = NULL;
665318e0a73SSteven Rostedt 
666318e0a73SSteven Rostedt 	return -ENOMEM;
667493762fcSSteven Rostedt }
668493762fcSSteven Rostedt 
669cafb168aSSteven Rostedt static int ftrace_profile_init_cpu(int cpu)
670493762fcSSteven Rostedt {
671cafb168aSSteven Rostedt 	struct ftrace_profile_stat *stat;
672493762fcSSteven Rostedt 	int size;
673493762fcSSteven Rostedt 
674cafb168aSSteven Rostedt 	stat = &per_cpu(ftrace_profile_stats, cpu);
675cafb168aSSteven Rostedt 
676cafb168aSSteven Rostedt 	if (stat->hash) {
677493762fcSSteven Rostedt 		/* If the profile is already created, simply reset it */
678cafb168aSSteven Rostedt 		ftrace_profile_reset(stat);
679493762fcSSteven Rostedt 		return 0;
680493762fcSSteven Rostedt 	}
681493762fcSSteven Rostedt 
682493762fcSSteven Rostedt 	/*
683493762fcSSteven Rostedt 	 * We are profiling all functions, but usually only a few thousand
684493762fcSSteven Rostedt 	 * functions are hit. We'll make a hash of 1024 items.
685493762fcSSteven Rostedt 	 */
686493762fcSSteven Rostedt 	size = FTRACE_PROFILE_HASH_SIZE;
687493762fcSSteven Rostedt 
6886396bb22SKees Cook 	stat->hash = kcalloc(size, sizeof(struct hlist_head), GFP_KERNEL);
689493762fcSSteven Rostedt 
690cafb168aSSteven Rostedt 	if (!stat->hash)
691493762fcSSteven Rostedt 		return -ENOMEM;
692493762fcSSteven Rostedt 
693318e0a73SSteven Rostedt 	/* Preallocate the function profiling pages */
694cafb168aSSteven Rostedt 	if (ftrace_profile_pages_init(stat) < 0) {
695cafb168aSSteven Rostedt 		kfree(stat->hash);
696cafb168aSSteven Rostedt 		stat->hash = NULL;
697493762fcSSteven Rostedt 		return -ENOMEM;
698493762fcSSteven Rostedt 	}
699493762fcSSteven Rostedt 
700493762fcSSteven Rostedt 	return 0;
701493762fcSSteven Rostedt }
702493762fcSSteven Rostedt 
703cafb168aSSteven Rostedt static int ftrace_profile_init(void)
704cafb168aSSteven Rostedt {
705cafb168aSSteven Rostedt 	int cpu;
706cafb168aSSteven Rostedt 	int ret = 0;
707cafb168aSSteven Rostedt 
708c4602c1cSMiao Xie 	for_each_possible_cpu(cpu) {
709cafb168aSSteven Rostedt 		ret = ftrace_profile_init_cpu(cpu);
710cafb168aSSteven Rostedt 		if (ret)
711cafb168aSSteven Rostedt 			break;
712cafb168aSSteven Rostedt 	}
713cafb168aSSteven Rostedt 
714cafb168aSSteven Rostedt 	return ret;
715cafb168aSSteven Rostedt }
716cafb168aSSteven Rostedt 
717493762fcSSteven Rostedt /* interrupts must be disabled */
718cafb168aSSteven Rostedt static struct ftrace_profile *
719cafb168aSSteven Rostedt ftrace_find_profiled_func(struct ftrace_profile_stat *stat, unsigned long ip)
720493762fcSSteven Rostedt {
721493762fcSSteven Rostedt 	struct ftrace_profile *rec;
722493762fcSSteven Rostedt 	struct hlist_head *hhd;
723493762fcSSteven Rostedt 	unsigned long key;
724493762fcSSteven Rostedt 
72520079ebeSNamhyung Kim 	key = hash_long(ip, FTRACE_PROFILE_HASH_BITS);
726cafb168aSSteven Rostedt 	hhd = &stat->hash[key];
727493762fcSSteven Rostedt 
728493762fcSSteven Rostedt 	if (hlist_empty(hhd))
729493762fcSSteven Rostedt 		return NULL;
730493762fcSSteven Rostedt 
7311bb539caSSteven Rostedt 	hlist_for_each_entry_rcu_notrace(rec, hhd, node) {
732493762fcSSteven Rostedt 		if (rec->ip == ip)
733493762fcSSteven Rostedt 			return rec;
734493762fcSSteven Rostedt 	}
735493762fcSSteven Rostedt 
736493762fcSSteven Rostedt 	return NULL;
737493762fcSSteven Rostedt }
738493762fcSSteven Rostedt 
739cafb168aSSteven Rostedt static void ftrace_add_profile(struct ftrace_profile_stat *stat,
740cafb168aSSteven Rostedt 			       struct ftrace_profile *rec)
741493762fcSSteven Rostedt {
742493762fcSSteven Rostedt 	unsigned long key;
743493762fcSSteven Rostedt 
74420079ebeSNamhyung Kim 	key = hash_long(rec->ip, FTRACE_PROFILE_HASH_BITS);
745cafb168aSSteven Rostedt 	hlist_add_head_rcu(&rec->node, &stat->hash[key]);
746493762fcSSteven Rostedt }
747493762fcSSteven Rostedt 
748318e0a73SSteven Rostedt /*
749318e0a73SSteven Rostedt  * The memory is already allocated, this simply finds a new record to use.
750318e0a73SSteven Rostedt  */
751493762fcSSteven Rostedt static struct ftrace_profile *
752318e0a73SSteven Rostedt ftrace_profile_alloc(struct ftrace_profile_stat *stat, unsigned long ip)
753493762fcSSteven Rostedt {
754493762fcSSteven Rostedt 	struct ftrace_profile *rec = NULL;
755493762fcSSteven Rostedt 
756318e0a73SSteven Rostedt 	/* prevent recursion (from NMIs) */
757cafb168aSSteven Rostedt 	if (atomic_inc_return(&stat->disabled) != 1)
758493762fcSSteven Rostedt 		goto out;
759493762fcSSteven Rostedt 
760493762fcSSteven Rostedt 	/*
761318e0a73SSteven Rostedt 	 * Try to find the function again since an NMI
762318e0a73SSteven Rostedt 	 * could have added it
763493762fcSSteven Rostedt 	 */
764cafb168aSSteven Rostedt 	rec = ftrace_find_profiled_func(stat, ip);
765493762fcSSteven Rostedt 	if (rec)
766cafb168aSSteven Rostedt 		goto out;
767493762fcSSteven Rostedt 
768cafb168aSSteven Rostedt 	if (stat->pages->index == PROFILES_PER_PAGE) {
769cafb168aSSteven Rostedt 		if (!stat->pages->next)
770cafb168aSSteven Rostedt 			goto out;
771cafb168aSSteven Rostedt 		stat->pages = stat->pages->next;
772493762fcSSteven Rostedt 	}
773493762fcSSteven Rostedt 
774cafb168aSSteven Rostedt 	rec = &stat->pages->records[stat->pages->index++];
775493762fcSSteven Rostedt 	rec->ip = ip;
776cafb168aSSteven Rostedt 	ftrace_add_profile(stat, rec);
777493762fcSSteven Rostedt 
778493762fcSSteven Rostedt  out:
779cafb168aSSteven Rostedt 	atomic_dec(&stat->disabled);
780493762fcSSteven Rostedt 
781493762fcSSteven Rostedt 	return rec;
782493762fcSSteven Rostedt }
783493762fcSSteven Rostedt 
784493762fcSSteven Rostedt static void
7852f5f6ad9SSteven Rostedt function_profile_call(unsigned long ip, unsigned long parent_ip,
786d19ad077SSteven Rostedt (VMware) 		      struct ftrace_ops *ops, struct ftrace_regs *fregs)
787493762fcSSteven Rostedt {
788cafb168aSSteven Rostedt 	struct ftrace_profile_stat *stat;
789493762fcSSteven Rostedt 	struct ftrace_profile *rec;
790493762fcSSteven Rostedt 	unsigned long flags;
791493762fcSSteven Rostedt 
792493762fcSSteven Rostedt 	if (!ftrace_profile_enabled)
793493762fcSSteven Rostedt 		return;
794493762fcSSteven Rostedt 
795493762fcSSteven Rostedt 	local_irq_save(flags);
796cafb168aSSteven Rostedt 
797bdffd893SChristoph Lameter 	stat = this_cpu_ptr(&ftrace_profile_stats);
7980f6ce3deSSteven Rostedt 	if (!stat->hash || !ftrace_profile_enabled)
799cafb168aSSteven Rostedt 		goto out;
800cafb168aSSteven Rostedt 
801cafb168aSSteven Rostedt 	rec = ftrace_find_profiled_func(stat, ip);
802493762fcSSteven Rostedt 	if (!rec) {
803318e0a73SSteven Rostedt 		rec = ftrace_profile_alloc(stat, ip);
804493762fcSSteven Rostedt 		if (!rec)
805493762fcSSteven Rostedt 			goto out;
806493762fcSSteven Rostedt 	}
807493762fcSSteven Rostedt 
808493762fcSSteven Rostedt 	rec->counter++;
809493762fcSSteven Rostedt  out:
810493762fcSSteven Rostedt 	local_irq_restore(flags);
811493762fcSSteven Rostedt }
812493762fcSSteven Rostedt 
8130706f1c4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
814e73e679fSSteven Rostedt (VMware) static bool fgraph_graph_time = true;
815e73e679fSSteven Rostedt (VMware) 
816e73e679fSSteven Rostedt (VMware) void ftrace_graph_graph_time_control(bool enable)
817e73e679fSSteven Rostedt (VMware) {
818e73e679fSSteven Rostedt (VMware) 	fgraph_graph_time = enable;
819e73e679fSSteven Rostedt (VMware) }
820e73e679fSSteven Rostedt (VMware) 
82137238abeSSteven Rostedt (VMware) static int profile_graph_entry(struct ftrace_graph_ent *trace,
82237238abeSSteven Rostedt (VMware) 			       struct fgraph_ops *gops)
8230706f1c4SSteven Rostedt {
824b0e21a61SSteven Rostedt (VMware) 	struct ftrace_ret_stack *ret_stack;
8258861dd30SNamhyung Kim 
826a1e2e31dSSteven Rostedt 	function_profile_call(trace->func, 0, NULL, NULL);
8278861dd30SNamhyung Kim 
828a8f0f9e4SSteven Rostedt (VMware) 	/* If function graph is shutting down, ret_stack can be NULL */
829a8f0f9e4SSteven Rostedt (VMware) 	if (!current->ret_stack)
830a8f0f9e4SSteven Rostedt (VMware) 		return 0;
831a8f0f9e4SSteven Rostedt (VMware) 
832b0e21a61SSteven Rostedt (VMware) 	ret_stack = ftrace_graph_get_ret_stack(current, 0);
833b0e21a61SSteven Rostedt (VMware) 	if (ret_stack)
834b0e21a61SSteven Rostedt (VMware) 		ret_stack->subtime = 0;
8358861dd30SNamhyung Kim 
8360706f1c4SSteven Rostedt 	return 1;
8370706f1c4SSteven Rostedt }
8380706f1c4SSteven Rostedt 
83937238abeSSteven Rostedt (VMware) static void profile_graph_return(struct ftrace_graph_ret *trace,
84037238abeSSteven Rostedt (VMware) 				 struct fgraph_ops *gops)
8410706f1c4SSteven Rostedt {
842b0e21a61SSteven Rostedt (VMware) 	struct ftrace_ret_stack *ret_stack;
843cafb168aSSteven Rostedt 	struct ftrace_profile_stat *stat;
844a2a16d6aSSteven Rostedt 	unsigned long long calltime;
8450706f1c4SSteven Rostedt 	struct ftrace_profile *rec;
846cafb168aSSteven Rostedt 	unsigned long flags;
8470706f1c4SSteven Rostedt 
8480706f1c4SSteven Rostedt 	local_irq_save(flags);
849bdffd893SChristoph Lameter 	stat = this_cpu_ptr(&ftrace_profile_stats);
8500f6ce3deSSteven Rostedt 	if (!stat->hash || !ftrace_profile_enabled)
851cafb168aSSteven Rostedt 		goto out;
852cafb168aSSteven Rostedt 
85337e44bc5SSteven Rostedt 	/* If the calltime was zero'd ignore it */
85437e44bc5SSteven Rostedt 	if (!trace->calltime)
85537e44bc5SSteven Rostedt 		goto out;
85637e44bc5SSteven Rostedt 
857a2a16d6aSSteven Rostedt 	calltime = trace->rettime - trace->calltime;
858a2a16d6aSSteven Rostedt 
85955577204SSteven Rostedt (Red Hat) 	if (!fgraph_graph_time) {
860a2a16d6aSSteven Rostedt 
861a2a16d6aSSteven Rostedt 		/* Append this call time to the parent time to subtract */
862b0e21a61SSteven Rostedt (VMware) 		ret_stack = ftrace_graph_get_ret_stack(current, 1);
863b0e21a61SSteven Rostedt (VMware) 		if (ret_stack)
864b0e21a61SSteven Rostedt (VMware) 			ret_stack->subtime += calltime;
865a2a16d6aSSteven Rostedt 
866b0e21a61SSteven Rostedt (VMware) 		ret_stack = ftrace_graph_get_ret_stack(current, 0);
867b0e21a61SSteven Rostedt (VMware) 		if (ret_stack && ret_stack->subtime < calltime)
868b0e21a61SSteven Rostedt (VMware) 			calltime -= ret_stack->subtime;
869a2a16d6aSSteven Rostedt 		else
870a2a16d6aSSteven Rostedt 			calltime = 0;
871a2a16d6aSSteven Rostedt 	}
872a2a16d6aSSteven Rostedt 
873cafb168aSSteven Rostedt 	rec = ftrace_find_profiled_func(stat, trace->func);
874e330b3bcSChase Douglas 	if (rec) {
875a2a16d6aSSteven Rostedt 		rec->time += calltime;
876e330b3bcSChase Douglas 		rec->time_squared += calltime * calltime;
877e330b3bcSChase Douglas 	}
878a2a16d6aSSteven Rostedt 
879cafb168aSSteven Rostedt  out:
8800706f1c4SSteven Rostedt 	local_irq_restore(flags);
8810706f1c4SSteven Rostedt }
8820706f1c4SSteven Rostedt 
883688f7089SSteven Rostedt (VMware) static struct fgraph_ops fprofiler_ops = {
884688f7089SSteven Rostedt (VMware) 	.entryfunc = &profile_graph_entry,
885688f7089SSteven Rostedt (VMware) 	.retfunc = &profile_graph_return,
886688f7089SSteven Rostedt (VMware) };
887688f7089SSteven Rostedt (VMware) 
8880706f1c4SSteven Rostedt static int register_ftrace_profiler(void)
8890706f1c4SSteven Rostedt {
890688f7089SSteven Rostedt (VMware) 	return register_ftrace_graph(&fprofiler_ops);
8910706f1c4SSteven Rostedt }
8920706f1c4SSteven Rostedt 
8930706f1c4SSteven Rostedt static void unregister_ftrace_profiler(void)
8940706f1c4SSteven Rostedt {
895688f7089SSteven Rostedt (VMware) 	unregister_ftrace_graph(&fprofiler_ops);
8960706f1c4SSteven Rostedt }
8970706f1c4SSteven Rostedt #else
898bd38c0e6SPaul McQuade static struct ftrace_ops ftrace_profile_ops __read_mostly = {
899493762fcSSteven Rostedt 	.func		= function_profile_call,
900a25d036dSSteven Rostedt (VMware) 	.flags		= FTRACE_OPS_FL_INITIALIZED,
90133b7f99cSSteven Rostedt (Red Hat) 	INIT_OPS_HASH(ftrace_profile_ops)
902493762fcSSteven Rostedt };
903493762fcSSteven Rostedt 
9040706f1c4SSteven Rostedt static int register_ftrace_profiler(void)
9050706f1c4SSteven Rostedt {
9060706f1c4SSteven Rostedt 	return register_ftrace_function(&ftrace_profile_ops);
9070706f1c4SSteven Rostedt }
9080706f1c4SSteven Rostedt 
9090706f1c4SSteven Rostedt static void unregister_ftrace_profiler(void)
9100706f1c4SSteven Rostedt {
9110706f1c4SSteven Rostedt 	unregister_ftrace_function(&ftrace_profile_ops);
9120706f1c4SSteven Rostedt }
9130706f1c4SSteven Rostedt #endif /* CONFIG_FUNCTION_GRAPH_TRACER */
9140706f1c4SSteven Rostedt 
915493762fcSSteven Rostedt static ssize_t
916493762fcSSteven Rostedt ftrace_profile_write(struct file *filp, const char __user *ubuf,
917493762fcSSteven Rostedt 		     size_t cnt, loff_t *ppos)
918493762fcSSteven Rostedt {
919493762fcSSteven Rostedt 	unsigned long val;
920493762fcSSteven Rostedt 	int ret;
921493762fcSSteven Rostedt 
92222fe9b54SPeter Huewe 	ret = kstrtoul_from_user(ubuf, cnt, 10, &val);
92322fe9b54SPeter Huewe 	if (ret)
924493762fcSSteven Rostedt 		return ret;
925493762fcSSteven Rostedt 
926493762fcSSteven Rostedt 	val = !!val;
927493762fcSSteven Rostedt 
928493762fcSSteven Rostedt 	mutex_lock(&ftrace_profile_lock);
929493762fcSSteven Rostedt 	if (ftrace_profile_enabled ^ val) {
930493762fcSSteven Rostedt 		if (val) {
931493762fcSSteven Rostedt 			ret = ftrace_profile_init();
932493762fcSSteven Rostedt 			if (ret < 0) {
933493762fcSSteven Rostedt 				cnt = ret;
934493762fcSSteven Rostedt 				goto out;
935493762fcSSteven Rostedt 			}
936493762fcSSteven Rostedt 
9370706f1c4SSteven Rostedt 			ret = register_ftrace_profiler();
9380706f1c4SSteven Rostedt 			if (ret < 0) {
9390706f1c4SSteven Rostedt 				cnt = ret;
9400706f1c4SSteven Rostedt 				goto out;
9410706f1c4SSteven Rostedt 			}
942493762fcSSteven Rostedt 			ftrace_profile_enabled = 1;
943493762fcSSteven Rostedt 		} else {
944493762fcSSteven Rostedt 			ftrace_profile_enabled = 0;
9450f6ce3deSSteven Rostedt 			/*
9460f6ce3deSSteven Rostedt 			 * unregister_ftrace_profiler calls stop_machine
94774401729SPaul E. McKenney 			 * so this acts like an synchronize_rcu.
9480f6ce3deSSteven Rostedt 			 */
9490706f1c4SSteven Rostedt 			unregister_ftrace_profiler();
950493762fcSSteven Rostedt 		}
951493762fcSSteven Rostedt 	}
952493762fcSSteven Rostedt  out:
953493762fcSSteven Rostedt 	mutex_unlock(&ftrace_profile_lock);
954493762fcSSteven Rostedt 
955cf8517cfSJiri Olsa 	*ppos += cnt;
956493762fcSSteven Rostedt 
957493762fcSSteven Rostedt 	return cnt;
958493762fcSSteven Rostedt }
959493762fcSSteven Rostedt 
960493762fcSSteven Rostedt static ssize_t
961493762fcSSteven Rostedt ftrace_profile_read(struct file *filp, char __user *ubuf,
962493762fcSSteven Rostedt 		     size_t cnt, loff_t *ppos)
963493762fcSSteven Rostedt {
964fb9fb015SSteven Rostedt 	char buf[64];		/* big enough to hold a number */
965493762fcSSteven Rostedt 	int r;
966493762fcSSteven Rostedt 
967493762fcSSteven Rostedt 	r = sprintf(buf, "%u\n", ftrace_profile_enabled);
968493762fcSSteven Rostedt 	return simple_read_from_buffer(ubuf, cnt, ppos, buf, r);
969493762fcSSteven Rostedt }
970493762fcSSteven Rostedt 
971493762fcSSteven Rostedt static const struct file_operations ftrace_profile_fops = {
972493762fcSSteven Rostedt 	.open		= tracing_open_generic,
973493762fcSSteven Rostedt 	.read		= ftrace_profile_read,
974493762fcSSteven Rostedt 	.write		= ftrace_profile_write,
9756038f373SArnd Bergmann 	.llseek		= default_llseek,
976493762fcSSteven Rostedt };
977493762fcSSteven Rostedt 
978cafb168aSSteven Rostedt /* used to initialize the real stat files */
979cafb168aSSteven Rostedt static struct tracer_stat function_stats __initdata = {
980cafb168aSSteven Rostedt 	.name		= "functions",
981cafb168aSSteven Rostedt 	.stat_start	= function_stat_start,
982cafb168aSSteven Rostedt 	.stat_next	= function_stat_next,
983cafb168aSSteven Rostedt 	.stat_cmp	= function_stat_cmp,
984cafb168aSSteven Rostedt 	.stat_headers	= function_stat_headers,
985cafb168aSSteven Rostedt 	.stat_show	= function_stat_show
986cafb168aSSteven Rostedt };
987cafb168aSSteven Rostedt 
9888434dc93SSteven Rostedt (Red Hat) static __init void ftrace_profile_tracefs(struct dentry *d_tracer)
989493762fcSSteven Rostedt {
990cafb168aSSteven Rostedt 	struct ftrace_profile_stat *stat;
991cafb168aSSteven Rostedt 	char *name;
992493762fcSSteven Rostedt 	int ret;
993cafb168aSSteven Rostedt 	int cpu;
994493762fcSSteven Rostedt 
995cafb168aSSteven Rostedt 	for_each_possible_cpu(cpu) {
996cafb168aSSteven Rostedt 		stat = &per_cpu(ftrace_profile_stats, cpu);
997cafb168aSSteven Rostedt 
9986363c6b5SGeliang Tang 		name = kasprintf(GFP_KERNEL, "function%d", cpu);
999cafb168aSSteven Rostedt 		if (!name) {
1000cafb168aSSteven Rostedt 			/*
1001cafb168aSSteven Rostedt 			 * The files created are permanent, if something happens
1002cafb168aSSteven Rostedt 			 * we still do not free memory.
1003cafb168aSSteven Rostedt 			 */
1004cafb168aSSteven Rostedt 			WARN(1,
1005cafb168aSSteven Rostedt 			     "Could not allocate stat file for cpu %d\n",
1006cafb168aSSteven Rostedt 			     cpu);
1007493762fcSSteven Rostedt 			return;
1008493762fcSSteven Rostedt 		}
1009cafb168aSSteven Rostedt 		stat->stat = function_stats;
1010cafb168aSSteven Rostedt 		stat->stat.name = name;
1011cafb168aSSteven Rostedt 		ret = register_stat_tracer(&stat->stat);
1012cafb168aSSteven Rostedt 		if (ret) {
1013cafb168aSSteven Rostedt 			WARN(1,
1014cafb168aSSteven Rostedt 			     "Could not register function stat for cpu %d\n",
1015cafb168aSSteven Rostedt 			     cpu);
1016cafb168aSSteven Rostedt 			kfree(name);
1017cafb168aSSteven Rostedt 			return;
1018cafb168aSSteven Rostedt 		}
1019cafb168aSSteven Rostedt 	}
1020493762fcSSteven Rostedt 
1021e4931b82SYuntao Wang 	trace_create_file("function_profile_enabled",
102221ccc9cdSSteven Rostedt (VMware) 			  TRACE_MODE_WRITE, d_tracer, NULL,
102321ccc9cdSSteven Rostedt (VMware) 			  &ftrace_profile_fops);
1024493762fcSSteven Rostedt }
1025493762fcSSteven Rostedt 
1026493762fcSSteven Rostedt #else /* CONFIG_FUNCTION_PROFILER */
10278434dc93SSteven Rostedt (Red Hat) static __init void ftrace_profile_tracefs(struct dentry *d_tracer)
1028493762fcSSteven Rostedt {
1029493762fcSSteven Rostedt }
1030493762fcSSteven Rostedt #endif /* CONFIG_FUNCTION_PROFILER */
1031493762fcSSteven Rostedt 
10323d083395SSteven Rostedt #ifdef CONFIG_DYNAMIC_FTRACE
103373d3fd96SIngo Molnar 
103479922b80SSteven Rostedt (Red Hat) static struct ftrace_ops *removed_ops;
103579922b80SSteven Rostedt (Red Hat) 
1036e1effa01SSteven Rostedt (Red Hat) /*
1037e1effa01SSteven Rostedt (Red Hat)  * Set when doing a global update, like enabling all recs or disabling them.
1038e1effa01SSteven Rostedt (Red Hat)  * It is not set when just updating a single ftrace_ops.
1039e1effa01SSteven Rostedt (Red Hat)  */
1040e1effa01SSteven Rostedt (Red Hat) static bool update_all_ops;
1041e1effa01SSteven Rostedt (Red Hat) 
104299ecdc43SSteven Rostedt #ifndef CONFIG_FTRACE_MCOUNT_RECORD
1043cb7be3b2SSteven Rostedt # error Dynamic ftrace depends on MCOUNT_RECORD
104499ecdc43SSteven Rostedt #endif
104599ecdc43SSteven Rostedt 
10467b60f3d8SSteven Rostedt (VMware) struct ftrace_func_probe {
10477b60f3d8SSteven Rostedt (VMware) 	struct ftrace_probe_ops	*probe_ops;
10487b60f3d8SSteven Rostedt (VMware) 	struct ftrace_ops	ops;
10497b60f3d8SSteven Rostedt (VMware) 	struct trace_array	*tr;
10507b60f3d8SSteven Rostedt (VMware) 	struct list_head	list;
10516e444319SSteven Rostedt (VMware) 	void			*data;
10527b60f3d8SSteven Rostedt (VMware) 	int			ref;
10537b60f3d8SSteven Rostedt (VMware) };
10547b60f3d8SSteven Rostedt (VMware) 
105533dc9b12SSteven Rostedt /*
105633dc9b12SSteven Rostedt  * We make these constant because no one should touch them,
105733dc9b12SSteven Rostedt  * but they are used as the default "empty hash", to avoid allocating
105833dc9b12SSteven Rostedt  * it all the time. These are in a read only section such that if
105933dc9b12SSteven Rostedt  * anyone does try to modify it, it will cause an exception.
106033dc9b12SSteven Rostedt  */
106133dc9b12SSteven Rostedt static const struct hlist_head empty_buckets[1];
106233dc9b12SSteven Rostedt static const struct ftrace_hash empty_hash = {
106333dc9b12SSteven Rostedt 	.buckets = (struct hlist_head *)empty_buckets,
1064b448c4e3SSteven Rostedt };
106533dc9b12SSteven Rostedt #define EMPTY_HASH	((struct ftrace_hash *)&empty_hash)
10665072c59fSSteven Rostedt 
10673306fc4aSSteven Rostedt (VMware) struct ftrace_ops global_ops = {
1068f45948e8SSteven Rostedt 	.func				= ftrace_stub,
106933b7f99cSSteven Rostedt (Red Hat) 	.local_hash.notrace_hash	= EMPTY_HASH,
107033b7f99cSSteven Rostedt (Red Hat) 	.local_hash.filter_hash		= EMPTY_HASH,
107133b7f99cSSteven Rostedt (Red Hat) 	INIT_OPS_HASH(global_ops)
1072a25d036dSSteven Rostedt (VMware) 	.flags				= FTRACE_OPS_FL_INITIALIZED |
1073e3eea140SSteven Rostedt (Red Hat) 					  FTRACE_OPS_FL_PID,
1074f45948e8SSteven Rostedt };
1075f45948e8SSteven Rostedt 
1076aec0be2dSSteven Rostedt (Red Hat) /*
1077f2cc020dSIngo Molnar  * Used by the stack unwinder to know about dynamic ftrace trampolines.
1078aec0be2dSSteven Rostedt (Red Hat)  */
10796be7fa3cSSteven Rostedt (VMware) struct ftrace_ops *ftrace_ops_trampoline(unsigned long addr)
1080aec0be2dSSteven Rostedt (Red Hat) {
10816be7fa3cSSteven Rostedt (VMware) 	struct ftrace_ops *op = NULL;
1082aec0be2dSSteven Rostedt (Red Hat) 
1083aec0be2dSSteven Rostedt (Red Hat) 	/*
1084aec0be2dSSteven Rostedt (Red Hat) 	 * Some of the ops may be dynamically allocated,
108574401729SPaul E. McKenney 	 * they are freed after a synchronize_rcu().
1086aec0be2dSSteven Rostedt (Red Hat) 	 */
1087aec0be2dSSteven Rostedt (Red Hat) 	preempt_disable_notrace();
1088aec0be2dSSteven Rostedt (Red Hat) 
1089aec0be2dSSteven Rostedt (Red Hat) 	do_for_each_ftrace_op(op, ftrace_ops_list) {
1090aec0be2dSSteven Rostedt (Red Hat) 		/*
1091aec0be2dSSteven Rostedt (Red Hat) 		 * This is to check for dynamically allocated trampolines.
1092aec0be2dSSteven Rostedt (Red Hat) 		 * Trampolines that are in kernel text will have
1093aec0be2dSSteven Rostedt (Red Hat) 		 * core_kernel_text() return true.
1094aec0be2dSSteven Rostedt (Red Hat) 		 */
1095aec0be2dSSteven Rostedt (Red Hat) 		if (op->trampoline && op->trampoline_size)
1096aec0be2dSSteven Rostedt (Red Hat) 			if (addr >= op->trampoline &&
1097aec0be2dSSteven Rostedt (Red Hat) 			    addr < op->trampoline + op->trampoline_size) {
10986be7fa3cSSteven Rostedt (VMware) 				preempt_enable_notrace();
10996be7fa3cSSteven Rostedt (VMware) 				return op;
1100aec0be2dSSteven Rostedt (Red Hat) 			}
1101aec0be2dSSteven Rostedt (Red Hat) 	} while_for_each_ftrace_op(op);
1102aec0be2dSSteven Rostedt (Red Hat) 	preempt_enable_notrace();
1103aec0be2dSSteven Rostedt (Red Hat) 
11046be7fa3cSSteven Rostedt (VMware) 	return NULL;
11056be7fa3cSSteven Rostedt (VMware) }
11066be7fa3cSSteven Rostedt (VMware) 
11076be7fa3cSSteven Rostedt (VMware) /*
11086be7fa3cSSteven Rostedt (VMware)  * This is used by __kernel_text_address() to return true if the
11096be7fa3cSSteven Rostedt (VMware)  * address is on a dynamically allocated trampoline that would
11106be7fa3cSSteven Rostedt (VMware)  * not return true for either core_kernel_text() or
11116be7fa3cSSteven Rostedt (VMware)  * is_module_text_address().
11126be7fa3cSSteven Rostedt (VMware)  */
11136be7fa3cSSteven Rostedt (VMware) bool is_ftrace_trampoline(unsigned long addr)
11146be7fa3cSSteven Rostedt (VMware) {
11156be7fa3cSSteven Rostedt (VMware) 	return ftrace_ops_trampoline(addr) != NULL;
1116aec0be2dSSteven Rostedt (Red Hat) }
1117aec0be2dSSteven Rostedt (Red Hat) 
11183c1720f0SSteven Rostedt struct ftrace_page {
11193c1720f0SSteven Rostedt 	struct ftrace_page	*next;
1120a7900875SSteven Rostedt 	struct dyn_ftrace	*records;
1121431aa3fbSSteven Rostedt 	int			index;
1122db42523bSLinus Torvalds 	int			order;
1123aa5e5ceaSDavid Miller };
11243c1720f0SSteven Rostedt 
1125a7900875SSteven Rostedt #define ENTRY_SIZE sizeof(struct dyn_ftrace)
1126a7900875SSteven Rostedt #define ENTRIES_PER_PAGE (PAGE_SIZE / ENTRY_SIZE)
11273c1720f0SSteven Rostedt 
11283c1720f0SSteven Rostedt static struct ftrace_page	*ftrace_pages_start;
11293c1720f0SSteven Rostedt static struct ftrace_page	*ftrace_pages;
11303c1720f0SSteven Rostedt 
11312b0cce0eSSteven Rostedt (VMware) static __always_inline unsigned long
11322b0cce0eSSteven Rostedt (VMware) ftrace_hash_key(struct ftrace_hash *hash, unsigned long ip)
11332b0cce0eSSteven Rostedt (VMware) {
11342b0cce0eSSteven Rostedt (VMware) 	if (hash->size_bits > 0)
11352b0cce0eSSteven Rostedt (VMware) 		return hash_long(ip, hash->size_bits);
11362b0cce0eSSteven Rostedt (VMware) 
11372b0cce0eSSteven Rostedt (VMware) 	return 0;
11382b0cce0eSSteven Rostedt (VMware) }
11392b0cce0eSSteven Rostedt (VMware) 
11402b2c279cSSteven Rostedt (VMware) /* Only use this function if ftrace_hash_empty() has already been tested */
11412b2c279cSSteven Rostedt (VMware) static __always_inline struct ftrace_func_entry *
11422b2c279cSSteven Rostedt (VMware) __ftrace_lookup_ip(struct ftrace_hash *hash, unsigned long ip)
1143b448c4e3SSteven Rostedt {
1144b448c4e3SSteven Rostedt 	unsigned long key;
1145b448c4e3SSteven Rostedt 	struct ftrace_func_entry *entry;
1146b448c4e3SSteven Rostedt 	struct hlist_head *hhd;
1147b448c4e3SSteven Rostedt 
11482b0cce0eSSteven Rostedt (VMware) 	key = ftrace_hash_key(hash, ip);
1149b448c4e3SSteven Rostedt 	hhd = &hash->buckets[key];
1150b448c4e3SSteven Rostedt 
11511bb539caSSteven Rostedt 	hlist_for_each_entry_rcu_notrace(entry, hhd, hlist) {
1152b448c4e3SSteven Rostedt 		if (entry->ip == ip)
1153b448c4e3SSteven Rostedt 			return entry;
1154b448c4e3SSteven Rostedt 	}
1155b448c4e3SSteven Rostedt 	return NULL;
1156b448c4e3SSteven Rostedt }
1157b448c4e3SSteven Rostedt 
11582b2c279cSSteven Rostedt (VMware) /**
11592b2c279cSSteven Rostedt (VMware)  * ftrace_lookup_ip - Test to see if an ip exists in an ftrace_hash
11602b2c279cSSteven Rostedt (VMware)  * @hash: The hash to look at
11612b2c279cSSteven Rostedt (VMware)  * @ip: The instruction pointer to test
11622b2c279cSSteven Rostedt (VMware)  *
11632b2c279cSSteven Rostedt (VMware)  * Search a given @hash to see if a given instruction pointer (@ip)
11642b2c279cSSteven Rostedt (VMware)  * exists in it.
11652b2c279cSSteven Rostedt (VMware)  *
1166d1530413SRandy Dunlap  * Returns: the entry that holds the @ip if found. NULL otherwise.
11672b2c279cSSteven Rostedt (VMware)  */
11682b2c279cSSteven Rostedt (VMware) struct ftrace_func_entry *
11692b2c279cSSteven Rostedt (VMware) ftrace_lookup_ip(struct ftrace_hash *hash, unsigned long ip)
11702b2c279cSSteven Rostedt (VMware) {
11712b2c279cSSteven Rostedt (VMware) 	if (ftrace_hash_empty(hash))
11722b2c279cSSteven Rostedt (VMware) 		return NULL;
11732b2c279cSSteven Rostedt (VMware) 
11742b2c279cSSteven Rostedt (VMware) 	return __ftrace_lookup_ip(hash, ip);
11752b2c279cSSteven Rostedt (VMware) }
11762b2c279cSSteven Rostedt (VMware) 
117733dc9b12SSteven Rostedt static void __add_hash_entry(struct ftrace_hash *hash,
117833dc9b12SSteven Rostedt 			     struct ftrace_func_entry *entry)
117933dc9b12SSteven Rostedt {
118033dc9b12SSteven Rostedt 	struct hlist_head *hhd;
118133dc9b12SSteven Rostedt 	unsigned long key;
118233dc9b12SSteven Rostedt 
11832b0cce0eSSteven Rostedt (VMware) 	key = ftrace_hash_key(hash, entry->ip);
118433dc9b12SSteven Rostedt 	hhd = &hash->buckets[key];
118533dc9b12SSteven Rostedt 	hlist_add_head(&entry->hlist, hhd);
118633dc9b12SSteven Rostedt 	hash->count++;
118733dc9b12SSteven Rostedt }
118833dc9b12SSteven Rostedt 
1189d05cb470SSteven Rostedt (Google) static struct ftrace_func_entry *
1190d05cb470SSteven Rostedt (Google) add_hash_entry(struct ftrace_hash *hash, unsigned long ip)
1191b448c4e3SSteven Rostedt {
1192b448c4e3SSteven Rostedt 	struct ftrace_func_entry *entry;
1193b448c4e3SSteven Rostedt 
1194b448c4e3SSteven Rostedt 	entry = kmalloc(sizeof(*entry), GFP_KERNEL);
1195b448c4e3SSteven Rostedt 	if (!entry)
1196d05cb470SSteven Rostedt (Google) 		return NULL;
1197b448c4e3SSteven Rostedt 
1198b448c4e3SSteven Rostedt 	entry->ip = ip;
119933dc9b12SSteven Rostedt 	__add_hash_entry(hash, entry);
1200b448c4e3SSteven Rostedt 
1201d05cb470SSteven Rostedt (Google) 	return entry;
1202b448c4e3SSteven Rostedt }
1203b448c4e3SSteven Rostedt 
1204b448c4e3SSteven Rostedt static void
120533dc9b12SSteven Rostedt free_hash_entry(struct ftrace_hash *hash,
120633dc9b12SSteven Rostedt 		  struct ftrace_func_entry *entry)
120733dc9b12SSteven Rostedt {
120833dc9b12SSteven Rostedt 	hlist_del(&entry->hlist);
120933dc9b12SSteven Rostedt 	kfree(entry);
121033dc9b12SSteven Rostedt 	hash->count--;
121133dc9b12SSteven Rostedt }
121233dc9b12SSteven Rostedt 
121333dc9b12SSteven Rostedt static void
1214b448c4e3SSteven Rostedt remove_hash_entry(struct ftrace_hash *hash,
1215b448c4e3SSteven Rostedt 		  struct ftrace_func_entry *entry)
1216b448c4e3SSteven Rostedt {
1217eee8ded1SSteven Rostedt (VMware) 	hlist_del_rcu(&entry->hlist);
1218b448c4e3SSteven Rostedt 	hash->count--;
1219b448c4e3SSteven Rostedt }
1220b448c4e3SSteven Rostedt 
1221b448c4e3SSteven Rostedt static void ftrace_hash_clear(struct ftrace_hash *hash)
1222b448c4e3SSteven Rostedt {
1223b448c4e3SSteven Rostedt 	struct hlist_head *hhd;
1224b67bfe0dSSasha Levin 	struct hlist_node *tn;
1225b448c4e3SSteven Rostedt 	struct ftrace_func_entry *entry;
1226b448c4e3SSteven Rostedt 	int size = 1 << hash->size_bits;
1227b448c4e3SSteven Rostedt 	int i;
1228b448c4e3SSteven Rostedt 
122933dc9b12SSteven Rostedt 	if (!hash->count)
123033dc9b12SSteven Rostedt 		return;
123133dc9b12SSteven Rostedt 
1232b448c4e3SSteven Rostedt 	for (i = 0; i < size; i++) {
1233b448c4e3SSteven Rostedt 		hhd = &hash->buckets[i];
1234b67bfe0dSSasha Levin 		hlist_for_each_entry_safe(entry, tn, hhd, hlist)
123533dc9b12SSteven Rostedt 			free_hash_entry(hash, entry);
1236b448c4e3SSteven Rostedt 	}
1237b448c4e3SSteven Rostedt 	FTRACE_WARN_ON(hash->count);
1238b448c4e3SSteven Rostedt }
1239b448c4e3SSteven Rostedt 
1240673feb9dSSteven Rostedt (VMware) static void free_ftrace_mod(struct ftrace_mod_load *ftrace_mod)
1241673feb9dSSteven Rostedt (VMware) {
1242673feb9dSSteven Rostedt (VMware) 	list_del(&ftrace_mod->list);
1243673feb9dSSteven Rostedt (VMware) 	kfree(ftrace_mod->module);
1244673feb9dSSteven Rostedt (VMware) 	kfree(ftrace_mod->func);
1245673feb9dSSteven Rostedt (VMware) 	kfree(ftrace_mod);
1246673feb9dSSteven Rostedt (VMware) }
1247673feb9dSSteven Rostedt (VMware) 
1248673feb9dSSteven Rostedt (VMware) static void clear_ftrace_mod_list(struct list_head *head)
1249673feb9dSSteven Rostedt (VMware) {
1250673feb9dSSteven Rostedt (VMware) 	struct ftrace_mod_load *p, *n;
1251673feb9dSSteven Rostedt (VMware) 
1252673feb9dSSteven Rostedt (VMware) 	/* stack tracer isn't supported yet */
1253673feb9dSSteven Rostedt (VMware) 	if (!head)
1254673feb9dSSteven Rostedt (VMware) 		return;
1255673feb9dSSteven Rostedt (VMware) 
1256673feb9dSSteven Rostedt (VMware) 	mutex_lock(&ftrace_lock);
1257673feb9dSSteven Rostedt (VMware) 	list_for_each_entry_safe(p, n, head, list)
1258673feb9dSSteven Rostedt (VMware) 		free_ftrace_mod(p);
1259673feb9dSSteven Rostedt (VMware) 	mutex_unlock(&ftrace_lock);
1260673feb9dSSteven Rostedt (VMware) }
1261673feb9dSSteven Rostedt (VMware) 
126233dc9b12SSteven Rostedt static void free_ftrace_hash(struct ftrace_hash *hash)
126333dc9b12SSteven Rostedt {
126433dc9b12SSteven Rostedt 	if (!hash || hash == EMPTY_HASH)
126533dc9b12SSteven Rostedt 		return;
126633dc9b12SSteven Rostedt 	ftrace_hash_clear(hash);
126733dc9b12SSteven Rostedt 	kfree(hash->buckets);
126833dc9b12SSteven Rostedt 	kfree(hash);
126933dc9b12SSteven Rostedt }
127033dc9b12SSteven Rostedt 
127107fd5515SSteven Rostedt static void __free_ftrace_hash_rcu(struct rcu_head *rcu)
127207fd5515SSteven Rostedt {
127307fd5515SSteven Rostedt 	struct ftrace_hash *hash;
127407fd5515SSteven Rostedt 
127507fd5515SSteven Rostedt 	hash = container_of(rcu, struct ftrace_hash, rcu);
127607fd5515SSteven Rostedt 	free_ftrace_hash(hash);
127707fd5515SSteven Rostedt }
127807fd5515SSteven Rostedt 
127907fd5515SSteven Rostedt static void free_ftrace_hash_rcu(struct ftrace_hash *hash)
128007fd5515SSteven Rostedt {
128107fd5515SSteven Rostedt 	if (!hash || hash == EMPTY_HASH)
128207fd5515SSteven Rostedt 		return;
128374401729SPaul E. McKenney 	call_rcu(&hash->rcu, __free_ftrace_hash_rcu);
128407fd5515SSteven Rostedt }
128507fd5515SSteven Rostedt 
12868be9fbd5SMark Rutland /**
12878be9fbd5SMark Rutland  * ftrace_free_filter - remove all filters for an ftrace_ops
1288d1530413SRandy Dunlap  * @ops: the ops to remove the filters from
12898be9fbd5SMark Rutland  */
12905500fa51SJiri Olsa void ftrace_free_filter(struct ftrace_ops *ops)
12915500fa51SJiri Olsa {
1292f04f24fbSMasami Hiramatsu 	ftrace_ops_init(ops);
129333b7f99cSSteven Rostedt (Red Hat) 	free_ftrace_hash(ops->func_hash->filter_hash);
129433b7f99cSSteven Rostedt (Red Hat) 	free_ftrace_hash(ops->func_hash->notrace_hash);
12955500fa51SJiri Olsa }
12968be9fbd5SMark Rutland EXPORT_SYMBOL_GPL(ftrace_free_filter);
12975500fa51SJiri Olsa 
129833dc9b12SSteven Rostedt static struct ftrace_hash *alloc_ftrace_hash(int size_bits)
129933dc9b12SSteven Rostedt {
130033dc9b12SSteven Rostedt 	struct ftrace_hash *hash;
130133dc9b12SSteven Rostedt 	int size;
130233dc9b12SSteven Rostedt 
130333dc9b12SSteven Rostedt 	hash = kzalloc(sizeof(*hash), GFP_KERNEL);
130433dc9b12SSteven Rostedt 	if (!hash)
130533dc9b12SSteven Rostedt 		return NULL;
130633dc9b12SSteven Rostedt 
130733dc9b12SSteven Rostedt 	size = 1 << size_bits;
130847b0edcbSThomas Meyer 	hash->buckets = kcalloc(size, sizeof(*hash->buckets), GFP_KERNEL);
130933dc9b12SSteven Rostedt 
131033dc9b12SSteven Rostedt 	if (!hash->buckets) {
131133dc9b12SSteven Rostedt 		kfree(hash);
131233dc9b12SSteven Rostedt 		return NULL;
131333dc9b12SSteven Rostedt 	}
131433dc9b12SSteven Rostedt 
131533dc9b12SSteven Rostedt 	hash->size_bits = size_bits;
131633dc9b12SSteven Rostedt 
131733dc9b12SSteven Rostedt 	return hash;
131833dc9b12SSteven Rostedt }
131933dc9b12SSteven Rostedt 
1320673feb9dSSteven Rostedt (VMware) 
1321673feb9dSSteven Rostedt (VMware) static int ftrace_add_mod(struct trace_array *tr,
1322673feb9dSSteven Rostedt (VMware) 			  const char *func, const char *module,
1323673feb9dSSteven Rostedt (VMware) 			  int enable)
1324673feb9dSSteven Rostedt (VMware) {
1325673feb9dSSteven Rostedt (VMware) 	struct ftrace_mod_load *ftrace_mod;
1326673feb9dSSteven Rostedt (VMware) 	struct list_head *mod_head = enable ? &tr->mod_trace : &tr->mod_notrace;
1327673feb9dSSteven Rostedt (VMware) 
1328673feb9dSSteven Rostedt (VMware) 	ftrace_mod = kzalloc(sizeof(*ftrace_mod), GFP_KERNEL);
1329673feb9dSSteven Rostedt (VMware) 	if (!ftrace_mod)
1330673feb9dSSteven Rostedt (VMware) 		return -ENOMEM;
1331673feb9dSSteven Rostedt (VMware) 
133219ba6c8aSXiu Jianfeng 	INIT_LIST_HEAD(&ftrace_mod->list);
1333673feb9dSSteven Rostedt (VMware) 	ftrace_mod->func = kstrdup(func, GFP_KERNEL);
1334673feb9dSSteven Rostedt (VMware) 	ftrace_mod->module = kstrdup(module, GFP_KERNEL);
1335673feb9dSSteven Rostedt (VMware) 	ftrace_mod->enable = enable;
1336673feb9dSSteven Rostedt (VMware) 
1337673feb9dSSteven Rostedt (VMware) 	if (!ftrace_mod->func || !ftrace_mod->module)
1338673feb9dSSteven Rostedt (VMware) 		goto out_free;
1339673feb9dSSteven Rostedt (VMware) 
1340673feb9dSSteven Rostedt (VMware) 	list_add(&ftrace_mod->list, mod_head);
1341673feb9dSSteven Rostedt (VMware) 
1342673feb9dSSteven Rostedt (VMware) 	return 0;
1343673feb9dSSteven Rostedt (VMware) 
1344673feb9dSSteven Rostedt (VMware)  out_free:
1345673feb9dSSteven Rostedt (VMware) 	free_ftrace_mod(ftrace_mod);
1346673feb9dSSteven Rostedt (VMware) 
1347673feb9dSSteven Rostedt (VMware) 	return -ENOMEM;
1348673feb9dSSteven Rostedt (VMware) }
1349673feb9dSSteven Rostedt (VMware) 
135033dc9b12SSteven Rostedt static struct ftrace_hash *
135133dc9b12SSteven Rostedt alloc_and_copy_ftrace_hash(int size_bits, struct ftrace_hash *hash)
135233dc9b12SSteven Rostedt {
135333dc9b12SSteven Rostedt 	struct ftrace_func_entry *entry;
135433dc9b12SSteven Rostedt 	struct ftrace_hash *new_hash;
135533dc9b12SSteven Rostedt 	int size;
135633dc9b12SSteven Rostedt 	int i;
135733dc9b12SSteven Rostedt 
135833dc9b12SSteven Rostedt 	new_hash = alloc_ftrace_hash(size_bits);
135933dc9b12SSteven Rostedt 	if (!new_hash)
136033dc9b12SSteven Rostedt 		return NULL;
136133dc9b12SSteven Rostedt 
13628c08f0d5SSteven Rostedt (VMware) 	if (hash)
13638c08f0d5SSteven Rostedt (VMware) 		new_hash->flags = hash->flags;
13648c08f0d5SSteven Rostedt (VMware) 
136533dc9b12SSteven Rostedt 	/* Empty hash? */
136606a51d93SSteven Rostedt 	if (ftrace_hash_empty(hash))
136733dc9b12SSteven Rostedt 		return new_hash;
136833dc9b12SSteven Rostedt 
136933dc9b12SSteven Rostedt 	size = 1 << hash->size_bits;
137033dc9b12SSteven Rostedt 	for (i = 0; i < size; i++) {
1371b67bfe0dSSasha Levin 		hlist_for_each_entry(entry, &hash->buckets[i], hlist) {
1372d05cb470SSteven Rostedt (Google) 			if (add_hash_entry(new_hash, entry->ip) == NULL)
137333dc9b12SSteven Rostedt 				goto free_hash;
137433dc9b12SSteven Rostedt 		}
137533dc9b12SSteven Rostedt 	}
137633dc9b12SSteven Rostedt 
137733dc9b12SSteven Rostedt 	FTRACE_WARN_ON(new_hash->count != hash->count);
137833dc9b12SSteven Rostedt 
137933dc9b12SSteven Rostedt 	return new_hash;
138033dc9b12SSteven Rostedt 
138133dc9b12SSteven Rostedt  free_hash:
138233dc9b12SSteven Rostedt 	free_ftrace_hash(new_hash);
138333dc9b12SSteven Rostedt 	return NULL;
138433dc9b12SSteven Rostedt }
138533dc9b12SSteven Rostedt 
138641fb61c2SSteven Rostedt static void
138784261912SSteven Rostedt (Red Hat) ftrace_hash_rec_disable_modify(struct ftrace_ops *ops, int filter_hash);
138841fb61c2SSteven Rostedt static void
138984261912SSteven Rostedt (Red Hat) ftrace_hash_rec_enable_modify(struct ftrace_ops *ops, int filter_hash);
139041fb61c2SSteven Rostedt 
1391f8b8be8aSMasami Hiramatsu static int ftrace_hash_ipmodify_update(struct ftrace_ops *ops,
1392f8b8be8aSMasami Hiramatsu 				       struct ftrace_hash *new_hash);
1393f8b8be8aSMasami Hiramatsu 
1394714641c3SSteven Rostedt (VMware) static struct ftrace_hash *dup_hash(struct ftrace_hash *src, int size)
139533dc9b12SSteven Rostedt {
139633dc9b12SSteven Rostedt 	struct ftrace_func_entry *entry;
139707fd5515SSteven Rostedt 	struct ftrace_hash *new_hash;
1398714641c3SSteven Rostedt (VMware) 	struct hlist_head *hhd;
1399714641c3SSteven Rostedt (VMware) 	struct hlist_node *tn;
140033dc9b12SSteven Rostedt 	int bits = 0;
140133dc9b12SSteven Rostedt 	int i;
140233dc9b12SSteven Rostedt 
140333dc9b12SSteven Rostedt 	/*
1404be493132SSteven Rostedt (VMware) 	 * Use around half the size (max bit of it), but
1405be493132SSteven Rostedt (VMware) 	 * a minimum of 2 is fine (as size of 0 or 1 both give 1 for bits).
140633dc9b12SSteven Rostedt 	 */
1407be493132SSteven Rostedt (VMware) 	bits = fls(size / 2);
140833dc9b12SSteven Rostedt 
140933dc9b12SSteven Rostedt 	/* Don't allocate too much */
141033dc9b12SSteven Rostedt 	if (bits > FTRACE_HASH_MAX_BITS)
141133dc9b12SSteven Rostedt 		bits = FTRACE_HASH_MAX_BITS;
141233dc9b12SSteven Rostedt 
141307fd5515SSteven Rostedt 	new_hash = alloc_ftrace_hash(bits);
141407fd5515SSteven Rostedt 	if (!new_hash)
14153e278c0dSNamhyung Kim 		return NULL;
141633dc9b12SSteven Rostedt 
14178c08f0d5SSteven Rostedt (VMware) 	new_hash->flags = src->flags;
14188c08f0d5SSteven Rostedt (VMware) 
141933dc9b12SSteven Rostedt 	size = 1 << src->size_bits;
142033dc9b12SSteven Rostedt 	for (i = 0; i < size; i++) {
142133dc9b12SSteven Rostedt 		hhd = &src->buckets[i];
1422b67bfe0dSSasha Levin 		hlist_for_each_entry_safe(entry, tn, hhd, hlist) {
142333dc9b12SSteven Rostedt 			remove_hash_entry(src, entry);
142407fd5515SSteven Rostedt 			__add_hash_entry(new_hash, entry);
142533dc9b12SSteven Rostedt 		}
142633dc9b12SSteven Rostedt 	}
14273e278c0dSNamhyung Kim 	return new_hash;
14283e278c0dSNamhyung Kim }
14293e278c0dSNamhyung Kim 
1430714641c3SSteven Rostedt (VMware) static struct ftrace_hash *
1431714641c3SSteven Rostedt (VMware) __ftrace_hash_move(struct ftrace_hash *src)
1432714641c3SSteven Rostedt (VMware) {
1433714641c3SSteven Rostedt (VMware) 	int size = src->count;
1434714641c3SSteven Rostedt (VMware) 
1435714641c3SSteven Rostedt (VMware) 	/*
1436714641c3SSteven Rostedt (VMware) 	 * If the new source is empty, just return the empty_hash.
1437714641c3SSteven Rostedt (VMware) 	 */
1438714641c3SSteven Rostedt (VMware) 	if (ftrace_hash_empty(src))
1439714641c3SSteven Rostedt (VMware) 		return EMPTY_HASH;
1440714641c3SSteven Rostedt (VMware) 
1441714641c3SSteven Rostedt (VMware) 	return dup_hash(src, size);
1442714641c3SSteven Rostedt (VMware) }
1443714641c3SSteven Rostedt (VMware) 
14443e278c0dSNamhyung Kim static int
14453e278c0dSNamhyung Kim ftrace_hash_move(struct ftrace_ops *ops, int enable,
14463e278c0dSNamhyung Kim 		 struct ftrace_hash **dst, struct ftrace_hash *src)
14473e278c0dSNamhyung Kim {
14483e278c0dSNamhyung Kim 	struct ftrace_hash *new_hash;
14493e278c0dSNamhyung Kim 	int ret;
14503e278c0dSNamhyung Kim 
14513e278c0dSNamhyung Kim 	/* Reject setting notrace hash on IPMODIFY ftrace_ops */
14523e278c0dSNamhyung Kim 	if (ops->flags & FTRACE_OPS_FL_IPMODIFY && !enable)
14533e278c0dSNamhyung Kim 		return -EINVAL;
14543e278c0dSNamhyung Kim 
14553e278c0dSNamhyung Kim 	new_hash = __ftrace_hash_move(src);
14563e278c0dSNamhyung Kim 	if (!new_hash)
14573e278c0dSNamhyung Kim 		return -ENOMEM;
14583e278c0dSNamhyung Kim 
1459f8b8be8aSMasami Hiramatsu 	/* Make sure this can be applied if it is IPMODIFY ftrace_ops */
1460f8b8be8aSMasami Hiramatsu 	if (enable) {
1461f8b8be8aSMasami Hiramatsu 		/* IPMODIFY should be updated only when filter_hash updating */
1462f8b8be8aSMasami Hiramatsu 		ret = ftrace_hash_ipmodify_update(ops, new_hash);
1463f8b8be8aSMasami Hiramatsu 		if (ret < 0) {
1464f8b8be8aSMasami Hiramatsu 			free_ftrace_hash(new_hash);
1465f8b8be8aSMasami Hiramatsu 			return ret;
1466f8b8be8aSMasami Hiramatsu 		}
1467f8b8be8aSMasami Hiramatsu 	}
1468f8b8be8aSMasami Hiramatsu 
14695c27c775SMasami Hiramatsu 	/*
14705c27c775SMasami Hiramatsu 	 * Remove the current set, update the hash and add
14715c27c775SMasami Hiramatsu 	 * them back.
14725c27c775SMasami Hiramatsu 	 */
147384261912SSteven Rostedt (Red Hat) 	ftrace_hash_rec_disable_modify(ops, enable);
14745c27c775SMasami Hiramatsu 
147507fd5515SSteven Rostedt 	rcu_assign_pointer(*dst, new_hash);
147607fd5515SSteven Rostedt 
147784261912SSteven Rostedt (Red Hat) 	ftrace_hash_rec_enable_modify(ops, enable);
147841fb61c2SSteven Rostedt 
14795c27c775SMasami Hiramatsu 	return 0;
148033dc9b12SSteven Rostedt }
148133dc9b12SSteven Rostedt 
1482fef5aeeeSSteven Rostedt (Red Hat) static bool hash_contains_ip(unsigned long ip,
1483fef5aeeeSSteven Rostedt (Red Hat) 			     struct ftrace_ops_hash *hash)
1484fef5aeeeSSteven Rostedt (Red Hat) {
1485fef5aeeeSSteven Rostedt (Red Hat) 	/*
1486fef5aeeeSSteven Rostedt (Red Hat) 	 * The function record is a match if it exists in the filter
1487fdda88d3SQiujun Huang 	 * hash and not in the notrace hash. Note, an empty hash is
1488fef5aeeeSSteven Rostedt (Red Hat) 	 * considered a match for the filter hash, but an empty
1489fef5aeeeSSteven Rostedt (Red Hat) 	 * notrace hash is considered not in the notrace hash.
1490fef5aeeeSSteven Rostedt (Red Hat) 	 */
1491fef5aeeeSSteven Rostedt (Red Hat) 	return (ftrace_hash_empty(hash->filter_hash) ||
14922b2c279cSSteven Rostedt (VMware) 		__ftrace_lookup_ip(hash->filter_hash, ip)) &&
1493fef5aeeeSSteven Rostedt (Red Hat) 		(ftrace_hash_empty(hash->notrace_hash) ||
14942b2c279cSSteven Rostedt (VMware) 		 !__ftrace_lookup_ip(hash->notrace_hash, ip));
1495fef5aeeeSSteven Rostedt (Red Hat) }
1496fef5aeeeSSteven Rostedt (Red Hat) 
1497265c831cSSteven Rostedt /*
1498b848914cSSteven Rostedt  * Test the hashes for this ops to see if we want to call
1499b848914cSSteven Rostedt  * the ops->func or not.
1500b848914cSSteven Rostedt  *
1501b848914cSSteven Rostedt  * It's a match if the ip is in the ops->filter_hash or
1502b848914cSSteven Rostedt  * the filter_hash does not exist or is empty,
1503b848914cSSteven Rostedt  *  AND
1504b848914cSSteven Rostedt  * the ip is not in the ops->notrace_hash.
1505cdbe61bfSSteven Rostedt  *
1506cdbe61bfSSteven Rostedt  * This needs to be called with preemption disabled as
150774401729SPaul E. McKenney  * the hashes are freed with call_rcu().
1508b848914cSSteven Rostedt  */
15093306fc4aSSteven Rostedt (VMware) int
1510195a8afcSSteven Rostedt (Red Hat) ftrace_ops_test(struct ftrace_ops *ops, unsigned long ip, void *regs)
1511b848914cSSteven Rostedt {
1512fef5aeeeSSteven Rostedt (Red Hat) 	struct ftrace_ops_hash hash;
1513b848914cSSteven Rostedt 	int ret;
1514b848914cSSteven Rostedt 
1515195a8afcSSteven Rostedt (Red Hat) #ifdef CONFIG_DYNAMIC_FTRACE_WITH_REGS
1516195a8afcSSteven Rostedt (Red Hat) 	/*
1517195a8afcSSteven Rostedt (Red Hat) 	 * There's a small race when adding ops that the ftrace handler
1518195a8afcSSteven Rostedt (Red Hat) 	 * that wants regs, may be called without them. We can not
1519195a8afcSSteven Rostedt (Red Hat) 	 * allow that handler to be called if regs is NULL.
1520195a8afcSSteven Rostedt (Red Hat) 	 */
1521195a8afcSSteven Rostedt (Red Hat) 	if (regs == NULL && (ops->flags & FTRACE_OPS_FL_SAVE_REGS))
1522195a8afcSSteven Rostedt (Red Hat) 		return 0;
1523195a8afcSSteven Rostedt (Red Hat) #endif
1524195a8afcSSteven Rostedt (Red Hat) 
1525f86f4180SChunyan Zhang 	rcu_assign_pointer(hash.filter_hash, ops->func_hash->filter_hash);
1526f86f4180SChunyan Zhang 	rcu_assign_pointer(hash.notrace_hash, ops->func_hash->notrace_hash);
1527b848914cSSteven Rostedt 
1528fef5aeeeSSteven Rostedt (Red Hat) 	if (hash_contains_ip(ip, &hash))
1529b848914cSSteven Rostedt 		ret = 1;
1530b848914cSSteven Rostedt 	else
1531b848914cSSteven Rostedt 		ret = 0;
1532b848914cSSteven Rostedt 
1533b848914cSSteven Rostedt 	return ret;
1534b848914cSSteven Rostedt }
1535b848914cSSteven Rostedt 
1536b848914cSSteven Rostedt /*
1537265c831cSSteven Rostedt  * This is a double for. Do not use 'break' to break out of the loop,
1538265c831cSSteven Rostedt  * you must use a goto.
1539265c831cSSteven Rostedt  */
1540265c831cSSteven Rostedt #define do_for_each_ftrace_rec(pg, rec)					\
1541265c831cSSteven Rostedt 	for (pg = ftrace_pages_start; pg; pg = pg->next) {		\
1542265c831cSSteven Rostedt 		int _____i;						\
1543265c831cSSteven Rostedt 		for (_____i = 0; _____i < pg->index; _____i++) {	\
1544265c831cSSteven Rostedt 			rec = &pg->records[_____i];
1545265c831cSSteven Rostedt 
1546265c831cSSteven Rostedt #define while_for_each_ftrace_rec()		\
1547265c831cSSteven Rostedt 		}				\
1548265c831cSSteven Rostedt 	}
1549ecea656dSAbhishek Sagar 
15505855feadSSteven Rostedt 
15515855feadSSteven Rostedt static int ftrace_cmp_recs(const void *a, const void *b)
15525855feadSSteven Rostedt {
1553a650e02aSSteven Rostedt 	const struct dyn_ftrace *key = a;
1554a650e02aSSteven Rostedt 	const struct dyn_ftrace *rec = b;
15555855feadSSteven Rostedt 
1556a650e02aSSteven Rostedt 	if (key->flags < rec->ip)
15575855feadSSteven Rostedt 		return -1;
1558a650e02aSSteven Rostedt 	if (key->ip >= rec->ip + MCOUNT_INSN_SIZE)
1559a650e02aSSteven Rostedt 		return 1;
1560a650e02aSSteven Rostedt 	return 0;
1561a650e02aSSteven Rostedt }
1562a650e02aSSteven Rostedt 
15637e16f581SSteven Rostedt (VMware) static struct dyn_ftrace *lookup_rec(unsigned long start, unsigned long end)
15647e16f581SSteven Rostedt (VMware) {
15657e16f581SSteven Rostedt (VMware) 	struct ftrace_page *pg;
15667e16f581SSteven Rostedt (VMware) 	struct dyn_ftrace *rec = NULL;
15677e16f581SSteven Rostedt (VMware) 	struct dyn_ftrace key;
15687e16f581SSteven Rostedt (VMware) 
15697e16f581SSteven Rostedt (VMware) 	key.ip = start;
15707e16f581SSteven Rostedt (VMware) 	key.flags = end;	/* overload flags, as it is unsigned long */
15717e16f581SSteven Rostedt (VMware) 
15727e16f581SSteven Rostedt (VMware) 	for (pg = ftrace_pages_start; pg; pg = pg->next) {
1573ee92fa44SChen Zhongjin 		if (pg->index == 0 ||
1574ee92fa44SChen Zhongjin 		    end < pg->records[0].ip ||
15757e16f581SSteven Rostedt (VMware) 		    start >= (pg->records[pg->index - 1].ip + MCOUNT_INSN_SIZE))
15767e16f581SSteven Rostedt (VMware) 			continue;
15777e16f581SSteven Rostedt (VMware) 		rec = bsearch(&key, pg->records, pg->index,
15787e16f581SSteven Rostedt (VMware) 			      sizeof(struct dyn_ftrace),
15797e16f581SSteven Rostedt (VMware) 			      ftrace_cmp_recs);
1580d9815bffSArtem Savkov 		if (rec)
1581d9815bffSArtem Savkov 			break;
15827e16f581SSteven Rostedt (VMware) 	}
15837e16f581SSteven Rostedt (VMware) 	return rec;
15847e16f581SSteven Rostedt (VMware) }
15857e16f581SSteven Rostedt (VMware) 
158604cf31a7SMichael Ellerman /**
158704cf31a7SMichael Ellerman  * ftrace_location_range - return the first address of a traced location
158804cf31a7SMichael Ellerman  *	if it touches the given ip range
158904cf31a7SMichael Ellerman  * @start: start of range to search.
159004cf31a7SMichael Ellerman  * @end: end of range to search (inclusive). @end points to the last byte
159104cf31a7SMichael Ellerman  *	to check.
159204cf31a7SMichael Ellerman  *
1593d1530413SRandy Dunlap  * Returns: rec->ip if the related ftrace location is a least partly within
159404cf31a7SMichael Ellerman  * the given address range. That is, the first address of the instruction
159504cf31a7SMichael Ellerman  * that is either a NOP or call to the function tracer. It checks the ftrace
159604cf31a7SMichael Ellerman  * internal tables to determine if the address belongs or not.
159704cf31a7SMichael Ellerman  */
159804cf31a7SMichael Ellerman unsigned long ftrace_location_range(unsigned long start, unsigned long end)
1599a650e02aSSteven Rostedt {
1600a650e02aSSteven Rostedt 	struct dyn_ftrace *rec;
1601e60b613dSZheng Yejian 	unsigned long ip = 0;
1602a650e02aSSteven Rostedt 
1603e60b613dSZheng Yejian 	rcu_read_lock();
16047e16f581SSteven Rostedt (VMware) 	rec = lookup_rec(start, end);
1605a650e02aSSteven Rostedt 	if (rec)
1606e60b613dSZheng Yejian 		ip = rec->ip;
1607e60b613dSZheng Yejian 	rcu_read_unlock();
1608a650e02aSSteven Rostedt 
1609e60b613dSZheng Yejian 	return ip;
16105855feadSSteven Rostedt }
16115855feadSSteven Rostedt 
1612c88fd863SSteven Rostedt /**
1613aebfd125SPeter Zijlstra  * ftrace_location - return the ftrace location
1614c88fd863SSteven Rostedt  * @ip: the instruction pointer to check
1615c88fd863SSteven Rostedt  *
1616d1530413SRandy Dunlap  * Returns:
1617d1530413SRandy Dunlap  * * If @ip matches the ftrace location, return @ip.
1618d1530413SRandy Dunlap  * * If @ip matches sym+0, return sym's ftrace location.
1619d1530413SRandy Dunlap  * * Otherwise, return 0.
1620c88fd863SSteven Rostedt  */
1621f0cf973aSSteven Rostedt unsigned long ftrace_location(unsigned long ip)
1622c88fd863SSteven Rostedt {
1623e60b613dSZheng Yejian 	unsigned long loc;
1624aebfd125SPeter Zijlstra 	unsigned long offset;
1625aebfd125SPeter Zijlstra 	unsigned long size;
1626aebfd125SPeter Zijlstra 
1627e60b613dSZheng Yejian 	loc = ftrace_location_range(ip, ip);
1628e60b613dSZheng Yejian 	if (!loc) {
1629aebfd125SPeter Zijlstra 		if (!kallsyms_lookup_size_offset(ip, &size, &offset))
1630aebfd125SPeter Zijlstra 			goto out;
1631aebfd125SPeter Zijlstra 
1632aebfd125SPeter Zijlstra 		/* map sym+0 to __fentry__ */
1633aebfd125SPeter Zijlstra 		if (!offset)
1634e60b613dSZheng Yejian 			loc = ftrace_location_range(ip, ip + size - 1);
1635aebfd125SPeter Zijlstra 	}
1636aebfd125SPeter Zijlstra 
1637aebfd125SPeter Zijlstra out:
1638e60b613dSZheng Yejian 	return loc;
16395855feadSSteven Rostedt }
1640c88fd863SSteven Rostedt 
1641a650e02aSSteven Rostedt /**
1642a650e02aSSteven Rostedt  * ftrace_text_reserved - return true if range contains an ftrace location
1643a650e02aSSteven Rostedt  * @start: start of range to search
1644a650e02aSSteven Rostedt  * @end: end of range to search (inclusive). @end points to the last byte to check.
1645a650e02aSSteven Rostedt  *
1646d1530413SRandy Dunlap  * Returns: 1 if @start and @end contains a ftrace location.
1647a650e02aSSteven Rostedt  * That is, the instruction that is either a NOP or call to
1648a650e02aSSteven Rostedt  * the function tracer. It checks the ftrace internal tables to
1649a650e02aSSteven Rostedt  * determine if the address belongs or not.
1650a650e02aSSteven Rostedt  */
1651d88471cbSSasha Levin int ftrace_text_reserved(const void *start, const void *end)
1652a650e02aSSteven Rostedt {
1653f0cf973aSSteven Rostedt 	unsigned long ret;
1654f0cf973aSSteven Rostedt 
1655f0cf973aSSteven Rostedt 	ret = ftrace_location_range((unsigned long)start,
1656a650e02aSSteven Rostedt 				    (unsigned long)end);
1657f0cf973aSSteven Rostedt 
1658f0cf973aSSteven Rostedt 	return (int)!!ret;
1659c88fd863SSteven Rostedt }
1660c88fd863SSteven Rostedt 
16614fbb48cbSSteven Rostedt (Red Hat) /* Test if ops registered to this rec needs regs */
16624fbb48cbSSteven Rostedt (Red Hat) static bool test_rec_ops_needs_regs(struct dyn_ftrace *rec)
16634fbb48cbSSteven Rostedt (Red Hat) {
16644fbb48cbSSteven Rostedt (Red Hat) 	struct ftrace_ops *ops;
16654fbb48cbSSteven Rostedt (Red Hat) 	bool keep_regs = false;
16664fbb48cbSSteven Rostedt (Red Hat) 
16674fbb48cbSSteven Rostedt (Red Hat) 	for (ops = ftrace_ops_list;
16684fbb48cbSSteven Rostedt (Red Hat) 	     ops != &ftrace_list_end; ops = ops->next) {
16694fbb48cbSSteven Rostedt (Red Hat) 		/* pass rec in as regs to have non-NULL val */
16704fbb48cbSSteven Rostedt (Red Hat) 		if (ftrace_ops_test(ops, rec->ip, rec)) {
16714fbb48cbSSteven Rostedt (Red Hat) 			if (ops->flags & FTRACE_OPS_FL_SAVE_REGS) {
16724fbb48cbSSteven Rostedt (Red Hat) 				keep_regs = true;
16734fbb48cbSSteven Rostedt (Red Hat) 				break;
16744fbb48cbSSteven Rostedt (Red Hat) 			}
16754fbb48cbSSteven Rostedt (Red Hat) 		}
16764fbb48cbSSteven Rostedt (Red Hat) 	}
16774fbb48cbSSteven Rostedt (Red Hat) 
16784fbb48cbSSteven Rostedt (Red Hat) 	return  keep_regs;
16794fbb48cbSSteven Rostedt (Red Hat) }
16804fbb48cbSSteven Rostedt (Red Hat) 
1681a124692bSCheng Jian static struct ftrace_ops *
1682a124692bSCheng Jian ftrace_find_tramp_ops_any(struct dyn_ftrace *rec);
1683a124692bSCheng Jian static struct ftrace_ops *
16844c75b0ffSNaveen N. Rao ftrace_find_tramp_ops_any_other(struct dyn_ftrace *rec, struct ftrace_ops *op_exclude);
16854c75b0ffSNaveen N. Rao static struct ftrace_ops *
1686a124692bSCheng Jian ftrace_find_tramp_ops_next(struct dyn_ftrace *rec, struct ftrace_ops *ops);
1687a124692bSCheng Jian 
1688cf04f2d5SSteven Rostedt (Google) static bool skip_record(struct dyn_ftrace *rec)
1689cf04f2d5SSteven Rostedt (Google) {
1690cf04f2d5SSteven Rostedt (Google) 	/*
1691cf04f2d5SSteven Rostedt (Google) 	 * At boot up, weak functions are set to disable. Function tracing
1692cf04f2d5SSteven Rostedt (Google) 	 * can be enabled before they are, and they still need to be disabled now.
1693cf04f2d5SSteven Rostedt (Google) 	 * If the record is disabled, still continue if it is marked as already
1694cf04f2d5SSteven Rostedt (Google) 	 * enabled (this is needed to keep the accounting working).
1695cf04f2d5SSteven Rostedt (Google) 	 */
1696cf04f2d5SSteven Rostedt (Google) 	return rec->flags & FTRACE_FL_DISABLED &&
1697cf04f2d5SSteven Rostedt (Google) 		!(rec->flags & FTRACE_FL_ENABLED);
1698cf04f2d5SSteven Rostedt (Google) }
1699cf04f2d5SSteven Rostedt (Google) 
170084b6d3e6SJiri Olsa static bool __ftrace_hash_rec_update(struct ftrace_ops *ops,
1701ed926f9bSSteven Rostedt 				     int filter_hash,
1702ed926f9bSSteven Rostedt 				     bool inc)
1703ed926f9bSSteven Rostedt {
1704ed926f9bSSteven Rostedt 	struct ftrace_hash *hash;
1705ed926f9bSSteven Rostedt 	struct ftrace_hash *other_hash;
1706ed926f9bSSteven Rostedt 	struct ftrace_page *pg;
1707ed926f9bSSteven Rostedt 	struct dyn_ftrace *rec;
170884b6d3e6SJiri Olsa 	bool update = false;
1709ed926f9bSSteven Rostedt 	int count = 0;
17108c08f0d5SSteven Rostedt (VMware) 	int all = false;
1711ed926f9bSSteven Rostedt 
1712ed926f9bSSteven Rostedt 	/* Only update if the ops has been registered */
1713ed926f9bSSteven Rostedt 	if (!(ops->flags & FTRACE_OPS_FL_ENABLED))
171484b6d3e6SJiri Olsa 		return false;
1715ed926f9bSSteven Rostedt 
1716ed926f9bSSteven Rostedt 	/*
1717ed926f9bSSteven Rostedt 	 * In the filter_hash case:
1718ed926f9bSSteven Rostedt 	 *   If the count is zero, we update all records.
1719ed926f9bSSteven Rostedt 	 *   Otherwise we just update the items in the hash.
1720ed926f9bSSteven Rostedt 	 *
1721ed926f9bSSteven Rostedt 	 * In the notrace_hash case:
1722ed926f9bSSteven Rostedt 	 *   We enable the update in the hash.
1723ed926f9bSSteven Rostedt 	 *   As disabling notrace means enabling the tracing,
1724ed926f9bSSteven Rostedt 	 *   and enabling notrace means disabling, the inc variable
1725ed926f9bSSteven Rostedt 	 *   gets inversed.
1726ed926f9bSSteven Rostedt 	 */
1727ed926f9bSSteven Rostedt 	if (filter_hash) {
172833b7f99cSSteven Rostedt (Red Hat) 		hash = ops->func_hash->filter_hash;
172933b7f99cSSteven Rostedt (Red Hat) 		other_hash = ops->func_hash->notrace_hash;
173006a51d93SSteven Rostedt 		if (ftrace_hash_empty(hash))
17318c08f0d5SSteven Rostedt (VMware) 			all = true;
1732ed926f9bSSteven Rostedt 	} else {
1733ed926f9bSSteven Rostedt 		inc = !inc;
173433b7f99cSSteven Rostedt (Red Hat) 		hash = ops->func_hash->notrace_hash;
173533b7f99cSSteven Rostedt (Red Hat) 		other_hash = ops->func_hash->filter_hash;
1736ed926f9bSSteven Rostedt 		/*
1737ed926f9bSSteven Rostedt 		 * If the notrace hash has no items,
1738ed926f9bSSteven Rostedt 		 * then there's nothing to do.
1739ed926f9bSSteven Rostedt 		 */
174006a51d93SSteven Rostedt 		if (ftrace_hash_empty(hash))
174184b6d3e6SJiri Olsa 			return false;
1742ed926f9bSSteven Rostedt 	}
1743ed926f9bSSteven Rostedt 
1744ed926f9bSSteven Rostedt 	do_for_each_ftrace_rec(pg, rec) {
1745ed926f9bSSteven Rostedt 		int in_other_hash = 0;
1746ed926f9bSSteven Rostedt 		int in_hash = 0;
1747ed926f9bSSteven Rostedt 		int match = 0;
1748ed926f9bSSteven Rostedt 
1749cf04f2d5SSteven Rostedt (Google) 		if (skip_record(rec))
1750b7ffffbbSSteven Rostedt (Red Hat) 			continue;
1751b7ffffbbSSteven Rostedt (Red Hat) 
1752ed926f9bSSteven Rostedt 		if (all) {
1753ed926f9bSSteven Rostedt 			/*
1754ed926f9bSSteven Rostedt 			 * Only the filter_hash affects all records.
1755ed926f9bSSteven Rostedt 			 * Update if the record is not in the notrace hash.
1756ed926f9bSSteven Rostedt 			 */
1757b848914cSSteven Rostedt 			if (!other_hash || !ftrace_lookup_ip(other_hash, rec->ip))
1758ed926f9bSSteven Rostedt 				match = 1;
1759ed926f9bSSteven Rostedt 		} else {
176006a51d93SSteven Rostedt 			in_hash = !!ftrace_lookup_ip(hash, rec->ip);
176106a51d93SSteven Rostedt 			in_other_hash = !!ftrace_lookup_ip(other_hash, rec->ip);
1762ed926f9bSSteven Rostedt 
1763ed926f9bSSteven Rostedt 			/*
176419eab4a4SSteven Rostedt (Red Hat) 			 * If filter_hash is set, we want to match all functions
176519eab4a4SSteven Rostedt (Red Hat) 			 * that are in the hash but not in the other hash.
1766ed926f9bSSteven Rostedt 			 *
176719eab4a4SSteven Rostedt (Red Hat) 			 * If filter_hash is not set, then we are decrementing.
176819eab4a4SSteven Rostedt (Red Hat) 			 * That means we match anything that is in the hash
176919eab4a4SSteven Rostedt (Red Hat) 			 * and also in the other_hash. That is, we need to turn
177019eab4a4SSteven Rostedt (Red Hat) 			 * off functions in the other hash because they are disabled
177119eab4a4SSteven Rostedt (Red Hat) 			 * by this hash.
1772ed926f9bSSteven Rostedt 			 */
1773ed926f9bSSteven Rostedt 			if (filter_hash && in_hash && !in_other_hash)
1774ed926f9bSSteven Rostedt 				match = 1;
1775ed926f9bSSteven Rostedt 			else if (!filter_hash && in_hash &&
177606a51d93SSteven Rostedt 				 (in_other_hash || ftrace_hash_empty(other_hash)))
1777ed926f9bSSteven Rostedt 				match = 1;
1778ed926f9bSSteven Rostedt 		}
1779ed926f9bSSteven Rostedt 		if (!match)
1780ed926f9bSSteven Rostedt 			continue;
1781ed926f9bSSteven Rostedt 
1782ed926f9bSSteven Rostedt 		if (inc) {
1783ed926f9bSSteven Rostedt 			rec->flags++;
17840376bde1SSteven Rostedt (Red Hat) 			if (FTRACE_WARN_ON(ftrace_rec_count(rec) == FTRACE_REF_MAX))
178584b6d3e6SJiri Olsa 				return false;
178679922b80SSteven Rostedt (Red Hat) 
1787763e34e7SSteven Rostedt (VMware) 			if (ops->flags & FTRACE_OPS_FL_DIRECT)
1788763e34e7SSteven Rostedt (VMware) 				rec->flags |= FTRACE_FL_DIRECT;
1789763e34e7SSteven Rostedt (VMware) 
179079922b80SSteven Rostedt (Red Hat) 			/*
179179922b80SSteven Rostedt (Red Hat) 			 * If there's only a single callback registered to a
179279922b80SSteven Rostedt (Red Hat) 			 * function, and the ops has a trampoline registered
179379922b80SSteven Rostedt (Red Hat) 			 * for it, then we can call it directly.
179479922b80SSteven Rostedt (Red Hat) 			 */
1795fef5aeeeSSteven Rostedt (Red Hat) 			if (ftrace_rec_count(rec) == 1 && ops->trampoline)
179679922b80SSteven Rostedt (Red Hat) 				rec->flags |= FTRACE_FL_TRAMP;
1797fef5aeeeSSteven Rostedt (Red Hat) 			else
179879922b80SSteven Rostedt (Red Hat) 				/*
179979922b80SSteven Rostedt (Red Hat) 				 * If we are adding another function callback
180079922b80SSteven Rostedt (Red Hat) 				 * to this function, and the previous had a
1801bce0b6c5SSteven Rostedt (Red Hat) 				 * custom trampoline in use, then we need to go
1802bce0b6c5SSteven Rostedt (Red Hat) 				 * back to the default trampoline.
180379922b80SSteven Rostedt (Red Hat) 				 */
1804fef5aeeeSSteven Rostedt (Red Hat) 				rec->flags &= ~FTRACE_FL_TRAMP;
180579922b80SSteven Rostedt (Red Hat) 
180608f6fba5SSteven Rostedt 			/*
180708f6fba5SSteven Rostedt 			 * If any ops wants regs saved for this function
180808f6fba5SSteven Rostedt 			 * then all ops will get saved regs.
180908f6fba5SSteven Rostedt 			 */
181008f6fba5SSteven Rostedt 			if (ops->flags & FTRACE_OPS_FL_SAVE_REGS)
181108f6fba5SSteven Rostedt 				rec->flags |= FTRACE_FL_REGS;
1812ed926f9bSSteven Rostedt 		} else {
18130376bde1SSteven Rostedt (Red Hat) 			if (FTRACE_WARN_ON(ftrace_rec_count(rec) == 0))
181484b6d3e6SJiri Olsa 				return false;
1815ed926f9bSSteven Rostedt 			rec->flags--;
181679922b80SSteven Rostedt (Red Hat) 
18174fbb48cbSSteven Rostedt (Red Hat) 			/*
1818763e34e7SSteven Rostedt (VMware) 			 * Only the internal direct_ops should have the
1819763e34e7SSteven Rostedt (VMware) 			 * DIRECT flag set. Thus, if it is removing a
1820763e34e7SSteven Rostedt (VMware) 			 * function, then that function should no longer
1821763e34e7SSteven Rostedt (VMware) 			 * be direct.
1822763e34e7SSteven Rostedt (VMware) 			 */
1823763e34e7SSteven Rostedt (VMware) 			if (ops->flags & FTRACE_OPS_FL_DIRECT)
1824763e34e7SSteven Rostedt (VMware) 				rec->flags &= ~FTRACE_FL_DIRECT;
1825763e34e7SSteven Rostedt (VMware) 
1826763e34e7SSteven Rostedt (VMware) 			/*
18274fbb48cbSSteven Rostedt (Red Hat) 			 * If the rec had REGS enabled and the ops that is
18284fbb48cbSSteven Rostedt (Red Hat) 			 * being removed had REGS set, then see if there is
18294fbb48cbSSteven Rostedt (Red Hat) 			 * still any ops for this record that wants regs.
18304fbb48cbSSteven Rostedt (Red Hat) 			 * If not, we can stop recording them.
18314fbb48cbSSteven Rostedt (Red Hat) 			 */
18320376bde1SSteven Rostedt (Red Hat) 			if (ftrace_rec_count(rec) > 0 &&
18334fbb48cbSSteven Rostedt (Red Hat) 			    rec->flags & FTRACE_FL_REGS &&
18344fbb48cbSSteven Rostedt (Red Hat) 			    ops->flags & FTRACE_OPS_FL_SAVE_REGS) {
18354fbb48cbSSteven Rostedt (Red Hat) 				if (!test_rec_ops_needs_regs(rec))
18364fbb48cbSSteven Rostedt (Red Hat) 					rec->flags &= ~FTRACE_FL_REGS;
18374fbb48cbSSteven Rostedt (Red Hat) 			}
183879922b80SSteven Rostedt (Red Hat) 
183979922b80SSteven Rostedt (Red Hat) 			/*
1840a124692bSCheng Jian 			 * The TRAMP needs to be set only if rec count
1841a124692bSCheng Jian 			 * is decremented to one, and the ops that is
1842a124692bSCheng Jian 			 * left has a trampoline. As TRAMP can only be
1843a124692bSCheng Jian 			 * enabled if there is only a single ops attached
1844a124692bSCheng Jian 			 * to it.
1845fef5aeeeSSteven Rostedt (Red Hat) 			 */
1846a124692bSCheng Jian 			if (ftrace_rec_count(rec) == 1 &&
18474c75b0ffSNaveen N. Rao 			    ftrace_find_tramp_ops_any_other(rec, ops))
1848a124692bSCheng Jian 				rec->flags |= FTRACE_FL_TRAMP;
1849a124692bSCheng Jian 			else
1850fef5aeeeSSteven Rostedt (Red Hat) 				rec->flags &= ~FTRACE_FL_TRAMP;
1851fef5aeeeSSteven Rostedt (Red Hat) 
1852fef5aeeeSSteven Rostedt (Red Hat) 			/*
185379922b80SSteven Rostedt (Red Hat) 			 * flags will be cleared in ftrace_check_record()
185479922b80SSteven Rostedt (Red Hat) 			 * if rec count is zero.
185579922b80SSteven Rostedt (Red Hat) 			 */
1856ed926f9bSSteven Rostedt 		}
1857cbad0fb2SMark Rutland 
1858cbad0fb2SMark Rutland 		/*
1859cbad0fb2SMark Rutland 		 * If the rec has a single associated ops, and ops->func can be
1860cbad0fb2SMark Rutland 		 * called directly, allow the call site to call via the ops.
1861cbad0fb2SMark Rutland 		 */
1862cbad0fb2SMark Rutland 		if (IS_ENABLED(CONFIG_DYNAMIC_FTRACE_WITH_CALL_OPS) &&
1863cbad0fb2SMark Rutland 		    ftrace_rec_count(rec) == 1 &&
1864cbad0fb2SMark Rutland 		    ftrace_ops_get_func(ops) == ops->func)
1865cbad0fb2SMark Rutland 			rec->flags |= FTRACE_FL_CALL_OPS;
1866cbad0fb2SMark Rutland 		else
1867cbad0fb2SMark Rutland 			rec->flags &= ~FTRACE_FL_CALL_OPS;
1868cbad0fb2SMark Rutland 
1869ed926f9bSSteven Rostedt 		count++;
187084b6d3e6SJiri Olsa 
187184b6d3e6SJiri Olsa 		/* Must match FTRACE_UPDATE_CALLS in ftrace_modify_all_code() */
18727375dca1SSteven Rostedt (VMware) 		update |= ftrace_test_record(rec, true) != FTRACE_UPDATE_IGNORE;
187384b6d3e6SJiri Olsa 
1874ed926f9bSSteven Rostedt 		/* Shortcut, if we handled all records, we are done. */
1875ed926f9bSSteven Rostedt 		if (!all && count == hash->count)
187684b6d3e6SJiri Olsa 			return update;
1877ed926f9bSSteven Rostedt 	} while_for_each_ftrace_rec();
187884b6d3e6SJiri Olsa 
187984b6d3e6SJiri Olsa 	return update;
1880ed926f9bSSteven Rostedt }
1881ed926f9bSSteven Rostedt 
188284b6d3e6SJiri Olsa static bool ftrace_hash_rec_disable(struct ftrace_ops *ops,
1883ed926f9bSSteven Rostedt 				    int filter_hash)
1884ed926f9bSSteven Rostedt {
188584b6d3e6SJiri Olsa 	return __ftrace_hash_rec_update(ops, filter_hash, 0);
1886ed926f9bSSteven Rostedt }
1887ed926f9bSSteven Rostedt 
188884b6d3e6SJiri Olsa static bool ftrace_hash_rec_enable(struct ftrace_ops *ops,
1889ed926f9bSSteven Rostedt 				   int filter_hash)
1890ed926f9bSSteven Rostedt {
189184b6d3e6SJiri Olsa 	return __ftrace_hash_rec_update(ops, filter_hash, 1);
1892ed926f9bSSteven Rostedt }
1893ed926f9bSSteven Rostedt 
189484261912SSteven Rostedt (Red Hat) static void ftrace_hash_rec_update_modify(struct ftrace_ops *ops,
189584261912SSteven Rostedt (Red Hat) 					  int filter_hash, int inc)
189684261912SSteven Rostedt (Red Hat) {
189784261912SSteven Rostedt (Red Hat) 	struct ftrace_ops *op;
189884261912SSteven Rostedt (Red Hat) 
189984261912SSteven Rostedt (Red Hat) 	__ftrace_hash_rec_update(ops, filter_hash, inc);
190084261912SSteven Rostedt (Red Hat) 
190184261912SSteven Rostedt (Red Hat) 	if (ops->func_hash != &global_ops.local_hash)
190284261912SSteven Rostedt (Red Hat) 		return;
190384261912SSteven Rostedt (Red Hat) 
190484261912SSteven Rostedt (Red Hat) 	/*
190584261912SSteven Rostedt (Red Hat) 	 * If the ops shares the global_ops hash, then we need to update
190684261912SSteven Rostedt (Red Hat) 	 * all ops that are enabled and use this hash.
190784261912SSteven Rostedt (Red Hat) 	 */
190884261912SSteven Rostedt (Red Hat) 	do_for_each_ftrace_op(op, ftrace_ops_list) {
190984261912SSteven Rostedt (Red Hat) 		/* Already done */
191084261912SSteven Rostedt (Red Hat) 		if (op == ops)
191184261912SSteven Rostedt (Red Hat) 			continue;
191284261912SSteven Rostedt (Red Hat) 		if (op->func_hash == &global_ops.local_hash)
191384261912SSteven Rostedt (Red Hat) 			__ftrace_hash_rec_update(op, filter_hash, inc);
191484261912SSteven Rostedt (Red Hat) 	} while_for_each_ftrace_op(op);
191584261912SSteven Rostedt (Red Hat) }
191684261912SSteven Rostedt (Red Hat) 
191784261912SSteven Rostedt (Red Hat) static void ftrace_hash_rec_disable_modify(struct ftrace_ops *ops,
191884261912SSteven Rostedt (Red Hat) 					   int filter_hash)
191984261912SSteven Rostedt (Red Hat) {
192084261912SSteven Rostedt (Red Hat) 	ftrace_hash_rec_update_modify(ops, filter_hash, 0);
192184261912SSteven Rostedt (Red Hat) }
192284261912SSteven Rostedt (Red Hat) 
192384261912SSteven Rostedt (Red Hat) static void ftrace_hash_rec_enable_modify(struct ftrace_ops *ops,
192484261912SSteven Rostedt (Red Hat) 					  int filter_hash)
192584261912SSteven Rostedt (Red Hat) {
192684261912SSteven Rostedt (Red Hat) 	ftrace_hash_rec_update_modify(ops, filter_hash, 1);
192784261912SSteven Rostedt (Red Hat) }
192884261912SSteven Rostedt (Red Hat) 
1929f8b8be8aSMasami Hiramatsu /*
1930f8b8be8aSMasami Hiramatsu  * Try to update IPMODIFY flag on each ftrace_rec. Return 0 if it is OK
1931f8b8be8aSMasami Hiramatsu  * or no-needed to update, -EBUSY if it detects a conflict of the flag
1932f8b8be8aSMasami Hiramatsu  * on a ftrace_rec, and -EINVAL if the new_hash tries to trace all recs.
1933f8b8be8aSMasami Hiramatsu  * Note that old_hash and new_hash has below meanings
1934f8b8be8aSMasami Hiramatsu  *  - If the hash is NULL, it hits all recs (if IPMODIFY is set, this is rejected)
1935f8b8be8aSMasami Hiramatsu  *  - If the hash is EMPTY_HASH, it hits nothing
1936f8b8be8aSMasami Hiramatsu  *  - Anything else hits the recs which match the hash entries.
193753cd885bSSong Liu  *
193853cd885bSSong Liu  * DIRECT ops does not have IPMODIFY flag, but we still need to check it
193953cd885bSSong Liu  * against functions with FTRACE_FL_IPMODIFY. If there is any overlap, call
194053cd885bSSong Liu  * ops_func(SHARE_IPMODIFY_SELF) to make sure current ops can share with
194153cd885bSSong Liu  * IPMODIFY. If ops_func(SHARE_IPMODIFY_SELF) returns non-zero, propagate
194253cd885bSSong Liu  * the return value to the caller and eventually to the owner of the DIRECT
194353cd885bSSong Liu  * ops.
1944f8b8be8aSMasami Hiramatsu  */
1945f8b8be8aSMasami Hiramatsu static int __ftrace_hash_update_ipmodify(struct ftrace_ops *ops,
1946f8b8be8aSMasami Hiramatsu 					 struct ftrace_hash *old_hash,
1947f8b8be8aSMasami Hiramatsu 					 struct ftrace_hash *new_hash)
1948f8b8be8aSMasami Hiramatsu {
1949f8b8be8aSMasami Hiramatsu 	struct ftrace_page *pg;
1950f8b8be8aSMasami Hiramatsu 	struct dyn_ftrace *rec, *end = NULL;
1951f8b8be8aSMasami Hiramatsu 	int in_old, in_new;
195253cd885bSSong Liu 	bool is_ipmodify, is_direct;
1953f8b8be8aSMasami Hiramatsu 
1954f8b8be8aSMasami Hiramatsu 	/* Only update if the ops has been registered */
1955f8b8be8aSMasami Hiramatsu 	if (!(ops->flags & FTRACE_OPS_FL_ENABLED))
1956f8b8be8aSMasami Hiramatsu 		return 0;
1957f8b8be8aSMasami Hiramatsu 
195853cd885bSSong Liu 	is_ipmodify = ops->flags & FTRACE_OPS_FL_IPMODIFY;
195953cd885bSSong Liu 	is_direct = ops->flags & FTRACE_OPS_FL_DIRECT;
196053cd885bSSong Liu 
196153cd885bSSong Liu 	/* neither IPMODIFY nor DIRECT, skip */
196253cd885bSSong Liu 	if (!is_ipmodify && !is_direct)
196353cd885bSSong Liu 		return 0;
196453cd885bSSong Liu 
196553cd885bSSong Liu 	if (WARN_ON_ONCE(is_ipmodify && is_direct))
1966f8b8be8aSMasami Hiramatsu 		return 0;
1967f8b8be8aSMasami Hiramatsu 
1968f8b8be8aSMasami Hiramatsu 	/*
196953cd885bSSong Liu 	 * Since the IPMODIFY and DIRECT are very address sensitive
197053cd885bSSong Liu 	 * actions, we do not allow ftrace_ops to set all functions to new
197153cd885bSSong Liu 	 * hash.
1972f8b8be8aSMasami Hiramatsu 	 */
1973f8b8be8aSMasami Hiramatsu 	if (!new_hash || !old_hash)
1974f8b8be8aSMasami Hiramatsu 		return -EINVAL;
1975f8b8be8aSMasami Hiramatsu 
1976f8b8be8aSMasami Hiramatsu 	/* Update rec->flags */
1977f8b8be8aSMasami Hiramatsu 	do_for_each_ftrace_rec(pg, rec) {
1978546fece4SSteven Rostedt (Red Hat) 
1979546fece4SSteven Rostedt (Red Hat) 		if (rec->flags & FTRACE_FL_DISABLED)
1980546fece4SSteven Rostedt (Red Hat) 			continue;
1981546fece4SSteven Rostedt (Red Hat) 
1982f8b8be8aSMasami Hiramatsu 		/* We need to update only differences of filter_hash */
1983f8b8be8aSMasami Hiramatsu 		in_old = !!ftrace_lookup_ip(old_hash, rec->ip);
1984f8b8be8aSMasami Hiramatsu 		in_new = !!ftrace_lookup_ip(new_hash, rec->ip);
1985f8b8be8aSMasami Hiramatsu 		if (in_old == in_new)
1986f8b8be8aSMasami Hiramatsu 			continue;
1987f8b8be8aSMasami Hiramatsu 
1988f8b8be8aSMasami Hiramatsu 		if (in_new) {
198953cd885bSSong Liu 			if (rec->flags & FTRACE_FL_IPMODIFY) {
199053cd885bSSong Liu 				int ret;
199153cd885bSSong Liu 
199253cd885bSSong Liu 				/* Cannot have two ipmodify on same rec */
199353cd885bSSong Liu 				if (is_ipmodify)
1994f8b8be8aSMasami Hiramatsu 					goto rollback;
199553cd885bSSong Liu 
199653cd885bSSong Liu 				FTRACE_WARN_ON(rec->flags & FTRACE_FL_DIRECT);
199753cd885bSSong Liu 
199853cd885bSSong Liu 				/*
199953cd885bSSong Liu 				 * Another ops with IPMODIFY is already
200053cd885bSSong Liu 				 * attached. We are now attaching a direct
200153cd885bSSong Liu 				 * ops. Run SHARE_IPMODIFY_SELF, to check
200253cd885bSSong Liu 				 * whether sharing is supported.
200353cd885bSSong Liu 				 */
200453cd885bSSong Liu 				if (!ops->ops_func)
200553cd885bSSong Liu 					return -EBUSY;
200653cd885bSSong Liu 				ret = ops->ops_func(ops, FTRACE_OPS_CMD_ENABLE_SHARE_IPMODIFY_SELF);
200753cd885bSSong Liu 				if (ret)
200853cd885bSSong Liu 					return ret;
200953cd885bSSong Liu 			} else if (is_ipmodify) {
2010f8b8be8aSMasami Hiramatsu 				rec->flags |= FTRACE_FL_IPMODIFY;
201153cd885bSSong Liu 			}
201253cd885bSSong Liu 		} else if (is_ipmodify) {
2013f8b8be8aSMasami Hiramatsu 			rec->flags &= ~FTRACE_FL_IPMODIFY;
201453cd885bSSong Liu 		}
2015f8b8be8aSMasami Hiramatsu 	} while_for_each_ftrace_rec();
2016f8b8be8aSMasami Hiramatsu 
2017f8b8be8aSMasami Hiramatsu 	return 0;
2018f8b8be8aSMasami Hiramatsu 
2019f8b8be8aSMasami Hiramatsu rollback:
2020f8b8be8aSMasami Hiramatsu 	end = rec;
2021f8b8be8aSMasami Hiramatsu 
2022f8b8be8aSMasami Hiramatsu 	/* Roll back what we did above */
2023f8b8be8aSMasami Hiramatsu 	do_for_each_ftrace_rec(pg, rec) {
2024546fece4SSteven Rostedt (Red Hat) 
2025546fece4SSteven Rostedt (Red Hat) 		if (rec->flags & FTRACE_FL_DISABLED)
2026546fece4SSteven Rostedt (Red Hat) 			continue;
2027546fece4SSteven Rostedt (Red Hat) 
2028f8b8be8aSMasami Hiramatsu 		if (rec == end)
2029f8b8be8aSMasami Hiramatsu 			goto err_out;
2030f8b8be8aSMasami Hiramatsu 
2031f8b8be8aSMasami Hiramatsu 		in_old = !!ftrace_lookup_ip(old_hash, rec->ip);
2032f8b8be8aSMasami Hiramatsu 		in_new = !!ftrace_lookup_ip(new_hash, rec->ip);
2033f8b8be8aSMasami Hiramatsu 		if (in_old == in_new)
2034f8b8be8aSMasami Hiramatsu 			continue;
2035f8b8be8aSMasami Hiramatsu 
2036f8b8be8aSMasami Hiramatsu 		if (in_new)
2037f8b8be8aSMasami Hiramatsu 			rec->flags &= ~FTRACE_FL_IPMODIFY;
2038f8b8be8aSMasami Hiramatsu 		else
2039f8b8be8aSMasami Hiramatsu 			rec->flags |= FTRACE_FL_IPMODIFY;
2040f8b8be8aSMasami Hiramatsu 	} while_for_each_ftrace_rec();
2041f8b8be8aSMasami Hiramatsu 
2042f8b8be8aSMasami Hiramatsu err_out:
2043f8b8be8aSMasami Hiramatsu 	return -EBUSY;
2044f8b8be8aSMasami Hiramatsu }
2045f8b8be8aSMasami Hiramatsu 
2046f8b8be8aSMasami Hiramatsu static int ftrace_hash_ipmodify_enable(struct ftrace_ops *ops)
2047f8b8be8aSMasami Hiramatsu {
2048f8b8be8aSMasami Hiramatsu 	struct ftrace_hash *hash = ops->func_hash->filter_hash;
2049f8b8be8aSMasami Hiramatsu 
2050f8b8be8aSMasami Hiramatsu 	if (ftrace_hash_empty(hash))
2051f8b8be8aSMasami Hiramatsu 		hash = NULL;
2052f8b8be8aSMasami Hiramatsu 
2053f8b8be8aSMasami Hiramatsu 	return __ftrace_hash_update_ipmodify(ops, EMPTY_HASH, hash);
2054f8b8be8aSMasami Hiramatsu }
2055f8b8be8aSMasami Hiramatsu 
2056f8b8be8aSMasami Hiramatsu /* Disabling always succeeds */
2057f8b8be8aSMasami Hiramatsu static void ftrace_hash_ipmodify_disable(struct ftrace_ops *ops)
2058f8b8be8aSMasami Hiramatsu {
2059f8b8be8aSMasami Hiramatsu 	struct ftrace_hash *hash = ops->func_hash->filter_hash;
2060f8b8be8aSMasami Hiramatsu 
2061f8b8be8aSMasami Hiramatsu 	if (ftrace_hash_empty(hash))
2062f8b8be8aSMasami Hiramatsu 		hash = NULL;
2063f8b8be8aSMasami Hiramatsu 
2064f8b8be8aSMasami Hiramatsu 	__ftrace_hash_update_ipmodify(ops, hash, EMPTY_HASH);
2065f8b8be8aSMasami Hiramatsu }
2066f8b8be8aSMasami Hiramatsu 
2067f8b8be8aSMasami Hiramatsu static int ftrace_hash_ipmodify_update(struct ftrace_ops *ops,
2068f8b8be8aSMasami Hiramatsu 				       struct ftrace_hash *new_hash)
2069f8b8be8aSMasami Hiramatsu {
2070f8b8be8aSMasami Hiramatsu 	struct ftrace_hash *old_hash = ops->func_hash->filter_hash;
2071f8b8be8aSMasami Hiramatsu 
2072f8b8be8aSMasami Hiramatsu 	if (ftrace_hash_empty(old_hash))
2073f8b8be8aSMasami Hiramatsu 		old_hash = NULL;
2074f8b8be8aSMasami Hiramatsu 
2075f8b8be8aSMasami Hiramatsu 	if (ftrace_hash_empty(new_hash))
2076f8b8be8aSMasami Hiramatsu 		new_hash = NULL;
2077f8b8be8aSMasami Hiramatsu 
2078f8b8be8aSMasami Hiramatsu 	return __ftrace_hash_update_ipmodify(ops, old_hash, new_hash);
2079f8b8be8aSMasami Hiramatsu }
2080f8b8be8aSMasami Hiramatsu 
2081b05086c7SSteven Rostedt (Red Hat) static void print_ip_ins(const char *fmt, const unsigned char *p)
208205736a42SSteven Rostedt {
20836c14133dSSteven Rostedt (VMware) 	char ins[MCOUNT_INSN_SIZE];
208405736a42SSteven Rostedt 
20856c14133dSSteven Rostedt (VMware) 	if (copy_from_kernel_nofault(ins, p, MCOUNT_INSN_SIZE)) {
20866c14133dSSteven Rostedt (VMware) 		printk(KERN_CONT "%s[FAULT] %px\n", fmt, p);
20876c14133dSSteven Rostedt (VMware) 		return;
20886c14133dSSteven Rostedt (VMware) 	}
20896c14133dSSteven Rostedt (VMware) 
209005736a42SSteven Rostedt 	printk(KERN_CONT "%s", fmt);
209130f7d1caSZheng Yejian 	pr_cont("%*phC", MCOUNT_INSN_SIZE, ins);
209205736a42SSteven Rostedt }
209305736a42SSteven Rostedt 
209402a392a0SSteven Rostedt (Red Hat) enum ftrace_bug_type ftrace_bug_type;
2095b05086c7SSteven Rostedt (Red Hat) const void *ftrace_expected;
209602a392a0SSteven Rostedt (Red Hat) 
209702a392a0SSteven Rostedt (Red Hat) static void print_bug_type(void)
209802a392a0SSteven Rostedt (Red Hat) {
209902a392a0SSteven Rostedt (Red Hat) 	switch (ftrace_bug_type) {
210002a392a0SSteven Rostedt (Red Hat) 	case FTRACE_BUG_UNKNOWN:
210102a392a0SSteven Rostedt (Red Hat) 		break;
210202a392a0SSteven Rostedt (Red Hat) 	case FTRACE_BUG_INIT:
210302a392a0SSteven Rostedt (Red Hat) 		pr_info("Initializing ftrace call sites\n");
210402a392a0SSteven Rostedt (Red Hat) 		break;
210502a392a0SSteven Rostedt (Red Hat) 	case FTRACE_BUG_NOP:
210602a392a0SSteven Rostedt (Red Hat) 		pr_info("Setting ftrace call site to NOP\n");
210702a392a0SSteven Rostedt (Red Hat) 		break;
210802a392a0SSteven Rostedt (Red Hat) 	case FTRACE_BUG_CALL:
210902a392a0SSteven Rostedt (Red Hat) 		pr_info("Setting ftrace call site to call ftrace function\n");
211002a392a0SSteven Rostedt (Red Hat) 		break;
211102a392a0SSteven Rostedt (Red Hat) 	case FTRACE_BUG_UPDATE:
211202a392a0SSteven Rostedt (Red Hat) 		pr_info("Updating ftrace call site to call a different ftrace function\n");
211302a392a0SSteven Rostedt (Red Hat) 		break;
211402a392a0SSteven Rostedt (Red Hat) 	}
211502a392a0SSteven Rostedt (Red Hat) }
211602a392a0SSteven Rostedt (Red Hat) 
2117c88fd863SSteven Rostedt /**
2118c88fd863SSteven Rostedt  * ftrace_bug - report and shutdown function tracer
2119c88fd863SSteven Rostedt  * @failed: The failed type (EFAULT, EINVAL, EPERM)
21204fd3279bSSteven Rostedt (Red Hat)  * @rec: The record that failed
2121c88fd863SSteven Rostedt  *
2122c88fd863SSteven Rostedt  * The arch code that enables or disables the function tracing
2123c88fd863SSteven Rostedt  * can call ftrace_bug() when it has detected a problem in
2124c88fd863SSteven Rostedt  * modifying the code. @failed should be one of either:
2125c88fd863SSteven Rostedt  * EFAULT - if the problem happens on reading the @ip address
2126c88fd863SSteven Rostedt  * EINVAL - if what is read at @ip is not what was expected
21279efb85c5SHariprasad Kelam  * EPERM - if the problem happens on writing to the @ip address
2128c88fd863SSteven Rostedt  */
21294fd3279bSSteven Rostedt (Red Hat) void ftrace_bug(int failed, struct dyn_ftrace *rec)
21303c1720f0SSteven Rostedt {
21314fd3279bSSteven Rostedt (Red Hat) 	unsigned long ip = rec ? rec->ip : 0;
21324fd3279bSSteven Rostedt (Red Hat) 
2133c143b775SCheng Jian 	pr_info("------------[ ftrace bug ]------------\n");
2134c143b775SCheng Jian 
2135b17e8a37SSteven Rostedt 	switch (failed) {
2136593eb8a2SSteven Rostedt 	case -EFAULT:
213705736a42SSteven Rostedt 		pr_info("ftrace faulted on modifying ");
21382062a4e8SDmitry Safonov 		print_ip_sym(KERN_INFO, ip);
213905736a42SSteven Rostedt 		break;
2140593eb8a2SSteven Rostedt 	case -EINVAL:
214105736a42SSteven Rostedt 		pr_info("ftrace failed to modify ");
21422062a4e8SDmitry Safonov 		print_ip_sym(KERN_INFO, ip);
214305736a42SSteven Rostedt 		print_ip_ins(" actual:   ", (unsigned char *)ip);
21444fd3279bSSteven Rostedt (Red Hat) 		pr_cont("\n");
2145b05086c7SSteven Rostedt (Red Hat) 		if (ftrace_expected) {
2146b05086c7SSteven Rostedt (Red Hat) 			print_ip_ins(" expected: ", ftrace_expected);
2147b05086c7SSteven Rostedt (Red Hat) 			pr_cont("\n");
2148b05086c7SSteven Rostedt (Red Hat) 		}
214905736a42SSteven Rostedt 		break;
2150593eb8a2SSteven Rostedt 	case -EPERM:
2151593eb8a2SSteven Rostedt 		pr_info("ftrace faulted on writing ");
21522062a4e8SDmitry Safonov 		print_ip_sym(KERN_INFO, ip);
2153593eb8a2SSteven Rostedt 		break;
2154593eb8a2SSteven Rostedt 	default:
2155593eb8a2SSteven Rostedt 		pr_info("ftrace faulted on unknown error ");
21562062a4e8SDmitry Safonov 		print_ip_sym(KERN_INFO, ip);
215705736a42SSteven Rostedt 	}
215802a392a0SSteven Rostedt (Red Hat) 	print_bug_type();
21594fd3279bSSteven Rostedt (Red Hat) 	if (rec) {
21604fd3279bSSteven Rostedt (Red Hat) 		struct ftrace_ops *ops = NULL;
21614fd3279bSSteven Rostedt (Red Hat) 
21624fd3279bSSteven Rostedt (Red Hat) 		pr_info("ftrace record flags: %lx\n", rec->flags);
2163cbad0fb2SMark Rutland 		pr_cont(" (%ld)%s%s", ftrace_rec_count(rec),
2164cbad0fb2SMark Rutland 			rec->flags & FTRACE_FL_REGS ? " R" : "  ",
2165cbad0fb2SMark Rutland 			rec->flags & FTRACE_FL_CALL_OPS ? " O" : "  ");
21664fd3279bSSteven Rostedt (Red Hat) 		if (rec->flags & FTRACE_FL_TRAMP_EN) {
21674fd3279bSSteven Rostedt (Red Hat) 			ops = ftrace_find_tramp_ops_any(rec);
216839daa7b9SSteven Rostedt (Red Hat) 			if (ops) {
216939daa7b9SSteven Rostedt (Red Hat) 				do {
217039daa7b9SSteven Rostedt (Red Hat) 					pr_cont("\ttramp: %pS (%pS)",
217139daa7b9SSteven Rostedt (Red Hat) 						(void *)ops->trampoline,
217239daa7b9SSteven Rostedt (Red Hat) 						(void *)ops->func);
217339daa7b9SSteven Rostedt (Red Hat) 					ops = ftrace_find_tramp_ops_next(rec, ops);
217439daa7b9SSteven Rostedt (Red Hat) 				} while (ops);
217539daa7b9SSteven Rostedt (Red Hat) 			} else
21764fd3279bSSteven Rostedt (Red Hat) 				pr_cont("\ttramp: ERROR!");
21774fd3279bSSteven Rostedt (Red Hat) 
21784fd3279bSSteven Rostedt (Red Hat) 		}
21794fd3279bSSteven Rostedt (Red Hat) 		ip = ftrace_get_addr_curr(rec);
218039daa7b9SSteven Rostedt (Red Hat) 		pr_cont("\n expected tramp: %lx\n", ip);
21814fd3279bSSteven Rostedt (Red Hat) 	}
2182c143b775SCheng Jian 
2183c143b775SCheng Jian 	FTRACE_WARN_ON_ONCE(1);
2184b17e8a37SSteven Rostedt }
218505736a42SSteven Rostedt 
21867375dca1SSteven Rostedt (VMware) static int ftrace_check_record(struct dyn_ftrace *rec, bool enable, bool update)
21873d083395SSteven Rostedt {
218864fbcd16SXiao Guangrong 	unsigned long flag = 0UL;
2189e7d3737eSFrederic Weisbecker 
219002a392a0SSteven Rostedt (Red Hat) 	ftrace_bug_type = FTRACE_BUG_UNKNOWN;
219102a392a0SSteven Rostedt (Red Hat) 
2192cf04f2d5SSteven Rostedt (Google) 	if (skip_record(rec))
2193b7ffffbbSSteven Rostedt (Red Hat) 		return FTRACE_UPDATE_IGNORE;
2194b7ffffbbSSteven Rostedt (Red Hat) 
21953d083395SSteven Rostedt 	/*
219630fb6aa7SJiri Olsa 	 * If we are updating calls:
21973d083395SSteven Rostedt 	 *
2198ed926f9bSSteven Rostedt 	 *   If the record has a ref count, then we need to enable it
2199ed926f9bSSteven Rostedt 	 *   because someone is using it.
22003d083395SSteven Rostedt 	 *
2201ed926f9bSSteven Rostedt 	 *   Otherwise we make sure its disabled.
2202ed926f9bSSteven Rostedt 	 *
220330fb6aa7SJiri Olsa 	 * If we are disabling calls, then disable all records that
2204ed926f9bSSteven Rostedt 	 * are enabled.
22053d083395SSteven Rostedt 	 */
22060376bde1SSteven Rostedt (Red Hat) 	if (enable && ftrace_rec_count(rec))
220764fbcd16SXiao Guangrong 		flag = FTRACE_FL_ENABLED;
22083d083395SSteven Rostedt 
220908f6fba5SSteven Rostedt 	/*
221079922b80SSteven Rostedt (Red Hat) 	 * If enabling and the REGS flag does not match the REGS_EN, or
221179922b80SSteven Rostedt (Red Hat) 	 * the TRAMP flag doesn't match the TRAMP_EN, then do not ignore
221279922b80SSteven Rostedt (Red Hat) 	 * this record. Set flags to fail the compare against ENABLED.
2213763e34e7SSteven Rostedt (VMware) 	 * Same for direct calls.
221408f6fba5SSteven Rostedt 	 */
221579922b80SSteven Rostedt (Red Hat) 	if (flag) {
221679922b80SSteven Rostedt (Red Hat) 		if (!(rec->flags & FTRACE_FL_REGS) !=
221779922b80SSteven Rostedt (Red Hat) 		    !(rec->flags & FTRACE_FL_REGS_EN))
221808f6fba5SSteven Rostedt 			flag |= FTRACE_FL_REGS;
221908f6fba5SSteven Rostedt 
222079922b80SSteven Rostedt (Red Hat) 		if (!(rec->flags & FTRACE_FL_TRAMP) !=
222179922b80SSteven Rostedt (Red Hat) 		    !(rec->flags & FTRACE_FL_TRAMP_EN))
222279922b80SSteven Rostedt (Red Hat) 			flag |= FTRACE_FL_TRAMP;
2223763e34e7SSteven Rostedt (VMware) 
2224763e34e7SSteven Rostedt (VMware) 		/*
2225763e34e7SSteven Rostedt (VMware) 		 * Direct calls are special, as count matters.
2226763e34e7SSteven Rostedt (VMware) 		 * We must test the record for direct, if the
2227763e34e7SSteven Rostedt (VMware) 		 * DIRECT and DIRECT_EN do not match, but only
2228763e34e7SSteven Rostedt (VMware) 		 * if the count is 1. That's because, if the
2229763e34e7SSteven Rostedt (VMware) 		 * count is something other than one, we do not
2230763e34e7SSteven Rostedt (VMware) 		 * want the direct enabled (it will be done via the
2231763e34e7SSteven Rostedt (VMware) 		 * direct helper). But if DIRECT_EN is set, and
2232763e34e7SSteven Rostedt (VMware) 		 * the count is not one, we need to clear it.
2233cbad0fb2SMark Rutland 		 *
2234763e34e7SSteven Rostedt (VMware) 		 */
2235763e34e7SSteven Rostedt (VMware) 		if (ftrace_rec_count(rec) == 1) {
2236763e34e7SSteven Rostedt (VMware) 			if (!(rec->flags & FTRACE_FL_DIRECT) !=
2237763e34e7SSteven Rostedt (VMware) 			    !(rec->flags & FTRACE_FL_DIRECT_EN))
2238763e34e7SSteven Rostedt (VMware) 				flag |= FTRACE_FL_DIRECT;
2239763e34e7SSteven Rostedt (VMware) 		} else if (rec->flags & FTRACE_FL_DIRECT_EN) {
2240763e34e7SSteven Rostedt (VMware) 			flag |= FTRACE_FL_DIRECT;
2241763e34e7SSteven Rostedt (VMware) 		}
2242cbad0fb2SMark Rutland 
2243cbad0fb2SMark Rutland 		/*
2244cbad0fb2SMark Rutland 		 * Ops calls are special, as count matters.
2245cbad0fb2SMark Rutland 		 * As with direct calls, they must only be enabled when count
2246cbad0fb2SMark Rutland 		 * is one, otherwise they'll be handled via the list ops.
2247cbad0fb2SMark Rutland 		 */
2248cbad0fb2SMark Rutland 		if (ftrace_rec_count(rec) == 1) {
2249cbad0fb2SMark Rutland 			if (!(rec->flags & FTRACE_FL_CALL_OPS) !=
2250cbad0fb2SMark Rutland 			    !(rec->flags & FTRACE_FL_CALL_OPS_EN))
2251cbad0fb2SMark Rutland 				flag |= FTRACE_FL_CALL_OPS;
2252cbad0fb2SMark Rutland 		} else if (rec->flags & FTRACE_FL_CALL_OPS_EN) {
2253cbad0fb2SMark Rutland 			flag |= FTRACE_FL_CALL_OPS;
2254cbad0fb2SMark Rutland 		}
225579922b80SSteven Rostedt (Red Hat) 	}
225679922b80SSteven Rostedt (Red Hat) 
225764fbcd16SXiao Guangrong 	/* If the state of this record hasn't changed, then do nothing */
225864fbcd16SXiao Guangrong 	if ((rec->flags & FTRACE_FL_ENABLED) == flag)
2259c88fd863SSteven Rostedt 		return FTRACE_UPDATE_IGNORE;
226064fbcd16SXiao Guangrong 
226164fbcd16SXiao Guangrong 	if (flag) {
226208f6fba5SSteven Rostedt 		/* Save off if rec is being enabled (for return value) */
226308f6fba5SSteven Rostedt 		flag ^= rec->flags & FTRACE_FL_ENABLED;
226408f6fba5SSteven Rostedt 
226508f6fba5SSteven Rostedt 		if (update) {
2266e11b521aSSteven Rostedt (Google) 			rec->flags |= FTRACE_FL_ENABLED | FTRACE_FL_TOUCHED;
226708f6fba5SSteven Rostedt 			if (flag & FTRACE_FL_REGS) {
226808f6fba5SSteven Rostedt 				if (rec->flags & FTRACE_FL_REGS)
226908f6fba5SSteven Rostedt 					rec->flags |= FTRACE_FL_REGS_EN;
227008f6fba5SSteven Rostedt 				else
227108f6fba5SSteven Rostedt 					rec->flags &= ~FTRACE_FL_REGS_EN;
227208f6fba5SSteven Rostedt 			}
227379922b80SSteven Rostedt (Red Hat) 			if (flag & FTRACE_FL_TRAMP) {
227479922b80SSteven Rostedt (Red Hat) 				if (rec->flags & FTRACE_FL_TRAMP)
227579922b80SSteven Rostedt (Red Hat) 					rec->flags |= FTRACE_FL_TRAMP_EN;
227679922b80SSteven Rostedt (Red Hat) 				else
227779922b80SSteven Rostedt (Red Hat) 					rec->flags &= ~FTRACE_FL_TRAMP_EN;
227879922b80SSteven Rostedt (Red Hat) 			}
2279d19ad077SSteven Rostedt (VMware) 
22806ce2c04fSSteven Rostedt (Google) 			/* Keep track of anything that modifies the function */
22816ce2c04fSSteven Rostedt (Google) 			if (rec->flags & (FTRACE_FL_DIRECT | FTRACE_FL_IPMODIFY))
22826ce2c04fSSteven Rostedt (Google) 				rec->flags |= FTRACE_FL_MODIFIED;
22836ce2c04fSSteven Rostedt (Google) 
2284763e34e7SSteven Rostedt (VMware) 			if (flag & FTRACE_FL_DIRECT) {
2285763e34e7SSteven Rostedt (VMware) 				/*
2286763e34e7SSteven Rostedt (VMware) 				 * If there's only one user (direct_ops helper)
2287763e34e7SSteven Rostedt (VMware) 				 * then we can call the direct function
2288763e34e7SSteven Rostedt (VMware) 				 * directly (no ftrace trampoline).
2289763e34e7SSteven Rostedt (VMware) 				 */
2290763e34e7SSteven Rostedt (VMware) 				if (ftrace_rec_count(rec) == 1) {
2291763e34e7SSteven Rostedt (VMware) 					if (rec->flags & FTRACE_FL_DIRECT)
2292763e34e7SSteven Rostedt (VMware) 						rec->flags |= FTRACE_FL_DIRECT_EN;
2293763e34e7SSteven Rostedt (VMware) 					else
2294763e34e7SSteven Rostedt (VMware) 						rec->flags &= ~FTRACE_FL_DIRECT_EN;
2295763e34e7SSteven Rostedt (VMware) 				} else {
2296763e34e7SSteven Rostedt (VMware) 					/*
2297763e34e7SSteven Rostedt (VMware) 					 * Can only call directly if there's
2298763e34e7SSteven Rostedt (VMware) 					 * only one callback to the function.
2299763e34e7SSteven Rostedt (VMware) 					 */
2300763e34e7SSteven Rostedt (VMware) 					rec->flags &= ~FTRACE_FL_DIRECT_EN;
2301763e34e7SSteven Rostedt (VMware) 				}
2302763e34e7SSteven Rostedt (VMware) 			}
2303cbad0fb2SMark Rutland 
2304cbad0fb2SMark Rutland 			if (flag & FTRACE_FL_CALL_OPS) {
2305cbad0fb2SMark Rutland 				if (ftrace_rec_count(rec) == 1) {
2306cbad0fb2SMark Rutland 					if (rec->flags & FTRACE_FL_CALL_OPS)
2307cbad0fb2SMark Rutland 						rec->flags |= FTRACE_FL_CALL_OPS_EN;
2308cbad0fb2SMark Rutland 					else
2309cbad0fb2SMark Rutland 						rec->flags &= ~FTRACE_FL_CALL_OPS_EN;
2310cbad0fb2SMark Rutland 				} else {
2311cbad0fb2SMark Rutland 					/*
2312cbad0fb2SMark Rutland 					 * Can only call directly if there's
2313cbad0fb2SMark Rutland 					 * only one set of associated ops.
2314cbad0fb2SMark Rutland 					 */
2315cbad0fb2SMark Rutland 					rec->flags &= ~FTRACE_FL_CALL_OPS_EN;
2316cbad0fb2SMark Rutland 				}
2317cbad0fb2SMark Rutland 			}
231864fbcd16SXiao Guangrong 		}
231964fbcd16SXiao Guangrong 
232008f6fba5SSteven Rostedt 		/*
232108f6fba5SSteven Rostedt 		 * If this record is being updated from a nop, then
232208f6fba5SSteven Rostedt 		 *   return UPDATE_MAKE_CALL.
232308f6fba5SSteven Rostedt 		 * Otherwise,
232408f6fba5SSteven Rostedt 		 *   return UPDATE_MODIFY_CALL to tell the caller to convert
2325f1b2f2bdSSteven Rostedt (Red Hat) 		 *   from the save regs, to a non-save regs function or
232679922b80SSteven Rostedt (Red Hat) 		 *   vice versa, or from a trampoline call.
232708f6fba5SSteven Rostedt 		 */
232802a392a0SSteven Rostedt (Red Hat) 		if (flag & FTRACE_FL_ENABLED) {
232902a392a0SSteven Rostedt (Red Hat) 			ftrace_bug_type = FTRACE_BUG_CALL;
233008f6fba5SSteven Rostedt 			return FTRACE_UPDATE_MAKE_CALL;
233102a392a0SSteven Rostedt (Red Hat) 		}
2332f1b2f2bdSSteven Rostedt (Red Hat) 
233302a392a0SSteven Rostedt (Red Hat) 		ftrace_bug_type = FTRACE_BUG_UPDATE;
233408f6fba5SSteven Rostedt 		return FTRACE_UPDATE_MODIFY_CALL;
233508f6fba5SSteven Rostedt 	}
233608f6fba5SSteven Rostedt 
233708f6fba5SSteven Rostedt 	if (update) {
233808f6fba5SSteven Rostedt 		/* If there's no more users, clear all flags */
23390376bde1SSteven Rostedt (Red Hat) 		if (!ftrace_rec_count(rec))
2340e11b521aSSteven Rostedt (Google) 			rec->flags &= FTRACE_NOCLEAR_FLAGS;
234108f6fba5SSteven Rostedt 		else
2342b24d443bSSteven Rostedt (Red Hat) 			/*
2343b24d443bSSteven Rostedt (Red Hat) 			 * Just disable the record, but keep the ops TRAMP
2344b24d443bSSteven Rostedt (Red Hat) 			 * and REGS states. The _EN flags must be disabled though.
2345b24d443bSSteven Rostedt (Red Hat) 			 */
2346b24d443bSSteven Rostedt (Red Hat) 			rec->flags &= ~(FTRACE_FL_ENABLED | FTRACE_FL_TRAMP_EN |
2347cbad0fb2SMark Rutland 					FTRACE_FL_REGS_EN | FTRACE_FL_DIRECT_EN |
2348cbad0fb2SMark Rutland 					FTRACE_FL_CALL_OPS_EN);
234908f6fba5SSteven Rostedt 	}
2350c88fd863SSteven Rostedt 
235102a392a0SSteven Rostedt (Red Hat) 	ftrace_bug_type = FTRACE_BUG_NOP;
2352c88fd863SSteven Rostedt 	return FTRACE_UPDATE_MAKE_NOP;
2353c88fd863SSteven Rostedt }
2354c88fd863SSteven Rostedt 
2355c88fd863SSteven Rostedt /**
23566130722fSSteven Rostedt (VMware)  * ftrace_update_record - set a record that now is tracing or not
2357c88fd863SSteven Rostedt  * @rec: the record to update
23587375dca1SSteven Rostedt (VMware)  * @enable: set to true if the record is tracing, false to force disable
2359c88fd863SSteven Rostedt  *
2360c88fd863SSteven Rostedt  * The records that represent all functions that can be traced need
2361c88fd863SSteven Rostedt  * to be updated when tracing has been enabled.
2362c88fd863SSteven Rostedt  */
23637375dca1SSteven Rostedt (VMware) int ftrace_update_record(struct dyn_ftrace *rec, bool enable)
2364c88fd863SSteven Rostedt {
23657375dca1SSteven Rostedt (VMware) 	return ftrace_check_record(rec, enable, true);
2366c88fd863SSteven Rostedt }
2367c88fd863SSteven Rostedt 
2368c88fd863SSteven Rostedt /**
23696130722fSSteven Rostedt (VMware)  * ftrace_test_record - check if the record has been enabled or not
2370c88fd863SSteven Rostedt  * @rec: the record to test
23717375dca1SSteven Rostedt (VMware)  * @enable: set to true to check if enabled, false if it is disabled
2372c88fd863SSteven Rostedt  *
2373c88fd863SSteven Rostedt  * The arch code may need to test if a record is already set to
2374c88fd863SSteven Rostedt  * tracing to determine how to modify the function code that it
2375c88fd863SSteven Rostedt  * represents.
2376c88fd863SSteven Rostedt  */
23777375dca1SSteven Rostedt (VMware) int ftrace_test_record(struct dyn_ftrace *rec, bool enable)
2378c88fd863SSteven Rostedt {
23797375dca1SSteven Rostedt (VMware) 	return ftrace_check_record(rec, enable, false);
2380c88fd863SSteven Rostedt }
2381c88fd863SSteven Rostedt 
238279922b80SSteven Rostedt (Red Hat) static struct ftrace_ops *
23835fecaa04SSteven Rostedt (Red Hat) ftrace_find_tramp_ops_any(struct dyn_ftrace *rec)
23845fecaa04SSteven Rostedt (Red Hat) {
23855fecaa04SSteven Rostedt (Red Hat) 	struct ftrace_ops *op;
2386fef5aeeeSSteven Rostedt (Red Hat) 	unsigned long ip = rec->ip;
23875fecaa04SSteven Rostedt (Red Hat) 
23885fecaa04SSteven Rostedt (Red Hat) 	do_for_each_ftrace_op(op, ftrace_ops_list) {
23895fecaa04SSteven Rostedt (Red Hat) 
23905fecaa04SSteven Rostedt (Red Hat) 		if (!op->trampoline)
23915fecaa04SSteven Rostedt (Red Hat) 			continue;
23925fecaa04SSteven Rostedt (Red Hat) 
2393fef5aeeeSSteven Rostedt (Red Hat) 		if (hash_contains_ip(ip, op->func_hash))
23945fecaa04SSteven Rostedt (Red Hat) 			return op;
23955fecaa04SSteven Rostedt (Red Hat) 	} while_for_each_ftrace_op(op);
23965fecaa04SSteven Rostedt (Red Hat) 
23975fecaa04SSteven Rostedt (Red Hat) 	return NULL;
23985fecaa04SSteven Rostedt (Red Hat) }
23995fecaa04SSteven Rostedt (Red Hat) 
24005fecaa04SSteven Rostedt (Red Hat) static struct ftrace_ops *
24014c75b0ffSNaveen N. Rao ftrace_find_tramp_ops_any_other(struct dyn_ftrace *rec, struct ftrace_ops *op_exclude)
24024c75b0ffSNaveen N. Rao {
24034c75b0ffSNaveen N. Rao 	struct ftrace_ops *op;
24044c75b0ffSNaveen N. Rao 	unsigned long ip = rec->ip;
24054c75b0ffSNaveen N. Rao 
24064c75b0ffSNaveen N. Rao 	do_for_each_ftrace_op(op, ftrace_ops_list) {
24074c75b0ffSNaveen N. Rao 
24084c75b0ffSNaveen N. Rao 		if (op == op_exclude || !op->trampoline)
24094c75b0ffSNaveen N. Rao 			continue;
24104c75b0ffSNaveen N. Rao 
24114c75b0ffSNaveen N. Rao 		if (hash_contains_ip(ip, op->func_hash))
24124c75b0ffSNaveen N. Rao 			return op;
24134c75b0ffSNaveen N. Rao 	} while_for_each_ftrace_op(op);
24144c75b0ffSNaveen N. Rao 
24154c75b0ffSNaveen N. Rao 	return NULL;
24164c75b0ffSNaveen N. Rao }
24174c75b0ffSNaveen N. Rao 
24184c75b0ffSNaveen N. Rao static struct ftrace_ops *
241939daa7b9SSteven Rostedt (Red Hat) ftrace_find_tramp_ops_next(struct dyn_ftrace *rec,
242039daa7b9SSteven Rostedt (Red Hat) 			   struct ftrace_ops *op)
242139daa7b9SSteven Rostedt (Red Hat) {
242239daa7b9SSteven Rostedt (Red Hat) 	unsigned long ip = rec->ip;
242339daa7b9SSteven Rostedt (Red Hat) 
242439daa7b9SSteven Rostedt (Red Hat) 	while_for_each_ftrace_op(op) {
242539daa7b9SSteven Rostedt (Red Hat) 
242639daa7b9SSteven Rostedt (Red Hat) 		if (!op->trampoline)
242739daa7b9SSteven Rostedt (Red Hat) 			continue;
242839daa7b9SSteven Rostedt (Red Hat) 
242939daa7b9SSteven Rostedt (Red Hat) 		if (hash_contains_ip(ip, op->func_hash))
243039daa7b9SSteven Rostedt (Red Hat) 			return op;
243139daa7b9SSteven Rostedt (Red Hat) 	}
243239daa7b9SSteven Rostedt (Red Hat) 
243339daa7b9SSteven Rostedt (Red Hat) 	return NULL;
243439daa7b9SSteven Rostedt (Red Hat) }
243539daa7b9SSteven Rostedt (Red Hat) 
243639daa7b9SSteven Rostedt (Red Hat) static struct ftrace_ops *
243779922b80SSteven Rostedt (Red Hat) ftrace_find_tramp_ops_curr(struct dyn_ftrace *rec)
243879922b80SSteven Rostedt (Red Hat) {
243979922b80SSteven Rostedt (Red Hat) 	struct ftrace_ops *op;
2440fef5aeeeSSteven Rostedt (Red Hat) 	unsigned long ip = rec->ip;
244179922b80SSteven Rostedt (Red Hat) 
2442fef5aeeeSSteven Rostedt (Red Hat) 	/*
2443fef5aeeeSSteven Rostedt (Red Hat) 	 * Need to check removed ops first.
2444fef5aeeeSSteven Rostedt (Red Hat) 	 * If they are being removed, and this rec has a tramp,
2445fef5aeeeSSteven Rostedt (Red Hat) 	 * and this rec is in the ops list, then it would be the
2446fef5aeeeSSteven Rostedt (Red Hat) 	 * one with the tramp.
2447fef5aeeeSSteven Rostedt (Red Hat) 	 */
2448fef5aeeeSSteven Rostedt (Red Hat) 	if (removed_ops) {
2449fef5aeeeSSteven Rostedt (Red Hat) 		if (hash_contains_ip(ip, &removed_ops->old_hash))
245079922b80SSteven Rostedt (Red Hat) 			return removed_ops;
245179922b80SSteven Rostedt (Red Hat) 	}
245279922b80SSteven Rostedt (Red Hat) 
2453fef5aeeeSSteven Rostedt (Red Hat) 	/*
2454fef5aeeeSSteven Rostedt (Red Hat) 	 * Need to find the current trampoline for a rec.
2455fef5aeeeSSteven Rostedt (Red Hat) 	 * Now, a trampoline is only attached to a rec if there
2456fef5aeeeSSteven Rostedt (Red Hat) 	 * was a single 'ops' attached to it. But this can be called
2457fef5aeeeSSteven Rostedt (Red Hat) 	 * when we are adding another op to the rec or removing the
2458fef5aeeeSSteven Rostedt (Red Hat) 	 * current one. Thus, if the op is being added, we can
2459fef5aeeeSSteven Rostedt (Red Hat) 	 * ignore it because it hasn't attached itself to the rec
24604fc40904SSteven Rostedt (Red Hat) 	 * yet.
24614fc40904SSteven Rostedt (Red Hat) 	 *
24624fc40904SSteven Rostedt (Red Hat) 	 * If an ops is being modified (hooking to different functions)
24634fc40904SSteven Rostedt (Red Hat) 	 * then we don't care about the new functions that are being
24644fc40904SSteven Rostedt (Red Hat) 	 * added, just the old ones (that are probably being removed).
24654fc40904SSteven Rostedt (Red Hat) 	 *
24664fc40904SSteven Rostedt (Red Hat) 	 * If we are adding an ops to a function that already is using
24674fc40904SSteven Rostedt (Red Hat) 	 * a trampoline, it needs to be removed (trampolines are only
24684fc40904SSteven Rostedt (Red Hat) 	 * for single ops connected), then an ops that is not being
24694fc40904SSteven Rostedt (Red Hat) 	 * modified also needs to be checked.
2470fef5aeeeSSteven Rostedt (Red Hat) 	 */
247179922b80SSteven Rostedt (Red Hat) 	do_for_each_ftrace_op(op, ftrace_ops_list) {
2472fef5aeeeSSteven Rostedt (Red Hat) 
2473fef5aeeeSSteven Rostedt (Red Hat) 		if (!op->trampoline)
247479922b80SSteven Rostedt (Red Hat) 			continue;
247579922b80SSteven Rostedt (Red Hat) 
2476fef5aeeeSSteven Rostedt (Red Hat) 		/*
2477fef5aeeeSSteven Rostedt (Red Hat) 		 * If the ops is being added, it hasn't gotten to
2478fef5aeeeSSteven Rostedt (Red Hat) 		 * the point to be removed from this tree yet.
2479fef5aeeeSSteven Rostedt (Red Hat) 		 */
2480fef5aeeeSSteven Rostedt (Red Hat) 		if (op->flags & FTRACE_OPS_FL_ADDING)
2481fef5aeeeSSteven Rostedt (Red Hat) 			continue;
2482fef5aeeeSSteven Rostedt (Red Hat) 
2483fef5aeeeSSteven Rostedt (Red Hat) 
24844fc40904SSteven Rostedt (Red Hat) 		/*
24854fc40904SSteven Rostedt (Red Hat) 		 * If the ops is being modified and is in the old
24864fc40904SSteven Rostedt (Red Hat) 		 * hash, then it is probably being removed from this
24874fc40904SSteven Rostedt (Red Hat) 		 * function.
24884fc40904SSteven Rostedt (Red Hat) 		 */
2489fef5aeeeSSteven Rostedt (Red Hat) 		if ((op->flags & FTRACE_OPS_FL_MODIFYING) &&
2490fef5aeeeSSteven Rostedt (Red Hat) 		    hash_contains_ip(ip, &op->old_hash))
249179922b80SSteven Rostedt (Red Hat) 			return op;
24924fc40904SSteven Rostedt (Red Hat) 		/*
24934fc40904SSteven Rostedt (Red Hat) 		 * If the ops is not being added or modified, and it's
24944fc40904SSteven Rostedt (Red Hat) 		 * in its normal filter hash, then this must be the one
24954fc40904SSteven Rostedt (Red Hat) 		 * we want!
24964fc40904SSteven Rostedt (Red Hat) 		 */
24974fc40904SSteven Rostedt (Red Hat) 		if (!(op->flags & FTRACE_OPS_FL_MODIFYING) &&
24984fc40904SSteven Rostedt (Red Hat) 		    hash_contains_ip(ip, op->func_hash))
24994fc40904SSteven Rostedt (Red Hat) 			return op;
250079922b80SSteven Rostedt (Red Hat) 
250179922b80SSteven Rostedt (Red Hat) 	} while_for_each_ftrace_op(op);
250279922b80SSteven Rostedt (Red Hat) 
250379922b80SSteven Rostedt (Red Hat) 	return NULL;
250479922b80SSteven Rostedt (Red Hat) }
250579922b80SSteven Rostedt (Red Hat) 
250679922b80SSteven Rostedt (Red Hat) static struct ftrace_ops *
250779922b80SSteven Rostedt (Red Hat) ftrace_find_tramp_ops_new(struct dyn_ftrace *rec)
250879922b80SSteven Rostedt (Red Hat) {
250979922b80SSteven Rostedt (Red Hat) 	struct ftrace_ops *op;
2510fef5aeeeSSteven Rostedt (Red Hat) 	unsigned long ip = rec->ip;
251179922b80SSteven Rostedt (Red Hat) 
251279922b80SSteven Rostedt (Red Hat) 	do_for_each_ftrace_op(op, ftrace_ops_list) {
251379922b80SSteven Rostedt (Red Hat) 		/* pass rec in as regs to have non-NULL val */
2514fef5aeeeSSteven Rostedt (Red Hat) 		if (hash_contains_ip(ip, op->func_hash))
251579922b80SSteven Rostedt (Red Hat) 			return op;
251679922b80SSteven Rostedt (Red Hat) 	} while_for_each_ftrace_op(op);
251779922b80SSteven Rostedt (Red Hat) 
251879922b80SSteven Rostedt (Red Hat) 	return NULL;
251979922b80SSteven Rostedt (Red Hat) }
252079922b80SSteven Rostedt (Red Hat) 
2521cbad0fb2SMark Rutland struct ftrace_ops *
2522cbad0fb2SMark Rutland ftrace_find_unique_ops(struct dyn_ftrace *rec)
2523cbad0fb2SMark Rutland {
2524cbad0fb2SMark Rutland 	struct ftrace_ops *op, *found = NULL;
2525cbad0fb2SMark Rutland 	unsigned long ip = rec->ip;
2526cbad0fb2SMark Rutland 
2527cbad0fb2SMark Rutland 	do_for_each_ftrace_op(op, ftrace_ops_list) {
2528cbad0fb2SMark Rutland 
2529cbad0fb2SMark Rutland 		if (hash_contains_ip(ip, op->func_hash)) {
2530cbad0fb2SMark Rutland 			if (found)
2531cbad0fb2SMark Rutland 				return NULL;
2532cbad0fb2SMark Rutland 			found = op;
2533cbad0fb2SMark Rutland 		}
2534cbad0fb2SMark Rutland 
2535cbad0fb2SMark Rutland 	} while_for_each_ftrace_op(op);
2536cbad0fb2SMark Rutland 
2537cbad0fb2SMark Rutland 	return found;
2538cbad0fb2SMark Rutland }
2539cbad0fb2SMark Rutland 
2540763e34e7SSteven Rostedt (VMware) #ifdef CONFIG_DYNAMIC_FTRACE_WITH_DIRECT_CALLS
2541763e34e7SSteven Rostedt (VMware) /* Protected by rcu_tasks for reading, and direct_mutex for writing */
2542d05cb470SSteven Rostedt (Google) static struct ftrace_hash __rcu *direct_functions = EMPTY_HASH;
2543763e34e7SSteven Rostedt (VMware) static DEFINE_MUTEX(direct_mutex);
2544763e34e7SSteven Rostedt (VMware) 
2545763e34e7SSteven Rostedt (VMware) /*
2546763e34e7SSteven Rostedt (VMware)  * Search the direct_functions hash to see if the given instruction pointer
2547763e34e7SSteven Rostedt (VMware)  * has a direct caller attached to it.
2548763e34e7SSteven Rostedt (VMware)  */
2549ff205766SAlexei Starovoitov unsigned long ftrace_find_rec_direct(unsigned long ip)
2550763e34e7SSteven Rostedt (VMware) {
2551763e34e7SSteven Rostedt (VMware) 	struct ftrace_func_entry *entry;
2552763e34e7SSteven Rostedt (VMware) 
2553763e34e7SSteven Rostedt (VMware) 	entry = __ftrace_lookup_ip(direct_functions, ip);
2554763e34e7SSteven Rostedt (VMware) 	if (!entry)
2555763e34e7SSteven Rostedt (VMware) 		return 0;
2556763e34e7SSteven Rostedt (VMware) 
2557763e34e7SSteven Rostedt (VMware) 	return entry->direct;
2558763e34e7SSteven Rostedt (VMware) }
2559763e34e7SSteven Rostedt (VMware) 
2560763e34e7SSteven Rostedt (VMware) static void call_direct_funcs(unsigned long ip, unsigned long pip,
2561d19ad077SSteven Rostedt (VMware) 			      struct ftrace_ops *ops, struct ftrace_regs *fregs)
2562763e34e7SSteven Rostedt (VMware) {
2563dbaccb61SFlorent Revest 	unsigned long addr = READ_ONCE(ops->direct_call);
2564763e34e7SSteven Rostedt (VMware) 
2565763e34e7SSteven Rostedt (VMware) 	if (!addr)
2566763e34e7SSteven Rostedt (VMware) 		return;
2567763e34e7SSteven Rostedt (VMware) 
25689705bc70SMark Rutland 	arch_ftrace_set_direct_caller(fregs, addr);
2569763e34e7SSteven Rostedt (VMware) }
2570763e34e7SSteven Rostedt (VMware) #endif /* CONFIG_DYNAMIC_FTRACE_WITH_DIRECT_CALLS */
2571763e34e7SSteven Rostedt (VMware) 
25727413af1fSSteven Rostedt (Red Hat) /**
25737413af1fSSteven Rostedt (Red Hat)  * ftrace_get_addr_new - Get the call address to set to
25747413af1fSSteven Rostedt (Red Hat)  * @rec:  The ftrace record descriptor
25757413af1fSSteven Rostedt (Red Hat)  *
25767413af1fSSteven Rostedt (Red Hat)  * If the record has the FTRACE_FL_REGS set, that means that it
25777413af1fSSteven Rostedt (Red Hat)  * wants to convert to a callback that saves all regs. If FTRACE_FL_REGS
25785c8c206eSRandy Dunlap  * is not set, then it wants to convert to the normal callback.
25797413af1fSSteven Rostedt (Red Hat)  *
2580d1530413SRandy Dunlap  * Returns: the address of the trampoline to set to
25817413af1fSSteven Rostedt (Red Hat)  */
25827413af1fSSteven Rostedt (Red Hat) unsigned long ftrace_get_addr_new(struct dyn_ftrace *rec)
25837413af1fSSteven Rostedt (Red Hat) {
258479922b80SSteven Rostedt (Red Hat) 	struct ftrace_ops *ops;
2585763e34e7SSteven Rostedt (VMware) 	unsigned long addr;
2586763e34e7SSteven Rostedt (VMware) 
2587763e34e7SSteven Rostedt (VMware) 	if ((rec->flags & FTRACE_FL_DIRECT) &&
2588763e34e7SSteven Rostedt (VMware) 	    (ftrace_rec_count(rec) == 1)) {
2589ff205766SAlexei Starovoitov 		addr = ftrace_find_rec_direct(rec->ip);
2590763e34e7SSteven Rostedt (VMware) 		if (addr)
2591763e34e7SSteven Rostedt (VMware) 			return addr;
2592763e34e7SSteven Rostedt (VMware) 		WARN_ON_ONCE(1);
2593763e34e7SSteven Rostedt (VMware) 	}
259479922b80SSteven Rostedt (Red Hat) 
259579922b80SSteven Rostedt (Red Hat) 	/* Trampolines take precedence over regs */
259679922b80SSteven Rostedt (Red Hat) 	if (rec->flags & FTRACE_FL_TRAMP) {
259779922b80SSteven Rostedt (Red Hat) 		ops = ftrace_find_tramp_ops_new(rec);
259879922b80SSteven Rostedt (Red Hat) 		if (FTRACE_WARN_ON(!ops || !ops->trampoline)) {
2599bce0b6c5SSteven Rostedt (Red Hat) 			pr_warn("Bad trampoline accounting at: %p (%pS) (%lx)\n",
2600bce0b6c5SSteven Rostedt (Red Hat) 				(void *)rec->ip, (void *)rec->ip, rec->flags);
260179922b80SSteven Rostedt (Red Hat) 			/* Ftrace is shutting down, return anything */
260279922b80SSteven Rostedt (Red Hat) 			return (unsigned long)FTRACE_ADDR;
260379922b80SSteven Rostedt (Red Hat) 		}
260479922b80SSteven Rostedt (Red Hat) 		return ops->trampoline;
260579922b80SSteven Rostedt (Red Hat) 	}
260679922b80SSteven Rostedt (Red Hat) 
26077413af1fSSteven Rostedt (Red Hat) 	if (rec->flags & FTRACE_FL_REGS)
26087413af1fSSteven Rostedt (Red Hat) 		return (unsigned long)FTRACE_REGS_ADDR;
26097413af1fSSteven Rostedt (Red Hat) 	else
26107413af1fSSteven Rostedt (Red Hat) 		return (unsigned long)FTRACE_ADDR;
26117413af1fSSteven Rostedt (Red Hat) }
26127413af1fSSteven Rostedt (Red Hat) 
26137413af1fSSteven Rostedt (Red Hat) /**
26147413af1fSSteven Rostedt (Red Hat)  * ftrace_get_addr_curr - Get the call address that is already there
26157413af1fSSteven Rostedt (Red Hat)  * @rec:  The ftrace record descriptor
26167413af1fSSteven Rostedt (Red Hat)  *
26177413af1fSSteven Rostedt (Red Hat)  * The FTRACE_FL_REGS_EN is set when the record already points to
26187413af1fSSteven Rostedt (Red Hat)  * a function that saves all the regs. Basically the '_EN' version
26197413af1fSSteven Rostedt (Red Hat)  * represents the current state of the function.
26207413af1fSSteven Rostedt (Red Hat)  *
2621d1530413SRandy Dunlap  * Returns: the address of the trampoline that is currently being called
26227413af1fSSteven Rostedt (Red Hat)  */
26237413af1fSSteven Rostedt (Red Hat) unsigned long ftrace_get_addr_curr(struct dyn_ftrace *rec)
26247413af1fSSteven Rostedt (Red Hat) {
262579922b80SSteven Rostedt (Red Hat) 	struct ftrace_ops *ops;
2626763e34e7SSteven Rostedt (VMware) 	unsigned long addr;
2627763e34e7SSteven Rostedt (VMware) 
2628763e34e7SSteven Rostedt (VMware) 	/* Direct calls take precedence over trampolines */
2629763e34e7SSteven Rostedt (VMware) 	if (rec->flags & FTRACE_FL_DIRECT_EN) {
2630ff205766SAlexei Starovoitov 		addr = ftrace_find_rec_direct(rec->ip);
2631763e34e7SSteven Rostedt (VMware) 		if (addr)
2632763e34e7SSteven Rostedt (VMware) 			return addr;
2633763e34e7SSteven Rostedt (VMware) 		WARN_ON_ONCE(1);
2634763e34e7SSteven Rostedt (VMware) 	}
263579922b80SSteven Rostedt (Red Hat) 
263679922b80SSteven Rostedt (Red Hat) 	/* Trampolines take precedence over regs */
263779922b80SSteven Rostedt (Red Hat) 	if (rec->flags & FTRACE_FL_TRAMP_EN) {
263879922b80SSteven Rostedt (Red Hat) 		ops = ftrace_find_tramp_ops_curr(rec);
263979922b80SSteven Rostedt (Red Hat) 		if (FTRACE_WARN_ON(!ops)) {
2640a395d6a7SJoe Perches 			pr_warn("Bad trampoline accounting at: %p (%pS)\n",
264179922b80SSteven Rostedt (Red Hat) 				(void *)rec->ip, (void *)rec->ip);
264279922b80SSteven Rostedt (Red Hat) 			/* Ftrace is shutting down, return anything */
264379922b80SSteven Rostedt (Red Hat) 			return (unsigned long)FTRACE_ADDR;
264479922b80SSteven Rostedt (Red Hat) 		}
264579922b80SSteven Rostedt (Red Hat) 		return ops->trampoline;
264679922b80SSteven Rostedt (Red Hat) 	}
264779922b80SSteven Rostedt (Red Hat) 
26487413af1fSSteven Rostedt (Red Hat) 	if (rec->flags & FTRACE_FL_REGS_EN)
26497413af1fSSteven Rostedt (Red Hat) 		return (unsigned long)FTRACE_REGS_ADDR;
26507413af1fSSteven Rostedt (Red Hat) 	else
26517413af1fSSteven Rostedt (Red Hat) 		return (unsigned long)FTRACE_ADDR;
26527413af1fSSteven Rostedt (Red Hat) }
26537413af1fSSteven Rostedt (Red Hat) 
2654c88fd863SSteven Rostedt static int
26557375dca1SSteven Rostedt (VMware) __ftrace_replace_code(struct dyn_ftrace *rec, bool enable)
2656c88fd863SSteven Rostedt {
265708f6fba5SSteven Rostedt 	unsigned long ftrace_old_addr;
2658c88fd863SSteven Rostedt 	unsigned long ftrace_addr;
2659c88fd863SSteven Rostedt 	int ret;
2660c88fd863SSteven Rostedt 
26617c0868e0SSteven Rostedt (Red Hat) 	ftrace_addr = ftrace_get_addr_new(rec);
2662c88fd863SSteven Rostedt 
26637c0868e0SSteven Rostedt (Red Hat) 	/* This needs to be done before we call ftrace_update_record */
26647c0868e0SSteven Rostedt (Red Hat) 	ftrace_old_addr = ftrace_get_addr_curr(rec);
26657c0868e0SSteven Rostedt (Red Hat) 
26667c0868e0SSteven Rostedt (Red Hat) 	ret = ftrace_update_record(rec, enable);
266708f6fba5SSteven Rostedt 
266802a392a0SSteven Rostedt (Red Hat) 	ftrace_bug_type = FTRACE_BUG_UNKNOWN;
266902a392a0SSteven Rostedt (Red Hat) 
2670c88fd863SSteven Rostedt 	switch (ret) {
2671c88fd863SSteven Rostedt 	case FTRACE_UPDATE_IGNORE:
2672c88fd863SSteven Rostedt 		return 0;
2673c88fd863SSteven Rostedt 
2674c88fd863SSteven Rostedt 	case FTRACE_UPDATE_MAKE_CALL:
267502a392a0SSteven Rostedt (Red Hat) 		ftrace_bug_type = FTRACE_BUG_CALL;
2676c88fd863SSteven Rostedt 		return ftrace_make_call(rec, ftrace_addr);
2677c88fd863SSteven Rostedt 
2678c88fd863SSteven Rostedt 	case FTRACE_UPDATE_MAKE_NOP:
267902a392a0SSteven Rostedt (Red Hat) 		ftrace_bug_type = FTRACE_BUG_NOP;
268039b5552cSSteven Rostedt (Red Hat) 		return ftrace_make_nop(NULL, rec, ftrace_old_addr);
268108f6fba5SSteven Rostedt 
268208f6fba5SSteven Rostedt 	case FTRACE_UPDATE_MODIFY_CALL:
268302a392a0SSteven Rostedt (Red Hat) 		ftrace_bug_type = FTRACE_BUG_UPDATE;
268408f6fba5SSteven Rostedt 		return ftrace_modify_call(rec, ftrace_old_addr, ftrace_addr);
26853d083395SSteven Rostedt 	}
26863d083395SSteven Rostedt 
26879efb85c5SHariprasad Kelam 	return -1; /* unknown ftrace bug */
2688c88fd863SSteven Rostedt }
2689c88fd863SSteven Rostedt 
2690a0572f68SSteven Rostedt (VMware) void __weak ftrace_replace_code(int mod_flags)
26913d083395SSteven Rostedt {
26923d083395SSteven Rostedt 	struct dyn_ftrace *rec;
26933d083395SSteven Rostedt 	struct ftrace_page *pg;
26947375dca1SSteven Rostedt (VMware) 	bool enable = mod_flags & FTRACE_MODIFY_ENABLE_FL;
2695a0572f68SSteven Rostedt (VMware) 	int schedulable = mod_flags & FTRACE_MODIFY_MAY_SLEEP_FL;
26966a24a244SSteven Rostedt 	int failed;
26973d083395SSteven Rostedt 
269845a4a237SSteven Rostedt 	if (unlikely(ftrace_disabled))
269945a4a237SSteven Rostedt 		return;
270045a4a237SSteven Rostedt 
2701265c831cSSteven Rostedt 	do_for_each_ftrace_rec(pg, rec) {
2702546fece4SSteven Rostedt (Red Hat) 
2703cf04f2d5SSteven Rostedt (Google) 		if (skip_record(rec))
2704546fece4SSteven Rostedt (Red Hat) 			continue;
2705546fece4SSteven Rostedt (Red Hat) 
2706e4f5d544SSteven Rostedt 		failed = __ftrace_replace_code(rec, enable);
2707fa9d13cfSZhaolei 		if (failed) {
27084fd3279bSSteven Rostedt (Red Hat) 			ftrace_bug(failed, rec);
27094377245aSSteven Rostedt 			/* Stop processing */
27104377245aSSteven Rostedt 			return;
27114377245aSSteven Rostedt 		}
2712a0572f68SSteven Rostedt (VMware) 		if (schedulable)
2713a0572f68SSteven Rostedt (VMware) 			cond_resched();
2714265c831cSSteven Rostedt 	} while_for_each_ftrace_rec();
27153d083395SSteven Rostedt }
27163c1720f0SSteven Rostedt 
2717c88fd863SSteven Rostedt struct ftrace_rec_iter {
2718c88fd863SSteven Rostedt 	struct ftrace_page	*pg;
2719c88fd863SSteven Rostedt 	int			index;
2720c88fd863SSteven Rostedt };
2721c88fd863SSteven Rostedt 
2722c88fd863SSteven Rostedt /**
27236130722fSSteven Rostedt (VMware)  * ftrace_rec_iter_start - start up iterating over traced functions
2724c88fd863SSteven Rostedt  *
2725d1530413SRandy Dunlap  * Returns: an iterator handle that is used to iterate over all
2726c88fd863SSteven Rostedt  * the records that represent address locations where functions
2727c88fd863SSteven Rostedt  * are traced.
2728c88fd863SSteven Rostedt  *
2729c88fd863SSteven Rostedt  * May return NULL if no records are available.
2730c88fd863SSteven Rostedt  */
2731c88fd863SSteven Rostedt struct ftrace_rec_iter *ftrace_rec_iter_start(void)
2732c88fd863SSteven Rostedt {
2733c88fd863SSteven Rostedt 	/*
2734c88fd863SSteven Rostedt 	 * We only use a single iterator.
2735c88fd863SSteven Rostedt 	 * Protected by the ftrace_lock mutex.
2736c88fd863SSteven Rostedt 	 */
2737c88fd863SSteven Rostedt 	static struct ftrace_rec_iter ftrace_rec_iter;
2738c88fd863SSteven Rostedt 	struct ftrace_rec_iter *iter = &ftrace_rec_iter;
2739c88fd863SSteven Rostedt 
2740c88fd863SSteven Rostedt 	iter->pg = ftrace_pages_start;
2741c88fd863SSteven Rostedt 	iter->index = 0;
2742c88fd863SSteven Rostedt 
2743c88fd863SSteven Rostedt 	/* Could have empty pages */
2744c88fd863SSteven Rostedt 	while (iter->pg && !iter->pg->index)
2745c88fd863SSteven Rostedt 		iter->pg = iter->pg->next;
2746c88fd863SSteven Rostedt 
2747c88fd863SSteven Rostedt 	if (!iter->pg)
2748c88fd863SSteven Rostedt 		return NULL;
2749c88fd863SSteven Rostedt 
2750c88fd863SSteven Rostedt 	return iter;
2751c88fd863SSteven Rostedt }
2752c88fd863SSteven Rostedt 
2753c88fd863SSteven Rostedt /**
27546130722fSSteven Rostedt (VMware)  * ftrace_rec_iter_next - get the next record to process.
2755c88fd863SSteven Rostedt  * @iter: The handle to the iterator.
2756c88fd863SSteven Rostedt  *
2757d1530413SRandy Dunlap  * Returns: the next iterator after the given iterator @iter.
2758c88fd863SSteven Rostedt  */
2759c88fd863SSteven Rostedt struct ftrace_rec_iter *ftrace_rec_iter_next(struct ftrace_rec_iter *iter)
2760c88fd863SSteven Rostedt {
2761c88fd863SSteven Rostedt 	iter->index++;
2762c88fd863SSteven Rostedt 
2763c88fd863SSteven Rostedt 	if (iter->index >= iter->pg->index) {
2764c88fd863SSteven Rostedt 		iter->pg = iter->pg->next;
2765c88fd863SSteven Rostedt 		iter->index = 0;
2766c88fd863SSteven Rostedt 
2767c88fd863SSteven Rostedt 		/* Could have empty pages */
2768c88fd863SSteven Rostedt 		while (iter->pg && !iter->pg->index)
2769c88fd863SSteven Rostedt 			iter->pg = iter->pg->next;
2770c88fd863SSteven Rostedt 	}
2771c88fd863SSteven Rostedt 
2772c88fd863SSteven Rostedt 	if (!iter->pg)
2773c88fd863SSteven Rostedt 		return NULL;
2774c88fd863SSteven Rostedt 
2775c88fd863SSteven Rostedt 	return iter;
2776c88fd863SSteven Rostedt }
2777c88fd863SSteven Rostedt 
2778c88fd863SSteven Rostedt /**
27796130722fSSteven Rostedt (VMware)  * ftrace_rec_iter_record - get the record at the iterator location
2780c88fd863SSteven Rostedt  * @iter: The current iterator location
2781c88fd863SSteven Rostedt  *
2782d1530413SRandy Dunlap  * Returns: the record that the current @iter is at.
2783c88fd863SSteven Rostedt  */
2784c88fd863SSteven Rostedt struct dyn_ftrace *ftrace_rec_iter_record(struct ftrace_rec_iter *iter)
2785c88fd863SSteven Rostedt {
2786c88fd863SSteven Rostedt 	return &iter->pg->records[iter->index];
2787c88fd863SSteven Rostedt }
2788c88fd863SSteven Rostedt 
27893b47bfc1SSteven Rostedt static int
2790fbf6c73cSMark Rutland ftrace_nop_initialize(struct module *mod, struct dyn_ftrace *rec)
27913c1720f0SSteven Rostedt {
2792492a7ea5SAbhishek Sagar 	int ret;
279337ad5084SSteven Rostedt 
279445a4a237SSteven Rostedt 	if (unlikely(ftrace_disabled))
279545a4a237SSteven Rostedt 		return 0;
279645a4a237SSteven Rostedt 
2797fbf6c73cSMark Rutland 	ret = ftrace_init_nop(mod, rec);
27983d083395SSteven Rostedt 	if (ret) {
279902a392a0SSteven Rostedt (Red Hat) 		ftrace_bug_type = FTRACE_BUG_INIT;
28004fd3279bSSteven Rostedt (Red Hat) 		ftrace_bug(ret, rec);
28013d083395SSteven Rostedt 		return 0;
2802d61f82d0SSteven Rostedt 	}
2803d61f82d0SSteven Rostedt 	return 1;
28043d083395SSteven Rostedt }
28053d083395SSteven Rostedt 
2806000ab691SSteven Rostedt /*
2807000ab691SSteven Rostedt  * archs can override this function if they must do something
2808000ab691SSteven Rostedt  * before the modifying code is performed.
2809000ab691SSteven Rostedt  */
28103a2bfec0SLi kunyu void __weak ftrace_arch_code_modify_prepare(void)
2811000ab691SSteven Rostedt {
2812000ab691SSteven Rostedt }
2813000ab691SSteven Rostedt 
2814000ab691SSteven Rostedt /*
2815000ab691SSteven Rostedt  * archs can override this function if they must do something
2816000ab691SSteven Rostedt  * after the modifying code is performed.
2817000ab691SSteven Rostedt  */
28183a2bfec0SLi kunyu void __weak ftrace_arch_code_modify_post_process(void)
2819000ab691SSteven Rostedt {
2820000ab691SSteven Rostedt }
2821000ab691SSteven Rostedt 
2822bd604f3dSSteven Rostedt (Google) static int update_ftrace_func(ftrace_func_t func)
2823bd604f3dSSteven Rostedt (Google) {
2824bd604f3dSSteven Rostedt (Google) 	static ftrace_func_t save_func;
2825bd604f3dSSteven Rostedt (Google) 
2826bd604f3dSSteven Rostedt (Google) 	/* Avoid updating if it hasn't changed */
2827bd604f3dSSteven Rostedt (Google) 	if (func == save_func)
2828bd604f3dSSteven Rostedt (Google) 		return 0;
2829bd604f3dSSteven Rostedt (Google) 
2830bd604f3dSSteven Rostedt (Google) 	save_func = func;
2831bd604f3dSSteven Rostedt (Google) 
2832bd604f3dSSteven Rostedt (Google) 	return ftrace_update_ftrace_func(func);
2833bd604f3dSSteven Rostedt (Google) }
2834bd604f3dSSteven Rostedt (Google) 
28358ed3e2cfSSteven Rostedt void ftrace_modify_all_code(int command)
28368ed3e2cfSSteven Rostedt {
283759338f75SSteven Rostedt (Red Hat) 	int update = command & FTRACE_UPDATE_TRACE_FUNC;
2838a0572f68SSteven Rostedt (VMware) 	int mod_flags = 0;
2839cd21067fSPetr Mladek 	int err = 0;
284059338f75SSteven Rostedt (Red Hat) 
2841a0572f68SSteven Rostedt (VMware) 	if (command & FTRACE_MAY_SLEEP)
2842a0572f68SSteven Rostedt (VMware) 		mod_flags = FTRACE_MODIFY_MAY_SLEEP_FL;
2843a0572f68SSteven Rostedt (VMware) 
284459338f75SSteven Rostedt (Red Hat) 	/*
284559338f75SSteven Rostedt (Red Hat) 	 * If the ftrace_caller calls a ftrace_ops func directly,
284659338f75SSteven Rostedt (Red Hat) 	 * we need to make sure that it only traces functions it
284759338f75SSteven Rostedt (Red Hat) 	 * expects to trace. When doing the switch of functions,
284859338f75SSteven Rostedt (Red Hat) 	 * we need to update to the ftrace_ops_list_func first
284959338f75SSteven Rostedt (Red Hat) 	 * before the transition between old and new calls are set,
285059338f75SSteven Rostedt (Red Hat) 	 * as the ftrace_ops_list_func will check the ops hashes
285159338f75SSteven Rostedt (Red Hat) 	 * to make sure the ops are having the right functions
285259338f75SSteven Rostedt (Red Hat) 	 * traced.
285359338f75SSteven Rostedt (Red Hat) 	 */
2854cd21067fSPetr Mladek 	if (update) {
2855bd604f3dSSteven Rostedt (Google) 		err = update_ftrace_func(ftrace_ops_list_func);
2856cd21067fSPetr Mladek 		if (FTRACE_WARN_ON(err))
2857cd21067fSPetr Mladek 			return;
2858cd21067fSPetr Mladek 	}
285959338f75SSteven Rostedt (Red Hat) 
28608ed3e2cfSSteven Rostedt 	if (command & FTRACE_UPDATE_CALLS)
2861a0572f68SSteven Rostedt (VMware) 		ftrace_replace_code(mod_flags | FTRACE_MODIFY_ENABLE_FL);
28628ed3e2cfSSteven Rostedt 	else if (command & FTRACE_DISABLE_CALLS)
2863a0572f68SSteven Rostedt (VMware) 		ftrace_replace_code(mod_flags);
28648ed3e2cfSSteven Rostedt 
2865405e1d83SSteven Rostedt (Red Hat) 	if (update && ftrace_trace_function != ftrace_ops_list_func) {
2866405e1d83SSteven Rostedt (Red Hat) 		function_trace_op = set_function_trace_op;
2867405e1d83SSteven Rostedt (Red Hat) 		smp_wmb();
2868405e1d83SSteven Rostedt (Red Hat) 		/* If irqs are disabled, we are in stop machine */
2869405e1d83SSteven Rostedt (Red Hat) 		if (!irqs_disabled())
2870405e1d83SSteven Rostedt (Red Hat) 			smp_call_function(ftrace_sync_ipi, NULL, 1);
2871bd604f3dSSteven Rostedt (Google) 		err = update_ftrace_func(ftrace_trace_function);
2872cd21067fSPetr Mladek 		if (FTRACE_WARN_ON(err))
2873cd21067fSPetr Mladek 			return;
2874405e1d83SSteven Rostedt (Red Hat) 	}
28758ed3e2cfSSteven Rostedt 
28768ed3e2cfSSteven Rostedt 	if (command & FTRACE_START_FUNC_RET)
2877cd21067fSPetr Mladek 		err = ftrace_enable_ftrace_graph_caller();
28788ed3e2cfSSteven Rostedt 	else if (command & FTRACE_STOP_FUNC_RET)
2879cd21067fSPetr Mladek 		err = ftrace_disable_ftrace_graph_caller();
2880cd21067fSPetr Mladek 	FTRACE_WARN_ON(err);
28818ed3e2cfSSteven Rostedt }
28828ed3e2cfSSteven Rostedt 
28833d083395SSteven Rostedt static int __ftrace_modify_code(void *data)
28843d083395SSteven Rostedt {
28853d083395SSteven Rostedt 	int *command = data;
28863d083395SSteven Rostedt 
28878ed3e2cfSSteven Rostedt 	ftrace_modify_all_code(*command);
28885a45cfe1SSteven Rostedt 
2889c88fd863SSteven Rostedt 	return 0;
2890c88fd863SSteven Rostedt }
2891c88fd863SSteven Rostedt 
2892c88fd863SSteven Rostedt /**
28936130722fSSteven Rostedt (VMware)  * ftrace_run_stop_machine - go back to the stop machine method
2894c88fd863SSteven Rostedt  * @command: The command to tell ftrace what to do
2895c88fd863SSteven Rostedt  *
2896c88fd863SSteven Rostedt  * If an arch needs to fall back to the stop machine method, the
2897c88fd863SSteven Rostedt  * it can call this function.
2898c88fd863SSteven Rostedt  */
2899c88fd863SSteven Rostedt void ftrace_run_stop_machine(int command)
2900c88fd863SSteven Rostedt {
2901c88fd863SSteven Rostedt 	stop_machine(__ftrace_modify_code, &command, NULL);
2902c88fd863SSteven Rostedt }
2903c88fd863SSteven Rostedt 
2904c88fd863SSteven Rostedt /**
29056130722fSSteven Rostedt (VMware)  * arch_ftrace_update_code - modify the code to trace or not trace
2906c88fd863SSteven Rostedt  * @command: The command that needs to be done
2907c88fd863SSteven Rostedt  *
2908c88fd863SSteven Rostedt  * Archs can override this function if it does not need to
2909c88fd863SSteven Rostedt  * run stop_machine() to modify code.
2910c88fd863SSteven Rostedt  */
2911c88fd863SSteven Rostedt void __weak arch_ftrace_update_code(int command)
2912c88fd863SSteven Rostedt {
2913c88fd863SSteven Rostedt 	ftrace_run_stop_machine(command);
2914c88fd863SSteven Rostedt }
2915c88fd863SSteven Rostedt 
2916c88fd863SSteven Rostedt static void ftrace_run_update_code(int command)
2917c88fd863SSteven Rostedt {
29183a2bfec0SLi kunyu 	ftrace_arch_code_modify_prepare();
2919c88fd863SSteven Rostedt 
2920c88fd863SSteven Rostedt 	/*
2921c88fd863SSteven Rostedt 	 * By default we use stop_machine() to modify the code.
2922c88fd863SSteven Rostedt 	 * But archs can do what ever they want as long as it
2923c88fd863SSteven Rostedt 	 * is safe. The stop_machine() is the safest, but also
2924c88fd863SSteven Rostedt 	 * produces the most overhead.
2925c88fd863SSteven Rostedt 	 */
2926c88fd863SSteven Rostedt 	arch_ftrace_update_code(command);
2927c88fd863SSteven Rostedt 
29283a2bfec0SLi kunyu 	ftrace_arch_code_modify_post_process();
29293d083395SSteven Rostedt }
29303d083395SSteven Rostedt 
29318252ecf3SSteven Rostedt (Red Hat) static void ftrace_run_modify_code(struct ftrace_ops *ops, int command,
29327485058eSSteven Rostedt (Red Hat) 				   struct ftrace_ops_hash *old_hash)
2933e1effa01SSteven Rostedt (Red Hat) {
2934e1effa01SSteven Rostedt (Red Hat) 	ops->flags |= FTRACE_OPS_FL_MODIFYING;
29357485058eSSteven Rostedt (Red Hat) 	ops->old_hash.filter_hash = old_hash->filter_hash;
29367485058eSSteven Rostedt (Red Hat) 	ops->old_hash.notrace_hash = old_hash->notrace_hash;
2937e1effa01SSteven Rostedt (Red Hat) 	ftrace_run_update_code(command);
29388252ecf3SSteven Rostedt (Red Hat) 	ops->old_hash.filter_hash = NULL;
29397485058eSSteven Rostedt (Red Hat) 	ops->old_hash.notrace_hash = NULL;
2940e1effa01SSteven Rostedt (Red Hat) 	ops->flags &= ~FTRACE_OPS_FL_MODIFYING;
2941e1effa01SSteven Rostedt (Red Hat) }
2942e1effa01SSteven Rostedt (Red Hat) 
29433d083395SSteven Rostedt static ftrace_func_t saved_ftrace_func;
294460a7ecf4SSteven Rostedt static int ftrace_start_up;
2945df4fc315SSteven Rostedt 
294612cce594SSteven Rostedt (Red Hat) void __weak arch_ftrace_trampoline_free(struct ftrace_ops *ops)
294712cce594SSteven Rostedt (Red Hat) {
294812cce594SSteven Rostedt (Red Hat) }
294912cce594SSteven Rostedt (Red Hat) 
2950fc0ea795SAdrian Hunter /* List of trace_ops that have allocated trampolines */
2951fc0ea795SAdrian Hunter static LIST_HEAD(ftrace_ops_trampoline_list);
2952fc0ea795SAdrian Hunter 
2953fc0ea795SAdrian Hunter static void ftrace_add_trampoline_to_kallsyms(struct ftrace_ops *ops)
2954fc0ea795SAdrian Hunter {
2955fc0ea795SAdrian Hunter 	lockdep_assert_held(&ftrace_lock);
2956fc0ea795SAdrian Hunter 	list_add_rcu(&ops->list, &ftrace_ops_trampoline_list);
2957fc0ea795SAdrian Hunter }
2958fc0ea795SAdrian Hunter 
2959fc0ea795SAdrian Hunter static void ftrace_remove_trampoline_from_kallsyms(struct ftrace_ops *ops)
2960fc0ea795SAdrian Hunter {
2961fc0ea795SAdrian Hunter 	lockdep_assert_held(&ftrace_lock);
2962fc0ea795SAdrian Hunter 	list_del_rcu(&ops->list);
2963478ece95SAdrian Hunter 	synchronize_rcu();
2964fc0ea795SAdrian Hunter }
2965fc0ea795SAdrian Hunter 
2966fc0ea795SAdrian Hunter /*
2967fc0ea795SAdrian Hunter  * "__builtin__ftrace" is used as a module name in /proc/kallsyms for symbols
2968fc0ea795SAdrian Hunter  * for pages allocated for ftrace purposes, even though "__builtin__ftrace" is
2969fc0ea795SAdrian Hunter  * not a module.
2970fc0ea795SAdrian Hunter  */
2971fc0ea795SAdrian Hunter #define FTRACE_TRAMPOLINE_MOD "__builtin__ftrace"
2972fc0ea795SAdrian Hunter #define FTRACE_TRAMPOLINE_SYM "ftrace_trampoline"
2973fc0ea795SAdrian Hunter 
2974fc0ea795SAdrian Hunter static void ftrace_trampoline_free(struct ftrace_ops *ops)
2975fc0ea795SAdrian Hunter {
2976fc0ea795SAdrian Hunter 	if (ops && (ops->flags & FTRACE_OPS_FL_ALLOC_TRAMP) &&
2977dd9ddf46SAdrian Hunter 	    ops->trampoline) {
2978548e1f6cSAdrian Hunter 		/*
2979548e1f6cSAdrian Hunter 		 * Record the text poke event before the ksymbol unregister
2980548e1f6cSAdrian Hunter 		 * event.
2981548e1f6cSAdrian Hunter 		 */
2982548e1f6cSAdrian Hunter 		perf_event_text_poke((void *)ops->trampoline,
2983548e1f6cSAdrian Hunter 				     (void *)ops->trampoline,
2984548e1f6cSAdrian Hunter 				     ops->trampoline_size, NULL, 0);
2985dd9ddf46SAdrian Hunter 		perf_event_ksymbol(PERF_RECORD_KSYMBOL_TYPE_OOL,
2986dd9ddf46SAdrian Hunter 				   ops->trampoline, ops->trampoline_size,
2987dd9ddf46SAdrian Hunter 				   true, FTRACE_TRAMPOLINE_SYM);
2988dd9ddf46SAdrian Hunter 		/* Remove from kallsyms after the perf events */
2989fc0ea795SAdrian Hunter 		ftrace_remove_trampoline_from_kallsyms(ops);
2990dd9ddf46SAdrian Hunter 	}
2991fc0ea795SAdrian Hunter 
2992fc0ea795SAdrian Hunter 	arch_ftrace_trampoline_free(ops);
2993fc0ea795SAdrian Hunter }
2994fc0ea795SAdrian Hunter 
2995df4fc315SSteven Rostedt static void ftrace_startup_enable(int command)
2996df4fc315SSteven Rostedt {
2997df4fc315SSteven Rostedt 	if (saved_ftrace_func != ftrace_trace_function) {
2998df4fc315SSteven Rostedt 		saved_ftrace_func = ftrace_trace_function;
2999df4fc315SSteven Rostedt 		command |= FTRACE_UPDATE_TRACE_FUNC;
3000df4fc315SSteven Rostedt 	}
3001df4fc315SSteven Rostedt 
3002df4fc315SSteven Rostedt 	if (!command || !ftrace_enabled)
3003df4fc315SSteven Rostedt 		return;
3004df4fc315SSteven Rostedt 
3005df4fc315SSteven Rostedt 	ftrace_run_update_code(command);
3006df4fc315SSteven Rostedt }
30073d083395SSteven Rostedt 
3008e1effa01SSteven Rostedt (Red Hat) static void ftrace_startup_all(int command)
3009e1effa01SSteven Rostedt (Red Hat) {
3010e1effa01SSteven Rostedt (Red Hat) 	update_all_ops = true;
3011e1effa01SSteven Rostedt (Red Hat) 	ftrace_startup_enable(command);
3012e1effa01SSteven Rostedt (Red Hat) 	update_all_ops = false;
3013e1effa01SSteven Rostedt (Red Hat) }
3014e1effa01SSteven Rostedt (Red Hat) 
30153306fc4aSSteven Rostedt (VMware) int ftrace_startup(struct ftrace_ops *ops, int command)
30163d083395SSteven Rostedt {
30178a56d776SSteven Rostedt (Red Hat) 	int ret;
3018b848914cSSteven Rostedt 
30194eebcc81SSteven Rostedt 	if (unlikely(ftrace_disabled))
3020a1cd6173SSteven Rostedt 		return -ENODEV;
30214eebcc81SSteven Rostedt 
30228a56d776SSteven Rostedt (Red Hat) 	ret = __register_ftrace_function(ops);
30238a56d776SSteven Rostedt (Red Hat) 	if (ret)
30248a56d776SSteven Rostedt (Red Hat) 		return ret;
30258a56d776SSteven Rostedt (Red Hat) 
302660a7ecf4SSteven Rostedt 	ftrace_start_up++;
30273d083395SSteven Rostedt 
3028e1effa01SSteven Rostedt (Red Hat) 	/*
3029e1effa01SSteven Rostedt (Red Hat) 	 * Note that ftrace probes uses this to start up
3030e1effa01SSteven Rostedt (Red Hat) 	 * and modify functions it will probe. But we still
3031e1effa01SSteven Rostedt (Red Hat) 	 * set the ADDING flag for modification, as probes
3032e1effa01SSteven Rostedt (Red Hat) 	 * do not have trampolines. If they add them in the
3033e1effa01SSteven Rostedt (Red Hat) 	 * future, then the probes will need to distinguish
3034e1effa01SSteven Rostedt (Red Hat) 	 * between adding and updating probes.
3035e1effa01SSteven Rostedt (Red Hat) 	 */
3036e1effa01SSteven Rostedt (Red Hat) 	ops->flags |= FTRACE_OPS_FL_ENABLED | FTRACE_OPS_FL_ADDING;
303766209a5bSSteven Rostedt (Red Hat) 
3038f8b8be8aSMasami Hiramatsu 	ret = ftrace_hash_ipmodify_enable(ops);
3039f8b8be8aSMasami Hiramatsu 	if (ret < 0) {
3040f8b8be8aSMasami Hiramatsu 		/* Rollback registration process */
3041f8b8be8aSMasami Hiramatsu 		__unregister_ftrace_function(ops);
3042f8b8be8aSMasami Hiramatsu 		ftrace_start_up--;
3043f8b8be8aSMasami Hiramatsu 		ops->flags &= ~FTRACE_OPS_FL_ENABLED;
3044d5e47505SMiroslav Benes 		if (ops->flags & FTRACE_OPS_FL_DYNAMIC)
3045d5e47505SMiroslav Benes 			ftrace_trampoline_free(ops);
3046f8b8be8aSMasami Hiramatsu 		return ret;
3047f8b8be8aSMasami Hiramatsu 	}
3048f8b8be8aSMasami Hiramatsu 
30497f50d06bSJiri Olsa 	if (ftrace_hash_rec_enable(ops, 1))
30507f50d06bSJiri Olsa 		command |= FTRACE_UPDATE_CALLS;
3051ed926f9bSSteven Rostedt 
3052df4fc315SSteven Rostedt 	ftrace_startup_enable(command);
3053a1cd6173SSteven Rostedt 
3054c3b0f72eSYang Jihong 	/*
3055c3b0f72eSYang Jihong 	 * If ftrace is in an undefined state, we just remove ops from list
3056c3b0f72eSYang Jihong 	 * to prevent the NULL pointer, instead of totally rolling it back and
3057c3b0f72eSYang Jihong 	 * free trampoline, because those actions could cause further damage.
3058c3b0f72eSYang Jihong 	 */
3059c3b0f72eSYang Jihong 	if (unlikely(ftrace_disabled)) {
3060c3b0f72eSYang Jihong 		__unregister_ftrace_function(ops);
3061c3b0f72eSYang Jihong 		return -ENODEV;
3062c3b0f72eSYang Jihong 	}
3063c3b0f72eSYang Jihong 
3064e1effa01SSteven Rostedt (Red Hat) 	ops->flags &= ~FTRACE_OPS_FL_ADDING;
3065e1effa01SSteven Rostedt (Red Hat) 
3066a1cd6173SSteven Rostedt 	return 0;
30673d083395SSteven Rostedt }
30683d083395SSteven Rostedt 
30693306fc4aSSteven Rostedt (VMware) int ftrace_shutdown(struct ftrace_ops *ops, int command)
30703d083395SSteven Rostedt {
30718a56d776SSteven Rostedt (Red Hat) 	int ret;
3072b848914cSSteven Rostedt 
30734eebcc81SSteven Rostedt 	if (unlikely(ftrace_disabled))
30748a56d776SSteven Rostedt (Red Hat) 		return -ENODEV;
30758a56d776SSteven Rostedt (Red Hat) 
30768a56d776SSteven Rostedt (Red Hat) 	ret = __unregister_ftrace_function(ops);
30778a56d776SSteven Rostedt (Red Hat) 	if (ret)
30788a56d776SSteven Rostedt (Red Hat) 		return ret;
30794eebcc81SSteven Rostedt 
308060a7ecf4SSteven Rostedt 	ftrace_start_up--;
30819ea1a153SFrederic Weisbecker 	/*
30829ea1a153SFrederic Weisbecker 	 * Just warn in case of unbalance, no need to kill ftrace, it's not
30839ea1a153SFrederic Weisbecker 	 * critical but the ftrace_call callers may be never nopped again after
30849ea1a153SFrederic Weisbecker 	 * further ftrace uses.
30859ea1a153SFrederic Weisbecker 	 */
30869ea1a153SFrederic Weisbecker 	WARN_ON_ONCE(ftrace_start_up < 0);
30879ea1a153SFrederic Weisbecker 
3088f8b8be8aSMasami Hiramatsu 	/* Disabling ipmodify never fails */
3089f8b8be8aSMasami Hiramatsu 	ftrace_hash_ipmodify_disable(ops);
30907f50d06bSJiri Olsa 
30917f50d06bSJiri Olsa 	if (ftrace_hash_rec_disable(ops, 1))
30927f50d06bSJiri Olsa 		command |= FTRACE_UPDATE_CALLS;
3093ed926f9bSSteven Rostedt 
3094ed926f9bSSteven Rostedt 	ops->flags &= ~FTRACE_OPS_FL_ENABLED;
3095b848914cSSteven Rostedt 
3096d61f82d0SSteven Rostedt 	if (saved_ftrace_func != ftrace_trace_function) {
3097d61f82d0SSteven Rostedt 		saved_ftrace_func = ftrace_trace_function;
3098d61f82d0SSteven Rostedt 		command |= FTRACE_UPDATE_TRACE_FUNC;
3099d61f82d0SSteven Rostedt 	}
3100d61f82d0SSteven Rostedt 
31010e792b89SLi Huafei 	if (!command || !ftrace_enabled)
31020e792b89SLi Huafei 		goto out;
31033d083395SSteven Rostedt 
310479922b80SSteven Rostedt (Red Hat) 	/*
310579922b80SSteven Rostedt (Red Hat) 	 * If the ops uses a trampoline, then it needs to be
310679922b80SSteven Rostedt (Red Hat) 	 * tested first on update.
310779922b80SSteven Rostedt (Red Hat) 	 */
3108e1effa01SSteven Rostedt (Red Hat) 	ops->flags |= FTRACE_OPS_FL_REMOVING;
310979922b80SSteven Rostedt (Red Hat) 	removed_ops = ops;
311079922b80SSteven Rostedt (Red Hat) 
3111fef5aeeeSSteven Rostedt (Red Hat) 	/* The trampoline logic checks the old hashes */
3112fef5aeeeSSteven Rostedt (Red Hat) 	ops->old_hash.filter_hash = ops->func_hash->filter_hash;
3113fef5aeeeSSteven Rostedt (Red Hat) 	ops->old_hash.notrace_hash = ops->func_hash->notrace_hash;
3114fef5aeeeSSteven Rostedt (Red Hat) 
3115d61f82d0SSteven Rostedt 	ftrace_run_update_code(command);
3116a4c35ed2SSteven Rostedt (Red Hat) 
311784bde62cSSteven Rostedt (Red Hat) 	/*
311884bde62cSSteven Rostedt (Red Hat) 	 * If there's no more ops registered with ftrace, run a
311984bde62cSSteven Rostedt (Red Hat) 	 * sanity check to make sure all rec flags are cleared.
312084bde62cSSteven Rostedt (Red Hat) 	 */
3121f86f4180SChunyan Zhang 	if (rcu_dereference_protected(ftrace_ops_list,
3122f86f4180SChunyan Zhang 			lockdep_is_held(&ftrace_lock)) == &ftrace_list_end) {
312384bde62cSSteven Rostedt (Red Hat) 		struct ftrace_page *pg;
312484bde62cSSteven Rostedt (Red Hat) 		struct dyn_ftrace *rec;
312584bde62cSSteven Rostedt (Red Hat) 
312684bde62cSSteven Rostedt (Red Hat) 		do_for_each_ftrace_rec(pg, rec) {
3127e11b521aSSteven Rostedt (Google) 			if (FTRACE_WARN_ON_ONCE(rec->flags & ~FTRACE_NOCLEAR_FLAGS))
312884bde62cSSteven Rostedt (Red Hat) 				pr_warn("  %pS flags:%lx\n",
312984bde62cSSteven Rostedt (Red Hat) 					(void *)rec->ip, rec->flags);
313084bde62cSSteven Rostedt (Red Hat) 		} while_for_each_ftrace_rec();
313184bde62cSSteven Rostedt (Red Hat) 	}
313284bde62cSSteven Rostedt (Red Hat) 
3133fef5aeeeSSteven Rostedt (Red Hat) 	ops->old_hash.filter_hash = NULL;
3134fef5aeeeSSteven Rostedt (Red Hat) 	ops->old_hash.notrace_hash = NULL;
3135fef5aeeeSSteven Rostedt (Red Hat) 
3136fef5aeeeSSteven Rostedt (Red Hat) 	removed_ops = NULL;
3137e1effa01SSteven Rostedt (Red Hat) 	ops->flags &= ~FTRACE_OPS_FL_REMOVING;
313879922b80SSteven Rostedt (Red Hat) 
31390e792b89SLi Huafei out:
3140a4c35ed2SSteven Rostedt (Red Hat) 	/*
3141a4c35ed2SSteven Rostedt (Red Hat) 	 * Dynamic ops may be freed, we must make sure that all
3142a4c35ed2SSteven Rostedt (Red Hat) 	 * callers are done before leaving this function.
31430598e4f0SSteven Rostedt (VMware) 	 */
3144b3a88803SPeter Zijlstra 	if (ops->flags & FTRACE_OPS_FL_DYNAMIC) {
31450598e4f0SSteven Rostedt (VMware) 		/*
3146a4c35ed2SSteven Rostedt (Red Hat) 		 * We need to do a hard force of sched synchronization.
3147a4c35ed2SSteven Rostedt (Red Hat) 		 * This is because we use preempt_disable() to do RCU, but
3148a4c35ed2SSteven Rostedt (Red Hat) 		 * the function tracers can be called where RCU is not watching
3149a4c35ed2SSteven Rostedt (Red Hat) 		 * (like before user_exit()). We can not rely on the RCU
3150a4c35ed2SSteven Rostedt (Red Hat) 		 * infrastructure to do the synchronization, thus we must do it
3151a4c35ed2SSteven Rostedt (Red Hat) 		 * ourselves.
3152a4c35ed2SSteven Rostedt (Red Hat) 		 */
3153e5a971d7SPaul E. McKenney 		synchronize_rcu_tasks_rude();
3154a4c35ed2SSteven Rostedt (Red Hat) 
31550598e4f0SSteven Rostedt (VMware) 		/*
3156fdda88d3SQiujun Huang 		 * When the kernel is preemptive, tasks can be preempted
31570598e4f0SSteven Rostedt (VMware) 		 * while on a ftrace trampoline. Just scheduling a task on
31580598e4f0SSteven Rostedt (VMware) 		 * a CPU is not good enough to flush them. Calling
3159f2cc020dSIngo Molnar 		 * synchronize_rcu_tasks() will wait for those tasks to
31600598e4f0SSteven Rostedt (VMware) 		 * execute and either schedule voluntarily or enter user space.
31610598e4f0SSteven Rostedt (VMware) 		 */
31620598e4f0SSteven Rostedt (VMware) 		synchronize_rcu_tasks();
31630598e4f0SSteven Rostedt (VMware) 
3164fc0ea795SAdrian Hunter 		ftrace_trampoline_free(ops);
3165a4c35ed2SSteven Rostedt (Red Hat) 	}
3166a4c35ed2SSteven Rostedt (Red Hat) 
31678a56d776SSteven Rostedt (Red Hat) 	return 0;
31683d083395SSteven Rostedt }
31693d083395SSteven Rostedt 
31705fccc755SSteven Rostedt (Google) /* Simply make a copy of @src and return it */
31715fccc755SSteven Rostedt (Google) static struct ftrace_hash *copy_hash(struct ftrace_hash *src)
31725fccc755SSteven Rostedt (Google) {
31735fccc755SSteven Rostedt (Google) 	if (ftrace_hash_empty(src))
31745fccc755SSteven Rostedt (Google) 		return EMPTY_HASH;
31755fccc755SSteven Rostedt (Google) 
31765fccc755SSteven Rostedt (Google) 	return alloc_and_copy_ftrace_hash(src->size_bits, src);
31775fccc755SSteven Rostedt (Google) }
31785fccc755SSteven Rostedt (Google) 
31795fccc755SSteven Rostedt (Google) /*
31805fccc755SSteven Rostedt (Google)  * Append @new_hash entries to @hash:
31815fccc755SSteven Rostedt (Google)  *
31825fccc755SSteven Rostedt (Google)  *  If @hash is the EMPTY_HASH then it traces all functions and nothing
31835fccc755SSteven Rostedt (Google)  *  needs to be done.
31845fccc755SSteven Rostedt (Google)  *
31855fccc755SSteven Rostedt (Google)  *  If @new_hash is the EMPTY_HASH, then make *hash the EMPTY_HASH so
31865fccc755SSteven Rostedt (Google)  *  that it traces everything.
31875fccc755SSteven Rostedt (Google)  *
31885fccc755SSteven Rostedt (Google)  *  Otherwise, go through all of @new_hash and add anything that @hash
31895fccc755SSteven Rostedt (Google)  *  doesn't already have, to @hash.
31905fccc755SSteven Rostedt (Google)  *
31915fccc755SSteven Rostedt (Google)  *  The filter_hash updates uses just the append_hash() function
31925fccc755SSteven Rostedt (Google)  *  and the notrace_hash does not.
31935fccc755SSteven Rostedt (Google)  */
31945fccc755SSteven Rostedt (Google) static int append_hash(struct ftrace_hash **hash, struct ftrace_hash *new_hash)
31955fccc755SSteven Rostedt (Google) {
31965fccc755SSteven Rostedt (Google) 	struct ftrace_func_entry *entry;
31975fccc755SSteven Rostedt (Google) 	int size;
31985fccc755SSteven Rostedt (Google) 	int i;
31995fccc755SSteven Rostedt (Google) 
32005fccc755SSteven Rostedt (Google) 	/* An empty hash does everything */
32015fccc755SSteven Rostedt (Google) 	if (ftrace_hash_empty(*hash))
32025fccc755SSteven Rostedt (Google) 		return 0;
32035fccc755SSteven Rostedt (Google) 
32045fccc755SSteven Rostedt (Google) 	/* If new_hash has everything make hash have everything */
32055fccc755SSteven Rostedt (Google) 	if (ftrace_hash_empty(new_hash)) {
32065fccc755SSteven Rostedt (Google) 		free_ftrace_hash(*hash);
32075fccc755SSteven Rostedt (Google) 		*hash = EMPTY_HASH;
32085fccc755SSteven Rostedt (Google) 		return 0;
32095fccc755SSteven Rostedt (Google) 	}
32105fccc755SSteven Rostedt (Google) 
32115fccc755SSteven Rostedt (Google) 	size = 1 << new_hash->size_bits;
32125fccc755SSteven Rostedt (Google) 	for (i = 0; i < size; i++) {
32135fccc755SSteven Rostedt (Google) 		hlist_for_each_entry(entry, &new_hash->buckets[i], hlist) {
32145fccc755SSteven Rostedt (Google) 			/* Only add if not already in hash */
32155fccc755SSteven Rostedt (Google) 			if (!__ftrace_lookup_ip(*hash, entry->ip) &&
32165fccc755SSteven Rostedt (Google) 			    add_hash_entry(*hash, entry->ip) == NULL)
32175fccc755SSteven Rostedt (Google) 				return -ENOMEM;
32185fccc755SSteven Rostedt (Google) 		}
32195fccc755SSteven Rostedt (Google) 	}
32205fccc755SSteven Rostedt (Google) 	return 0;
32215fccc755SSteven Rostedt (Google) }
32225fccc755SSteven Rostedt (Google) 
32235fccc755SSteven Rostedt (Google) /*
32245fccc755SSteven Rostedt (Google)  * Add to @hash only those that are in both @new_hash1 and @new_hash2
32255fccc755SSteven Rostedt (Google)  *
32265fccc755SSteven Rostedt (Google)  * The notrace_hash updates uses just the intersect_hash() function
32275fccc755SSteven Rostedt (Google)  * and the filter_hash does not.
32285fccc755SSteven Rostedt (Google)  */
32295fccc755SSteven Rostedt (Google) static int intersect_hash(struct ftrace_hash **hash, struct ftrace_hash *new_hash1,
32305fccc755SSteven Rostedt (Google) 			  struct ftrace_hash *new_hash2)
32315fccc755SSteven Rostedt (Google) {
32325fccc755SSteven Rostedt (Google) 	struct ftrace_func_entry *entry;
32335fccc755SSteven Rostedt (Google) 	int size;
32345fccc755SSteven Rostedt (Google) 	int i;
32355fccc755SSteven Rostedt (Google) 
32365fccc755SSteven Rostedt (Google) 	/*
32375fccc755SSteven Rostedt (Google) 	 * If new_hash1 or new_hash2 is the EMPTY_HASH then make the hash
32385fccc755SSteven Rostedt (Google) 	 * empty as well as empty for notrace means none are notraced.
32395fccc755SSteven Rostedt (Google) 	 */
32405fccc755SSteven Rostedt (Google) 	if (ftrace_hash_empty(new_hash1) || ftrace_hash_empty(new_hash2)) {
32415fccc755SSteven Rostedt (Google) 		free_ftrace_hash(*hash);
32425fccc755SSteven Rostedt (Google) 		*hash = EMPTY_HASH;
32435fccc755SSteven Rostedt (Google) 		return 0;
32445fccc755SSteven Rostedt (Google) 	}
32455fccc755SSteven Rostedt (Google) 
32465fccc755SSteven Rostedt (Google) 	size = 1 << new_hash1->size_bits;
32475fccc755SSteven Rostedt (Google) 	for (i = 0; i < size; i++) {
32485fccc755SSteven Rostedt (Google) 		hlist_for_each_entry(entry, &new_hash1->buckets[i], hlist) {
32495fccc755SSteven Rostedt (Google) 			/* Only add if in both @new_hash1 and @new_hash2 */
32505fccc755SSteven Rostedt (Google) 			if (__ftrace_lookup_ip(new_hash2, entry->ip) &&
32515fccc755SSteven Rostedt (Google) 			    add_hash_entry(*hash, entry->ip) == NULL)
32525fccc755SSteven Rostedt (Google) 				return -ENOMEM;
32535fccc755SSteven Rostedt (Google) 		}
32545fccc755SSteven Rostedt (Google) 	}
32555fccc755SSteven Rostedt (Google) 	/* If nothing intersects, make it the empty set */
32565fccc755SSteven Rostedt (Google) 	if (ftrace_hash_empty(*hash)) {
32575fccc755SSteven Rostedt (Google) 		free_ftrace_hash(*hash);
32585fccc755SSteven Rostedt (Google) 		*hash = EMPTY_HASH;
32595fccc755SSteven Rostedt (Google) 	}
32605fccc755SSteven Rostedt (Google) 	return 0;
32615fccc755SSteven Rostedt (Google) }
32625fccc755SSteven Rostedt (Google) 
32635fccc755SSteven Rostedt (Google) /* Return a new hash that has a union of all @ops->filter_hash entries */
32645fccc755SSteven Rostedt (Google) static struct ftrace_hash *append_hashes(struct ftrace_ops *ops)
32655fccc755SSteven Rostedt (Google) {
32665fccc755SSteven Rostedt (Google) 	struct ftrace_hash *new_hash;
32675fccc755SSteven Rostedt (Google) 	struct ftrace_ops *subops;
32685fccc755SSteven Rostedt (Google) 	int ret;
32695fccc755SSteven Rostedt (Google) 
32705fccc755SSteven Rostedt (Google) 	new_hash = alloc_ftrace_hash(ops->func_hash->filter_hash->size_bits);
32715fccc755SSteven Rostedt (Google) 	if (!new_hash)
32725fccc755SSteven Rostedt (Google) 		return NULL;
32735fccc755SSteven Rostedt (Google) 
32745fccc755SSteven Rostedt (Google) 	list_for_each_entry(subops, &ops->subop_list, list) {
32755fccc755SSteven Rostedt (Google) 		ret = append_hash(&new_hash, subops->func_hash->filter_hash);
32765fccc755SSteven Rostedt (Google) 		if (ret < 0) {
32775fccc755SSteven Rostedt (Google) 			free_ftrace_hash(new_hash);
32785fccc755SSteven Rostedt (Google) 			return NULL;
32795fccc755SSteven Rostedt (Google) 		}
32805fccc755SSteven Rostedt (Google) 		/* Nothing more to do if new_hash is empty */
32815fccc755SSteven Rostedt (Google) 		if (ftrace_hash_empty(new_hash))
32825fccc755SSteven Rostedt (Google) 			break;
32835fccc755SSteven Rostedt (Google) 	}
32845fccc755SSteven Rostedt (Google) 	return new_hash;
32855fccc755SSteven Rostedt (Google) }
32865fccc755SSteven Rostedt (Google) 
32875fccc755SSteven Rostedt (Google) /* Make @ops trace evenything except what all its subops do not trace */
32885fccc755SSteven Rostedt (Google) static struct ftrace_hash *intersect_hashes(struct ftrace_ops *ops)
32895fccc755SSteven Rostedt (Google) {
32905fccc755SSteven Rostedt (Google) 	struct ftrace_hash *new_hash = NULL;
32915fccc755SSteven Rostedt (Google) 	struct ftrace_ops *subops;
32925fccc755SSteven Rostedt (Google) 	int size_bits;
32935fccc755SSteven Rostedt (Google) 	int ret;
32945fccc755SSteven Rostedt (Google) 
32955fccc755SSteven Rostedt (Google) 	list_for_each_entry(subops, &ops->subop_list, list) {
32965fccc755SSteven Rostedt (Google) 		struct ftrace_hash *next_hash;
32975fccc755SSteven Rostedt (Google) 
32985fccc755SSteven Rostedt (Google) 		if (!new_hash) {
32995fccc755SSteven Rostedt (Google) 			size_bits = subops->func_hash->notrace_hash->size_bits;
33005fccc755SSteven Rostedt (Google) 			new_hash = alloc_and_copy_ftrace_hash(size_bits, ops->func_hash->notrace_hash);
33015fccc755SSteven Rostedt (Google) 			if (!new_hash)
33025fccc755SSteven Rostedt (Google) 				return NULL;
33035fccc755SSteven Rostedt (Google) 			continue;
33045fccc755SSteven Rostedt (Google) 		}
33055fccc755SSteven Rostedt (Google) 		size_bits = new_hash->size_bits;
33065fccc755SSteven Rostedt (Google) 		next_hash = new_hash;
33075fccc755SSteven Rostedt (Google) 		new_hash = alloc_ftrace_hash(size_bits);
33085fccc755SSteven Rostedt (Google) 		ret = intersect_hash(&new_hash, next_hash, subops->func_hash->notrace_hash);
33095fccc755SSteven Rostedt (Google) 		free_ftrace_hash(next_hash);
33105fccc755SSteven Rostedt (Google) 		if (ret < 0) {
33115fccc755SSteven Rostedt (Google) 			free_ftrace_hash(new_hash);
33125fccc755SSteven Rostedt (Google) 			return NULL;
33135fccc755SSteven Rostedt (Google) 		}
33145fccc755SSteven Rostedt (Google) 		/* Nothing more to do if new_hash is empty */
33155fccc755SSteven Rostedt (Google) 		if (ftrace_hash_empty(new_hash))
33165fccc755SSteven Rostedt (Google) 			break;
33175fccc755SSteven Rostedt (Google) 	}
33185fccc755SSteven Rostedt (Google) 	return new_hash;
33195fccc755SSteven Rostedt (Google) }
33205fccc755SSteven Rostedt (Google) 
33215fccc755SSteven Rostedt (Google) static bool ops_equal(struct ftrace_hash *A, struct ftrace_hash *B)
33225fccc755SSteven Rostedt (Google) {
33235fccc755SSteven Rostedt (Google) 	struct ftrace_func_entry *entry;
33245fccc755SSteven Rostedt (Google) 	int size;
33255fccc755SSteven Rostedt (Google) 	int i;
33265fccc755SSteven Rostedt (Google) 
33275fccc755SSteven Rostedt (Google) 	if (ftrace_hash_empty(A))
33285fccc755SSteven Rostedt (Google) 		return ftrace_hash_empty(B);
33295fccc755SSteven Rostedt (Google) 
33305fccc755SSteven Rostedt (Google) 	if (ftrace_hash_empty(B))
33315fccc755SSteven Rostedt (Google) 		return ftrace_hash_empty(A);
33325fccc755SSteven Rostedt (Google) 
33335fccc755SSteven Rostedt (Google) 	if (A->count != B->count)
33345fccc755SSteven Rostedt (Google) 		return false;
33355fccc755SSteven Rostedt (Google) 
33365fccc755SSteven Rostedt (Google) 	size = 1 << A->size_bits;
33375fccc755SSteven Rostedt (Google) 	for (i = 0; i < size; i++) {
33385fccc755SSteven Rostedt (Google) 		hlist_for_each_entry(entry, &A->buckets[i], hlist) {
33395fccc755SSteven Rostedt (Google) 			if (!__ftrace_lookup_ip(B, entry->ip))
33405fccc755SSteven Rostedt (Google) 				return false;
33415fccc755SSteven Rostedt (Google) 		}
33425fccc755SSteven Rostedt (Google) 	}
33435fccc755SSteven Rostedt (Google) 
33445fccc755SSteven Rostedt (Google) 	return true;
33455fccc755SSteven Rostedt (Google) }
33465fccc755SSteven Rostedt (Google) 
3347d9bbfbd1SSteven Rostedt (Google) static void ftrace_ops_update_code(struct ftrace_ops *ops,
3348d9bbfbd1SSteven Rostedt (Google) 				   struct ftrace_ops_hash *old_hash);
3349d9bbfbd1SSteven Rostedt (Google) 
3350d9bbfbd1SSteven Rostedt (Google) static int __ftrace_hash_move_and_update_ops(struct ftrace_ops *ops,
33515fccc755SSteven Rostedt (Google) 					     struct ftrace_hash **orig_hash,
33525fccc755SSteven Rostedt (Google) 					     struct ftrace_hash *hash,
3353d9bbfbd1SSteven Rostedt (Google) 					     int enable)
3354d9bbfbd1SSteven Rostedt (Google) {
3355d9bbfbd1SSteven Rostedt (Google) 	struct ftrace_ops_hash old_hash_ops;
3356d9bbfbd1SSteven Rostedt (Google) 	struct ftrace_hash *old_hash;
3357d9bbfbd1SSteven Rostedt (Google) 	int ret;
3358d9bbfbd1SSteven Rostedt (Google) 
3359d9bbfbd1SSteven Rostedt (Google) 	old_hash = *orig_hash;
3360d9bbfbd1SSteven Rostedt (Google) 	old_hash_ops.filter_hash = ops->func_hash->filter_hash;
3361d9bbfbd1SSteven Rostedt (Google) 	old_hash_ops.notrace_hash = ops->func_hash->notrace_hash;
3362d9bbfbd1SSteven Rostedt (Google) 	ret = ftrace_hash_move(ops, enable, orig_hash, hash);
3363d9bbfbd1SSteven Rostedt (Google) 	if (!ret) {
3364d9bbfbd1SSteven Rostedt (Google) 		ftrace_ops_update_code(ops, &old_hash_ops);
3365d9bbfbd1SSteven Rostedt (Google) 		free_ftrace_hash_rcu(old_hash);
3366d9bbfbd1SSteven Rostedt (Google) 	}
3367d9bbfbd1SSteven Rostedt (Google) 	return ret;
3368d9bbfbd1SSteven Rostedt (Google) }
33695fccc755SSteven Rostedt (Google) 
33705fccc755SSteven Rostedt (Google) static int ftrace_update_ops(struct ftrace_ops *ops, struct ftrace_hash *filter_hash,
33715fccc755SSteven Rostedt (Google) 			     struct ftrace_hash *notrace_hash)
33725fccc755SSteven Rostedt (Google) {
33735fccc755SSteven Rostedt (Google) 	int ret;
33745fccc755SSteven Rostedt (Google) 
33755fccc755SSteven Rostedt (Google) 	if (!ops_equal(filter_hash, ops->func_hash->filter_hash)) {
3376d9bbfbd1SSteven Rostedt (Google) 		ret = __ftrace_hash_move_and_update_ops(ops, &ops->func_hash->filter_hash,
33775fccc755SSteven Rostedt (Google) 							filter_hash, 1);
33785fccc755SSteven Rostedt (Google) 		if (ret < 0)
33795fccc755SSteven Rostedt (Google) 			return ret;
33805fccc755SSteven Rostedt (Google) 	}
33815fccc755SSteven Rostedt (Google) 
33825fccc755SSteven Rostedt (Google) 	if (!ops_equal(notrace_hash, ops->func_hash->notrace_hash)) {
3383d9bbfbd1SSteven Rostedt (Google) 		ret = __ftrace_hash_move_and_update_ops(ops, &ops->func_hash->notrace_hash,
33845fccc755SSteven Rostedt (Google) 							notrace_hash, 0);
33855fccc755SSteven Rostedt (Google) 		if (ret < 0)
33865fccc755SSteven Rostedt (Google) 			return ret;
33875fccc755SSteven Rostedt (Google) 	}
33885fccc755SSteven Rostedt (Google) 
33895fccc755SSteven Rostedt (Google) 	return 0;
33905fccc755SSteven Rostedt (Google) }
33915fccc755SSteven Rostedt (Google) 
33925fccc755SSteven Rostedt (Google) /**
33935fccc755SSteven Rostedt (Google)  * ftrace_startup_subops - enable tracing for subops of an ops
33945fccc755SSteven Rostedt (Google)  * @ops: Manager ops (used to pick all the functions of its subops)
33955fccc755SSteven Rostedt (Google)  * @subops: A new ops to add to @ops
33965fccc755SSteven Rostedt (Google)  * @command: Extra commands to use to enable tracing
33975fccc755SSteven Rostedt (Google)  *
33985fccc755SSteven Rostedt (Google)  * The @ops is a manager @ops that has the filter that includes all the functions
33995fccc755SSteven Rostedt (Google)  * that its list of subops are tracing. Adding a new @subops will add the
34005fccc755SSteven Rostedt (Google)  * functions of @subops to @ops.
34015fccc755SSteven Rostedt (Google)  */
34025fccc755SSteven Rostedt (Google) int ftrace_startup_subops(struct ftrace_ops *ops, struct ftrace_ops *subops, int command)
34035fccc755SSteven Rostedt (Google) {
34045fccc755SSteven Rostedt (Google) 	struct ftrace_hash *filter_hash;
34055fccc755SSteven Rostedt (Google) 	struct ftrace_hash *notrace_hash;
34065fccc755SSteven Rostedt (Google) 	struct ftrace_hash *save_filter_hash;
34075fccc755SSteven Rostedt (Google) 	struct ftrace_hash *save_notrace_hash;
34085fccc755SSteven Rostedt (Google) 	int size_bits;
34095fccc755SSteven Rostedt (Google) 	int ret;
34105fccc755SSteven Rostedt (Google) 
34115fccc755SSteven Rostedt (Google) 	if (unlikely(ftrace_disabled))
34125fccc755SSteven Rostedt (Google) 		return -ENODEV;
34135fccc755SSteven Rostedt (Google) 
34145fccc755SSteven Rostedt (Google) 	ftrace_ops_init(ops);
34155fccc755SSteven Rostedt (Google) 	ftrace_ops_init(subops);
34165fccc755SSteven Rostedt (Google) 
34175fccc755SSteven Rostedt (Google) 	if (WARN_ON_ONCE(subops->flags & FTRACE_OPS_FL_ENABLED))
34185fccc755SSteven Rostedt (Google) 		return -EBUSY;
34195fccc755SSteven Rostedt (Google) 
34205fccc755SSteven Rostedt (Google) 	/* Make everything canonical (Just in case!) */
34215fccc755SSteven Rostedt (Google) 	if (!ops->func_hash->filter_hash)
34225fccc755SSteven Rostedt (Google) 		ops->func_hash->filter_hash = EMPTY_HASH;
34235fccc755SSteven Rostedt (Google) 	if (!ops->func_hash->notrace_hash)
34245fccc755SSteven Rostedt (Google) 		ops->func_hash->notrace_hash = EMPTY_HASH;
34255fccc755SSteven Rostedt (Google) 	if (!subops->func_hash->filter_hash)
34265fccc755SSteven Rostedt (Google) 		subops->func_hash->filter_hash = EMPTY_HASH;
34275fccc755SSteven Rostedt (Google) 	if (!subops->func_hash->notrace_hash)
34285fccc755SSteven Rostedt (Google) 		subops->func_hash->notrace_hash = EMPTY_HASH;
34295fccc755SSteven Rostedt (Google) 
34305fccc755SSteven Rostedt (Google) 	/* For the first subops to ops just enable it normally */
34315fccc755SSteven Rostedt (Google) 	if (list_empty(&ops->subop_list)) {
34325fccc755SSteven Rostedt (Google) 		/* Just use the subops hashes */
34335fccc755SSteven Rostedt (Google) 		filter_hash = copy_hash(subops->func_hash->filter_hash);
34345fccc755SSteven Rostedt (Google) 		notrace_hash = copy_hash(subops->func_hash->notrace_hash);
34355fccc755SSteven Rostedt (Google) 		if (!filter_hash || !notrace_hash) {
34365fccc755SSteven Rostedt (Google) 			free_ftrace_hash(filter_hash);
34375fccc755SSteven Rostedt (Google) 			free_ftrace_hash(notrace_hash);
34385fccc755SSteven Rostedt (Google) 			return -ENOMEM;
34395fccc755SSteven Rostedt (Google) 		}
34405fccc755SSteven Rostedt (Google) 
34415fccc755SSteven Rostedt (Google) 		save_filter_hash = ops->func_hash->filter_hash;
34425fccc755SSteven Rostedt (Google) 		save_notrace_hash = ops->func_hash->notrace_hash;
34435fccc755SSteven Rostedt (Google) 
34445fccc755SSteven Rostedt (Google) 		ops->func_hash->filter_hash = filter_hash;
34455fccc755SSteven Rostedt (Google) 		ops->func_hash->notrace_hash = notrace_hash;
34465fccc755SSteven Rostedt (Google) 		list_add(&subops->list, &ops->subop_list);
34475fccc755SSteven Rostedt (Google) 		ret = ftrace_startup(ops, command);
34485fccc755SSteven Rostedt (Google) 		if (ret < 0) {
34495fccc755SSteven Rostedt (Google) 			list_del(&subops->list);
34505fccc755SSteven Rostedt (Google) 			ops->func_hash->filter_hash = save_filter_hash;
34515fccc755SSteven Rostedt (Google) 			ops->func_hash->notrace_hash = save_notrace_hash;
34525fccc755SSteven Rostedt (Google) 			free_ftrace_hash(filter_hash);
34535fccc755SSteven Rostedt (Google) 			free_ftrace_hash(notrace_hash);
34545fccc755SSteven Rostedt (Google) 		} else {
34555fccc755SSteven Rostedt (Google) 			free_ftrace_hash(save_filter_hash);
34565fccc755SSteven Rostedt (Google) 			free_ftrace_hash(save_notrace_hash);
3457d9bbfbd1SSteven Rostedt (Google) 			subops->flags |= FTRACE_OPS_FL_ENABLED | FTRACE_OPS_FL_SUBOP;
3458d9bbfbd1SSteven Rostedt (Google) 			subops->managed = ops;
34595fccc755SSteven Rostedt (Google) 		}
34605fccc755SSteven Rostedt (Google) 		return ret;
34615fccc755SSteven Rostedt (Google) 	}
34625fccc755SSteven Rostedt (Google) 
34635fccc755SSteven Rostedt (Google) 	/*
34645fccc755SSteven Rostedt (Google) 	 * Here there's already something attached. Here are the rules:
34655fccc755SSteven Rostedt (Google) 	 *   o If either filter_hash is empty then the final stays empty
34665fccc755SSteven Rostedt (Google) 	 *      o Otherwise, the final is a superset of both hashes
34675fccc755SSteven Rostedt (Google) 	 *   o If either notrace_hash is empty then the final stays empty
34685fccc755SSteven Rostedt (Google) 	 *      o Otherwise, the final is an intersection between the hashes
34695fccc755SSteven Rostedt (Google) 	 */
34705fccc755SSteven Rostedt (Google) 	if (ftrace_hash_empty(ops->func_hash->filter_hash) ||
34715fccc755SSteven Rostedt (Google) 	    ftrace_hash_empty(subops->func_hash->filter_hash)) {
34725fccc755SSteven Rostedt (Google) 		filter_hash = EMPTY_HASH;
34735fccc755SSteven Rostedt (Google) 	} else {
34745fccc755SSteven Rostedt (Google) 		size_bits = max(ops->func_hash->filter_hash->size_bits,
34755fccc755SSteven Rostedt (Google) 				subops->func_hash->filter_hash->size_bits);
34765fccc755SSteven Rostedt (Google) 		filter_hash = alloc_and_copy_ftrace_hash(size_bits, ops->func_hash->filter_hash);
34775fccc755SSteven Rostedt (Google) 		if (!filter_hash)
34785fccc755SSteven Rostedt (Google) 			return -ENOMEM;
34795fccc755SSteven Rostedt (Google) 		ret = append_hash(&filter_hash, subops->func_hash->filter_hash);
34805fccc755SSteven Rostedt (Google) 		if (ret < 0) {
34815fccc755SSteven Rostedt (Google) 			free_ftrace_hash(filter_hash);
34825fccc755SSteven Rostedt (Google) 			return ret;
34835fccc755SSteven Rostedt (Google) 		}
34845fccc755SSteven Rostedt (Google) 	}
34855fccc755SSteven Rostedt (Google) 
34865fccc755SSteven Rostedt (Google) 	if (ftrace_hash_empty(ops->func_hash->notrace_hash) ||
34875fccc755SSteven Rostedt (Google) 	    ftrace_hash_empty(subops->func_hash->notrace_hash)) {
34885fccc755SSteven Rostedt (Google) 		notrace_hash = EMPTY_HASH;
34895fccc755SSteven Rostedt (Google) 	} else {
34905fccc755SSteven Rostedt (Google) 		size_bits = max(ops->func_hash->filter_hash->size_bits,
34915fccc755SSteven Rostedt (Google) 				subops->func_hash->filter_hash->size_bits);
34925fccc755SSteven Rostedt (Google) 		notrace_hash = alloc_ftrace_hash(size_bits);
34935fccc755SSteven Rostedt (Google) 		if (!notrace_hash) {
34945fccc755SSteven Rostedt (Google) 			free_ftrace_hash(filter_hash);
34955fccc755SSteven Rostedt (Google) 			return -ENOMEM;
34965fccc755SSteven Rostedt (Google) 		}
34975fccc755SSteven Rostedt (Google) 
34985fccc755SSteven Rostedt (Google) 		ret = intersect_hash(&notrace_hash, ops->func_hash->filter_hash,
34995fccc755SSteven Rostedt (Google) 				     subops->func_hash->filter_hash);
35005fccc755SSteven Rostedt (Google) 		if (ret < 0) {
35015fccc755SSteven Rostedt (Google) 			free_ftrace_hash(filter_hash);
35025fccc755SSteven Rostedt (Google) 			free_ftrace_hash(notrace_hash);
35035fccc755SSteven Rostedt (Google) 			return ret;
35045fccc755SSteven Rostedt (Google) 		}
35055fccc755SSteven Rostedt (Google) 	}
35065fccc755SSteven Rostedt (Google) 
35075fccc755SSteven Rostedt (Google) 	list_add(&subops->list, &ops->subop_list);
35085fccc755SSteven Rostedt (Google) 
35095fccc755SSteven Rostedt (Google) 	ret = ftrace_update_ops(ops, filter_hash, notrace_hash);
35105fccc755SSteven Rostedt (Google) 	free_ftrace_hash(filter_hash);
35115fccc755SSteven Rostedt (Google) 	free_ftrace_hash(notrace_hash);
3512d9bbfbd1SSteven Rostedt (Google) 	if (ret < 0) {
35135fccc755SSteven Rostedt (Google) 		list_del(&subops->list);
3514d9bbfbd1SSteven Rostedt (Google) 	} else {
3515d9bbfbd1SSteven Rostedt (Google) 		subops->flags |= FTRACE_OPS_FL_ENABLED | FTRACE_OPS_FL_SUBOP;
3516d9bbfbd1SSteven Rostedt (Google) 		subops->managed = ops;
3517d9bbfbd1SSteven Rostedt (Google) 	}
35185fccc755SSteven Rostedt (Google) 	return ret;
35195fccc755SSteven Rostedt (Google) }
35205fccc755SSteven Rostedt (Google) 
35215fccc755SSteven Rostedt (Google) /**
35225fccc755SSteven Rostedt (Google)  * ftrace_shutdown_subops - Remove a subops from a manager ops
35235fccc755SSteven Rostedt (Google)  * @ops: A manager ops to remove @subops from
35245fccc755SSteven Rostedt (Google)  * @subops: The subops to remove from @ops
35255fccc755SSteven Rostedt (Google)  * @command: Any extra command flags to add to modifying the text
35265fccc755SSteven Rostedt (Google)  *
35275fccc755SSteven Rostedt (Google)  * Removes the functions being traced by the @subops from @ops. Note, it
35285fccc755SSteven Rostedt (Google)  * will not affect functions that are being traced by other subops that
35295fccc755SSteven Rostedt (Google)  * still exist in @ops.
35305fccc755SSteven Rostedt (Google)  *
35315fccc755SSteven Rostedt (Google)  * If the last subops is removed from @ops, then @ops is shutdown normally.
35325fccc755SSteven Rostedt (Google)  */
35335fccc755SSteven Rostedt (Google) int ftrace_shutdown_subops(struct ftrace_ops *ops, struct ftrace_ops *subops, int command)
35345fccc755SSteven Rostedt (Google) {
35355fccc755SSteven Rostedt (Google) 	struct ftrace_hash *filter_hash;
35365fccc755SSteven Rostedt (Google) 	struct ftrace_hash *notrace_hash;
35375fccc755SSteven Rostedt (Google) 	int ret;
35385fccc755SSteven Rostedt (Google) 
35395fccc755SSteven Rostedt (Google) 	if (unlikely(ftrace_disabled))
35405fccc755SSteven Rostedt (Google) 		return -ENODEV;
35415fccc755SSteven Rostedt (Google) 
35425fccc755SSteven Rostedt (Google) 	if (WARN_ON_ONCE(!(subops->flags & FTRACE_OPS_FL_ENABLED)))
35435fccc755SSteven Rostedt (Google) 		return -EINVAL;
35445fccc755SSteven Rostedt (Google) 
35455fccc755SSteven Rostedt (Google) 	list_del(&subops->list);
35465fccc755SSteven Rostedt (Google) 
35475fccc755SSteven Rostedt (Google) 	if (list_empty(&ops->subop_list)) {
35485fccc755SSteven Rostedt (Google) 		/* Last one, just disable the current ops */
35495fccc755SSteven Rostedt (Google) 
35505fccc755SSteven Rostedt (Google) 		ret = ftrace_shutdown(ops, command);
35515fccc755SSteven Rostedt (Google) 		if (ret < 0) {
35525fccc755SSteven Rostedt (Google) 			list_add(&subops->list, &ops->subop_list);
35535fccc755SSteven Rostedt (Google) 			return ret;
35545fccc755SSteven Rostedt (Google) 		}
35555fccc755SSteven Rostedt (Google) 
35565fccc755SSteven Rostedt (Google) 		subops->flags &= ~FTRACE_OPS_FL_ENABLED;
35575fccc755SSteven Rostedt (Google) 
35585fccc755SSteven Rostedt (Google) 		free_ftrace_hash(ops->func_hash->filter_hash);
35595fccc755SSteven Rostedt (Google) 		free_ftrace_hash(ops->func_hash->notrace_hash);
35605fccc755SSteven Rostedt (Google) 		ops->func_hash->filter_hash = EMPTY_HASH;
35615fccc755SSteven Rostedt (Google) 		ops->func_hash->notrace_hash = EMPTY_HASH;
3562d9bbfbd1SSteven Rostedt (Google) 		subops->flags &= ~(FTRACE_OPS_FL_ENABLED | FTRACE_OPS_FL_SUBOP);
3563d9bbfbd1SSteven Rostedt (Google) 		subops->managed = NULL;
35645fccc755SSteven Rostedt (Google) 
35655fccc755SSteven Rostedt (Google) 		return 0;
35665fccc755SSteven Rostedt (Google) 	}
35675fccc755SSteven Rostedt (Google) 
35685fccc755SSteven Rostedt (Google) 	/* Rebuild the hashes without subops */
35695fccc755SSteven Rostedt (Google) 	filter_hash = append_hashes(ops);
35705fccc755SSteven Rostedt (Google) 	notrace_hash = intersect_hashes(ops);
35715fccc755SSteven Rostedt (Google) 	if (!filter_hash || !notrace_hash) {
35725fccc755SSteven Rostedt (Google) 		free_ftrace_hash(filter_hash);
35735fccc755SSteven Rostedt (Google) 		free_ftrace_hash(notrace_hash);
35745fccc755SSteven Rostedt (Google) 		list_add(&subops->list, &ops->subop_list);
35755fccc755SSteven Rostedt (Google) 		return -ENOMEM;
35765fccc755SSteven Rostedt (Google) 	}
35775fccc755SSteven Rostedt (Google) 
35785fccc755SSteven Rostedt (Google) 	ret = ftrace_update_ops(ops, filter_hash, notrace_hash);
3579d9bbfbd1SSteven Rostedt (Google) 	if (ret < 0) {
35805fccc755SSteven Rostedt (Google) 		list_add(&subops->list, &ops->subop_list);
3581d9bbfbd1SSteven Rostedt (Google) 	} else {
3582d9bbfbd1SSteven Rostedt (Google) 		subops->flags &= ~(FTRACE_OPS_FL_ENABLED | FTRACE_OPS_FL_SUBOP);
3583d9bbfbd1SSteven Rostedt (Google) 		subops->managed = NULL;
3584d9bbfbd1SSteven Rostedt (Google) 	}
35855fccc755SSteven Rostedt (Google) 	free_ftrace_hash(filter_hash);
35865fccc755SSteven Rostedt (Google) 	free_ftrace_hash(notrace_hash);
35875fccc755SSteven Rostedt (Google) 	return ret;
35885fccc755SSteven Rostedt (Google) }
35895fccc755SSteven Rostedt (Google) 
3590d9bbfbd1SSteven Rostedt (Google) static int ftrace_hash_move_and_update_subops(struct ftrace_ops *subops,
3591d9bbfbd1SSteven Rostedt (Google) 					      struct ftrace_hash **orig_subhash,
3592d9bbfbd1SSteven Rostedt (Google) 					      struct ftrace_hash *hash,
3593d9bbfbd1SSteven Rostedt (Google) 					      int enable)
3594d9bbfbd1SSteven Rostedt (Google) {
3595d9bbfbd1SSteven Rostedt (Google) 	struct ftrace_ops *ops = subops->managed;
3596d9bbfbd1SSteven Rostedt (Google) 	struct ftrace_hash **orig_hash;
3597d9bbfbd1SSteven Rostedt (Google) 	struct ftrace_hash *save_hash;
3598d9bbfbd1SSteven Rostedt (Google) 	struct ftrace_hash *new_hash;
3599d9bbfbd1SSteven Rostedt (Google) 	int ret;
3600d9bbfbd1SSteven Rostedt (Google) 
3601d9bbfbd1SSteven Rostedt (Google) 	/* Manager ops can not be subops (yet) */
3602d9bbfbd1SSteven Rostedt (Google) 	if (WARN_ON_ONCE(!ops || ops->flags & FTRACE_OPS_FL_SUBOP))
3603d9bbfbd1SSteven Rostedt (Google) 		return -EINVAL;
3604d9bbfbd1SSteven Rostedt (Google) 
3605d9bbfbd1SSteven Rostedt (Google) 	/* Move the new hash over to the subops hash */
3606d9bbfbd1SSteven Rostedt (Google) 	save_hash = *orig_subhash;
3607d9bbfbd1SSteven Rostedt (Google) 	*orig_subhash = __ftrace_hash_move(hash);
3608d9bbfbd1SSteven Rostedt (Google) 	if (!*orig_subhash) {
3609d9bbfbd1SSteven Rostedt (Google) 		*orig_subhash = save_hash;
3610d9bbfbd1SSteven Rostedt (Google) 		return -ENOMEM;
3611d9bbfbd1SSteven Rostedt (Google) 	}
3612d9bbfbd1SSteven Rostedt (Google) 
3613d9bbfbd1SSteven Rostedt (Google) 	/* Create a new_hash to hold the ops new functions */
3614d9bbfbd1SSteven Rostedt (Google) 	if (enable) {
3615d9bbfbd1SSteven Rostedt (Google) 		orig_hash = &ops->func_hash->filter_hash;
3616d9bbfbd1SSteven Rostedt (Google) 		new_hash = append_hashes(ops);
3617d9bbfbd1SSteven Rostedt (Google) 	} else {
3618d9bbfbd1SSteven Rostedt (Google) 		orig_hash = &ops->func_hash->notrace_hash;
3619d9bbfbd1SSteven Rostedt (Google) 		new_hash = intersect_hashes(ops);
3620d9bbfbd1SSteven Rostedt (Google) 	}
3621d9bbfbd1SSteven Rostedt (Google) 
3622d9bbfbd1SSteven Rostedt (Google) 	/* Move the hash over to the new hash */
3623d9bbfbd1SSteven Rostedt (Google) 	ret = __ftrace_hash_move_and_update_ops(ops, orig_hash, new_hash, enable);
3624d9bbfbd1SSteven Rostedt (Google) 
3625d9bbfbd1SSteven Rostedt (Google) 	free_ftrace_hash(new_hash);
3626d9bbfbd1SSteven Rostedt (Google) 
3627d9bbfbd1SSteven Rostedt (Google) 	if (ret) {
3628d9bbfbd1SSteven Rostedt (Google) 		/* Put back the original hash */
3629d9bbfbd1SSteven Rostedt (Google) 		free_ftrace_hash_rcu(*orig_subhash);
3630d9bbfbd1SSteven Rostedt (Google) 		*orig_subhash = save_hash;
3631d9bbfbd1SSteven Rostedt (Google) 	} else {
3632d9bbfbd1SSteven Rostedt (Google) 		free_ftrace_hash_rcu(save_hash);
3633d9bbfbd1SSteven Rostedt (Google) 	}
3634d9bbfbd1SSteven Rostedt (Google) 	return ret;
3635d9bbfbd1SSteven Rostedt (Google) }
3636d9bbfbd1SSteven Rostedt (Google) 
3637d9bbfbd1SSteven Rostedt (Google) 
3638a5a1d1c2SThomas Gleixner static u64		ftrace_update_time;
36393d083395SSteven Rostedt unsigned long		ftrace_update_tot_cnt;
3640da537f0aSSteven Rostedt (VMware) unsigned long		ftrace_number_of_pages;
3641da537f0aSSteven Rostedt (VMware) unsigned long		ftrace_number_of_groups;
36423d083395SSteven Rostedt 
36438c4f3c3fSSteven Rostedt (Red Hat) static inline int ops_traces_mod(struct ftrace_ops *ops)
3644f7bc8b61SSteven Rostedt {
36458c4f3c3fSSteven Rostedt (Red Hat) 	/*
36468c4f3c3fSSteven Rostedt (Red Hat) 	 * Filter_hash being empty will default to trace module.
36478c4f3c3fSSteven Rostedt (Red Hat) 	 * But notrace hash requires a test of individual module functions.
36488c4f3c3fSSteven Rostedt (Red Hat) 	 */
364933b7f99cSSteven Rostedt (Red Hat) 	return ftrace_hash_empty(ops->func_hash->filter_hash) &&
365033b7f99cSSteven Rostedt (Red Hat) 		ftrace_hash_empty(ops->func_hash->notrace_hash);
36518c4f3c3fSSteven Rostedt (Red Hat) }
3652f7bc8b61SSteven Rostedt 
36531dc43cf0SJiri Slaby static int ftrace_update_code(struct module *mod, struct ftrace_page *new_pgs)
36543d083395SSteven Rostedt {
365567ccddf8SIlya Leoshkevich 	bool init_nop = ftrace_need_init_nop();
365685ae32aeSSteven Rostedt 	struct ftrace_page *pg;
3657e94142a6SLai Jiangshan 	struct dyn_ftrace *p;
3658a5a1d1c2SThomas Gleixner 	u64 start, stop;
36591dc43cf0SJiri Slaby 	unsigned long update_cnt = 0;
3660b7ffffbbSSteven Rostedt (Red Hat) 	unsigned long rec_flags = 0;
366185ae32aeSSteven Rostedt 	int i;
3662f7bc8b61SSteven Rostedt 
3663750ed1a4SIngo Molnar 	start = ftrace_now(raw_smp_processor_id());
36643d083395SSteven Rostedt 
3665b7ffffbbSSteven Rostedt (Red Hat) 	/*
3666b7ffffbbSSteven Rostedt (Red Hat) 	 * When a module is loaded, this function is called to convert
3667b7ffffbbSSteven Rostedt (Red Hat) 	 * the calls to mcount in its text to nops, and also to create
3668b7ffffbbSSteven Rostedt (Red Hat) 	 * an entry in the ftrace data. Now, if ftrace is activated
3669b7ffffbbSSteven Rostedt (Red Hat) 	 * after this call, but before the module sets its text to
3670b7ffffbbSSteven Rostedt (Red Hat) 	 * read-only, the modification of enabling ftrace can fail if
3671b7ffffbbSSteven Rostedt (Red Hat) 	 * the read-only is done while ftrace is converting the calls.
3672b7ffffbbSSteven Rostedt (Red Hat) 	 * To prevent this, the module's records are set as disabled
3673b7ffffbbSSteven Rostedt (Red Hat) 	 * and will be enabled after the call to set the module's text
3674b7ffffbbSSteven Rostedt (Red Hat) 	 * to read-only.
3675b7ffffbbSSteven Rostedt (Red Hat) 	 */
3676b7ffffbbSSteven Rostedt (Red Hat) 	if (mod)
3677b7ffffbbSSteven Rostedt (Red Hat) 		rec_flags |= FTRACE_FL_DISABLED;
3678b7ffffbbSSteven Rostedt (Red Hat) 
36791dc43cf0SJiri Slaby 	for (pg = new_pgs; pg; pg = pg->next) {
3680f22f9a89SAbhishek Sagar 
368185ae32aeSSteven Rostedt 		for (i = 0; i < pg->index; i++) {
36828c4f3c3fSSteven Rostedt (Red Hat) 
368308f5ac90SSteven Rostedt 			/* If something went wrong, bail without enabling anything */
368408f5ac90SSteven Rostedt 			if (unlikely(ftrace_disabled))
368508f5ac90SSteven Rostedt 				return -1;
36863d083395SSteven Rostedt 
368785ae32aeSSteven Rostedt 			p = &pg->records[i];
3688b7ffffbbSSteven Rostedt (Red Hat) 			p->flags = rec_flags;
3689f22f9a89SAbhishek Sagar 
36905cb084bbSJiri Olsa 			/*
369125985edcSLucas De Marchi 			 * Do the initial record conversion from mcount jump
36925cb084bbSJiri Olsa 			 * to the NOP instructions.
36935cb084bbSJiri Olsa 			 */
369467ccddf8SIlya Leoshkevich 			if (init_nop && !ftrace_nop_initialize(mod, p))
3695d2c8c3eaSSteven Rostedt 				break;
36965cb084bbSJiri Olsa 
36971dc43cf0SJiri Slaby 			update_cnt++;
36985cb084bbSJiri Olsa 		}
369985ae32aeSSteven Rostedt 	}
370085ae32aeSSteven Rostedt 
3701750ed1a4SIngo Molnar 	stop = ftrace_now(raw_smp_processor_id());
37023d083395SSteven Rostedt 	ftrace_update_time = stop - start;
37031dc43cf0SJiri Slaby 	ftrace_update_tot_cnt += update_cnt;
37043d083395SSteven Rostedt 
370516444a8aSArnaldo Carvalho de Melo 	return 0;
370616444a8aSArnaldo Carvalho de Melo }
370716444a8aSArnaldo Carvalho de Melo 
3708a7900875SSteven Rostedt static int ftrace_allocate_records(struct ftrace_page *pg, int count)
37093c1720f0SSteven Rostedt {
3710a7900875SSteven Rostedt 	int order;
37117ba031e8SSteven Rostedt (VMware) 	int pages;
37123c1720f0SSteven Rostedt 	int cnt;
37133c1720f0SSteven Rostedt 
3714a7900875SSteven Rostedt 	if (WARN_ON(!count))
3715a7900875SSteven Rostedt 		return -EINVAL;
3716a7900875SSteven Rostedt 
3717ceaaa129SSteven Rostedt (VMware) 	/* We want to fill as much as possible, with no empty pages */
3718b40c6eabSWei Yang 	pages = DIV_ROUND_UP(count, ENTRIES_PER_PAGE);
3719ceaaa129SSteven Rostedt (VMware) 	order = fls(pages) - 1;
37203c1720f0SSteven Rostedt 
3721a7900875SSteven Rostedt  again:
3722a7900875SSteven Rostedt 	pg->records = (void *)__get_free_pages(GFP_KERNEL | __GFP_ZERO, order);
3723a7900875SSteven Rostedt 
3724a7900875SSteven Rostedt 	if (!pg->records) {
3725a7900875SSteven Rostedt 		/* if we can't allocate this size, try something smaller */
3726a7900875SSteven Rostedt 		if (!order)
3727a7900875SSteven Rostedt 			return -ENOMEM;
3728bcea02b0SWang Wensheng 		order--;
3729a7900875SSteven Rostedt 		goto again;
3730a7900875SSteven Rostedt 	}
3731a7900875SSteven Rostedt 
3732da537f0aSSteven Rostedt (VMware) 	ftrace_number_of_pages += 1 << order;
3733da537f0aSSteven Rostedt (VMware) 	ftrace_number_of_groups++;
3734da537f0aSSteven Rostedt (VMware) 
3735a7900875SSteven Rostedt 	cnt = (PAGE_SIZE << order) / ENTRY_SIZE;
3736db42523bSLinus Torvalds 	pg->order = order;
3737a7900875SSteven Rostedt 
3738a7900875SSteven Rostedt 	if (cnt > count)
3739a7900875SSteven Rostedt 		cnt = count;
3740a7900875SSteven Rostedt 
3741a7900875SSteven Rostedt 	return cnt;
3742a7900875SSteven Rostedt }
3743a7900875SSteven Rostedt 
374426efd79cSZheng Yejian static void ftrace_free_pages(struct ftrace_page *pages)
374526efd79cSZheng Yejian {
374626efd79cSZheng Yejian 	struct ftrace_page *pg = pages;
374726efd79cSZheng Yejian 
374826efd79cSZheng Yejian 	while (pg) {
374926efd79cSZheng Yejian 		if (pg->records) {
375026efd79cSZheng Yejian 			free_pages((unsigned long)pg->records, pg->order);
375126efd79cSZheng Yejian 			ftrace_number_of_pages -= 1 << pg->order;
375226efd79cSZheng Yejian 		}
375326efd79cSZheng Yejian 		pages = pg->next;
375426efd79cSZheng Yejian 		kfree(pg);
375526efd79cSZheng Yejian 		pg = pages;
375626efd79cSZheng Yejian 		ftrace_number_of_groups--;
375726efd79cSZheng Yejian 	}
375826efd79cSZheng Yejian }
375926efd79cSZheng Yejian 
3760a7900875SSteven Rostedt static struct ftrace_page *
3761a7900875SSteven Rostedt ftrace_allocate_pages(unsigned long num_to_init)
3762a7900875SSteven Rostedt {
3763a7900875SSteven Rostedt 	struct ftrace_page *start_pg;
3764a7900875SSteven Rostedt 	struct ftrace_page *pg;
3765a7900875SSteven Rostedt 	int cnt;
3766a7900875SSteven Rostedt 
3767a7900875SSteven Rostedt 	if (!num_to_init)
37689efb85c5SHariprasad Kelam 		return NULL;
3769a7900875SSteven Rostedt 
3770a7900875SSteven Rostedt 	start_pg = pg = kzalloc(sizeof(*pg), GFP_KERNEL);
3771a7900875SSteven Rostedt 	if (!pg)
3772a7900875SSteven Rostedt 		return NULL;
3773a7900875SSteven Rostedt 
3774a7900875SSteven Rostedt 	/*
3775a7900875SSteven Rostedt 	 * Try to allocate as much as possible in one continues
3776a7900875SSteven Rostedt 	 * location that fills in all of the space. We want to
3777a7900875SSteven Rostedt 	 * waste as little space as possible.
3778a7900875SSteven Rostedt 	 */
3779a7900875SSteven Rostedt 	for (;;) {
3780a7900875SSteven Rostedt 		cnt = ftrace_allocate_records(pg, num_to_init);
3781a7900875SSteven Rostedt 		if (cnt < 0)
3782a7900875SSteven Rostedt 			goto free_pages;
3783a7900875SSteven Rostedt 
3784a7900875SSteven Rostedt 		num_to_init -= cnt;
3785a7900875SSteven Rostedt 		if (!num_to_init)
3786a7900875SSteven Rostedt 			break;
3787a7900875SSteven Rostedt 
3788a7900875SSteven Rostedt 		pg->next = kzalloc(sizeof(*pg), GFP_KERNEL);
3789a7900875SSteven Rostedt 		if (!pg->next)
3790a7900875SSteven Rostedt 			goto free_pages;
3791a7900875SSteven Rostedt 
3792a7900875SSteven Rostedt 		pg = pg->next;
3793a7900875SSteven Rostedt 	}
3794a7900875SSteven Rostedt 
3795a7900875SSteven Rostedt 	return start_pg;
3796a7900875SSteven Rostedt 
3797a7900875SSteven Rostedt  free_pages:
379826efd79cSZheng Yejian 	ftrace_free_pages(start_pg);
3799a7900875SSteven Rostedt 	pr_info("ftrace: FAILED to allocate memory for functions\n");
3800a7900875SSteven Rostedt 	return NULL;
3801a7900875SSteven Rostedt }
3802a7900875SSteven Rostedt 
38035072c59fSSteven Rostedt #define FTRACE_BUFF_MAX (KSYM_SYMBOL_LEN+4) /* room for wildcards */
38045072c59fSSteven Rostedt 
38055072c59fSSteven Rostedt struct ftrace_iterator {
380698c4fd04SSteven Rostedt 	loff_t				pos;
38072bccfffdSSteven Rostedt 	loff_t				func_pos;
38085985ea8bSSteven Rostedt (VMware) 	loff_t				mod_pos;
38095072c59fSSteven Rostedt 	struct ftrace_page		*pg;
38104aeb6967SSteven Rostedt 	struct dyn_ftrace		*func;
38114aeb6967SSteven Rostedt 	struct ftrace_func_probe	*probe;
3812eee8ded1SSteven Rostedt (VMware) 	struct ftrace_func_entry	*probe_entry;
38134aeb6967SSteven Rostedt 	struct trace_parser		parser;
38141cf41dd7SSteven Rostedt 	struct ftrace_hash		*hash;
381533dc9b12SSteven Rostedt 	struct ftrace_ops		*ops;
38165985ea8bSSteven Rostedt (VMware) 	struct trace_array		*tr;
38175985ea8bSSteven Rostedt (VMware) 	struct list_head		*mod_list;
3818eee8ded1SSteven Rostedt (VMware) 	int				pidx;
3819431aa3fbSSteven Rostedt 	int				idx;
38205072c59fSSteven Rostedt 	unsigned			flags;
38215072c59fSSteven Rostedt };
38225072c59fSSteven Rostedt 
3823e309b41dSIngo Molnar static void *
3824eee8ded1SSteven Rostedt (VMware) t_probe_next(struct seq_file *m, loff_t *pos)
38258fc0c701SSteven Rostedt {
38268fc0c701SSteven Rostedt 	struct ftrace_iterator *iter = m->private;
3827d2afd57aSSteven Rostedt (VMware) 	struct trace_array *tr = iter->ops->private;
382804ec7bb6SSteven Rostedt (VMware) 	struct list_head *func_probes;
3829eee8ded1SSteven Rostedt (VMware) 	struct ftrace_hash *hash;
3830eee8ded1SSteven Rostedt (VMware) 	struct list_head *next;
38314aeb6967SSteven Rostedt 	struct hlist_node *hnd = NULL;
38328fc0c701SSteven Rostedt 	struct hlist_head *hhd;
3833eee8ded1SSteven Rostedt (VMware) 	int size;
38348fc0c701SSteven Rostedt 
38358fc0c701SSteven Rostedt 	(*pos)++;
383698c4fd04SSteven Rostedt 	iter->pos = *pos;
38378fc0c701SSteven Rostedt 
383804ec7bb6SSteven Rostedt (VMware) 	if (!tr)
38398fc0c701SSteven Rostedt 		return NULL;
38408fc0c701SSteven Rostedt 
384104ec7bb6SSteven Rostedt (VMware) 	func_probes = &tr->func_probes;
384204ec7bb6SSteven Rostedt (VMware) 	if (list_empty(func_probes))
38438fc0c701SSteven Rostedt 		return NULL;
38448fc0c701SSteven Rostedt 
3845eee8ded1SSteven Rostedt (VMware) 	if (!iter->probe) {
384604ec7bb6SSteven Rostedt (VMware) 		next = func_probes->next;
38477b60f3d8SSteven Rostedt (VMware) 		iter->probe = list_entry(next, struct ftrace_func_probe, list);
3848eee8ded1SSteven Rostedt (VMware) 	}
3849eee8ded1SSteven Rostedt (VMware) 
3850eee8ded1SSteven Rostedt (VMware) 	if (iter->probe_entry)
3851eee8ded1SSteven Rostedt (VMware) 		hnd = &iter->probe_entry->hlist;
3852eee8ded1SSteven Rostedt (VMware) 
3853eee8ded1SSteven Rostedt (VMware) 	hash = iter->probe->ops.func_hash->filter_hash;
38547bd46644SNaveen N. Rao 
3855372e0d01SSteven Rostedt (VMware) 	/*
3856372e0d01SSteven Rostedt (VMware) 	 * A probe being registered may temporarily have an empty hash
3857372e0d01SSteven Rostedt (VMware) 	 * and it's at the end of the func_probes list.
3858372e0d01SSteven Rostedt (VMware) 	 */
3859372e0d01SSteven Rostedt (VMware) 	if (!hash || hash == EMPTY_HASH)
38607bd46644SNaveen N. Rao 		return NULL;
38617bd46644SNaveen N. Rao 
3862eee8ded1SSteven Rostedt (VMware) 	size = 1 << hash->size_bits;
3863eee8ded1SSteven Rostedt (VMware) 
3864eee8ded1SSteven Rostedt (VMware)  retry:
3865eee8ded1SSteven Rostedt (VMware) 	if (iter->pidx >= size) {
386604ec7bb6SSteven Rostedt (VMware) 		if (iter->probe->list.next == func_probes)
3867eee8ded1SSteven Rostedt (VMware) 			return NULL;
3868eee8ded1SSteven Rostedt (VMware) 		next = iter->probe->list.next;
38697b60f3d8SSteven Rostedt (VMware) 		iter->probe = list_entry(next, struct ftrace_func_probe, list);
3870eee8ded1SSteven Rostedt (VMware) 		hash = iter->probe->ops.func_hash->filter_hash;
3871eee8ded1SSteven Rostedt (VMware) 		size = 1 << hash->size_bits;
3872eee8ded1SSteven Rostedt (VMware) 		iter->pidx = 0;
3873eee8ded1SSteven Rostedt (VMware) 	}
3874eee8ded1SSteven Rostedt (VMware) 
3875eee8ded1SSteven Rostedt (VMware) 	hhd = &hash->buckets[iter->pidx];
38768fc0c701SSteven Rostedt 
38778fc0c701SSteven Rostedt 	if (hlist_empty(hhd)) {
3878eee8ded1SSteven Rostedt (VMware) 		iter->pidx++;
38798fc0c701SSteven Rostedt 		hnd = NULL;
38808fc0c701SSteven Rostedt 		goto retry;
38818fc0c701SSteven Rostedt 	}
38828fc0c701SSteven Rostedt 
38838fc0c701SSteven Rostedt 	if (!hnd)
38848fc0c701SSteven Rostedt 		hnd = hhd->first;
38858fc0c701SSteven Rostedt 	else {
38868fc0c701SSteven Rostedt 		hnd = hnd->next;
38878fc0c701SSteven Rostedt 		if (!hnd) {
3888eee8ded1SSteven Rostedt (VMware) 			iter->pidx++;
38898fc0c701SSteven Rostedt 			goto retry;
38908fc0c701SSteven Rostedt 		}
38918fc0c701SSteven Rostedt 	}
38928fc0c701SSteven Rostedt 
38934aeb6967SSteven Rostedt 	if (WARN_ON_ONCE(!hnd))
38944aeb6967SSteven Rostedt 		return NULL;
38954aeb6967SSteven Rostedt 
3896eee8ded1SSteven Rostedt (VMware) 	iter->probe_entry = hlist_entry(hnd, struct ftrace_func_entry, hlist);
38974aeb6967SSteven Rostedt 
38984aeb6967SSteven Rostedt 	return iter;
38998fc0c701SSteven Rostedt }
39008fc0c701SSteven Rostedt 
3901eee8ded1SSteven Rostedt (VMware) static void *t_probe_start(struct seq_file *m, loff_t *pos)
39028fc0c701SSteven Rostedt {
39038fc0c701SSteven Rostedt 	struct ftrace_iterator *iter = m->private;
39048fc0c701SSteven Rostedt 	void *p = NULL;
3905d82d6244SLi Zefan 	loff_t l;
3906d82d6244SLi Zefan 
3907eee8ded1SSteven Rostedt (VMware) 	if (!(iter->flags & FTRACE_ITER_DO_PROBES))
390869a3083cSSteven Rostedt 		return NULL;
390969a3083cSSteven Rostedt 
39105985ea8bSSteven Rostedt (VMware) 	if (iter->mod_pos > *pos)
39112bccfffdSSteven Rostedt 		return NULL;
39128fc0c701SSteven Rostedt 
3913eee8ded1SSteven Rostedt (VMware) 	iter->probe = NULL;
3914eee8ded1SSteven Rostedt (VMware) 	iter->probe_entry = NULL;
3915eee8ded1SSteven Rostedt (VMware) 	iter->pidx = 0;
39165985ea8bSSteven Rostedt (VMware) 	for (l = 0; l <= (*pos - iter->mod_pos); ) {
3917eee8ded1SSteven Rostedt (VMware) 		p = t_probe_next(m, &l);
3918d82d6244SLi Zefan 		if (!p)
3919d82d6244SLi Zefan 			break;
3920d82d6244SLi Zefan 	}
39214aeb6967SSteven Rostedt 	if (!p)
39224aeb6967SSteven Rostedt 		return NULL;
39234aeb6967SSteven Rostedt 
392498c4fd04SSteven Rostedt 	/* Only set this if we have an item */
3925eee8ded1SSteven Rostedt (VMware) 	iter->flags |= FTRACE_ITER_PROBE;
392698c4fd04SSteven Rostedt 
39274aeb6967SSteven Rostedt 	return iter;
39288fc0c701SSteven Rostedt }
39298fc0c701SSteven Rostedt 
39304aeb6967SSteven Rostedt static int
3931eee8ded1SSteven Rostedt (VMware) t_probe_show(struct seq_file *m, struct ftrace_iterator *iter)
39328fc0c701SSteven Rostedt {
3933eee8ded1SSteven Rostedt (VMware) 	struct ftrace_func_entry *probe_entry;
39347b60f3d8SSteven Rostedt (VMware) 	struct ftrace_probe_ops *probe_ops;
39357b60f3d8SSteven Rostedt (VMware) 	struct ftrace_func_probe *probe;
39368fc0c701SSteven Rostedt 
3937eee8ded1SSteven Rostedt (VMware) 	probe = iter->probe;
3938eee8ded1SSteven Rostedt (VMware) 	probe_entry = iter->probe_entry;
3939eee8ded1SSteven Rostedt (VMware) 
3940eee8ded1SSteven Rostedt (VMware) 	if (WARN_ON_ONCE(!probe || !probe_entry))
39414aeb6967SSteven Rostedt 		return -EIO;
39428fc0c701SSteven Rostedt 
39437b60f3d8SSteven Rostedt (VMware) 	probe_ops = probe->probe_ops;
3944809dcf29SSteven Rostedt 
39457b60f3d8SSteven Rostedt (VMware) 	if (probe_ops->print)
39466e444319SSteven Rostedt (VMware) 		return probe_ops->print(m, probe_entry->ip, probe_ops, probe->data);
39478fc0c701SSteven Rostedt 
39487b60f3d8SSteven Rostedt (VMware) 	seq_printf(m, "%ps:%ps\n", (void *)probe_entry->ip,
39497b60f3d8SSteven Rostedt (VMware) 		   (void *)probe_ops->func);
39508fc0c701SSteven Rostedt 
39518fc0c701SSteven Rostedt 	return 0;
39528fc0c701SSteven Rostedt }
39538fc0c701SSteven Rostedt 
39548fc0c701SSteven Rostedt static void *
39555985ea8bSSteven Rostedt (VMware) t_mod_next(struct seq_file *m, loff_t *pos)
39565985ea8bSSteven Rostedt (VMware) {
39575985ea8bSSteven Rostedt (VMware) 	struct ftrace_iterator *iter = m->private;
39585985ea8bSSteven Rostedt (VMware) 	struct trace_array *tr = iter->tr;
39595985ea8bSSteven Rostedt (VMware) 
39605985ea8bSSteven Rostedt (VMware) 	(*pos)++;
39615985ea8bSSteven Rostedt (VMware) 	iter->pos = *pos;
39625985ea8bSSteven Rostedt (VMware) 
39635985ea8bSSteven Rostedt (VMware) 	iter->mod_list = iter->mod_list->next;
39645985ea8bSSteven Rostedt (VMware) 
39655985ea8bSSteven Rostedt (VMware) 	if (iter->mod_list == &tr->mod_trace ||
39665985ea8bSSteven Rostedt (VMware) 	    iter->mod_list == &tr->mod_notrace) {
39675985ea8bSSteven Rostedt (VMware) 		iter->flags &= ~FTRACE_ITER_MOD;
39685985ea8bSSteven Rostedt (VMware) 		return NULL;
39695985ea8bSSteven Rostedt (VMware) 	}
39705985ea8bSSteven Rostedt (VMware) 
39715985ea8bSSteven Rostedt (VMware) 	iter->mod_pos = *pos;
39725985ea8bSSteven Rostedt (VMware) 
39735985ea8bSSteven Rostedt (VMware) 	return iter;
39745985ea8bSSteven Rostedt (VMware) }
39755985ea8bSSteven Rostedt (VMware) 
39765985ea8bSSteven Rostedt (VMware) static void *t_mod_start(struct seq_file *m, loff_t *pos)
39775985ea8bSSteven Rostedt (VMware) {
39785985ea8bSSteven Rostedt (VMware) 	struct ftrace_iterator *iter = m->private;
39795985ea8bSSteven Rostedt (VMware) 	void *p = NULL;
39805985ea8bSSteven Rostedt (VMware) 	loff_t l;
39815985ea8bSSteven Rostedt (VMware) 
39825985ea8bSSteven Rostedt (VMware) 	if (iter->func_pos > *pos)
39835985ea8bSSteven Rostedt (VMware) 		return NULL;
39845985ea8bSSteven Rostedt (VMware) 
39855985ea8bSSteven Rostedt (VMware) 	iter->mod_pos = iter->func_pos;
39865985ea8bSSteven Rostedt (VMware) 
39875985ea8bSSteven Rostedt (VMware) 	/* probes are only available if tr is set */
39885985ea8bSSteven Rostedt (VMware) 	if (!iter->tr)
39895985ea8bSSteven Rostedt (VMware) 		return NULL;
39905985ea8bSSteven Rostedt (VMware) 
39915985ea8bSSteven Rostedt (VMware) 	for (l = 0; l <= (*pos - iter->func_pos); ) {
39925985ea8bSSteven Rostedt (VMware) 		p = t_mod_next(m, &l);
39935985ea8bSSteven Rostedt (VMware) 		if (!p)
39945985ea8bSSteven Rostedt (VMware) 			break;
39955985ea8bSSteven Rostedt (VMware) 	}
39965985ea8bSSteven Rostedt (VMware) 	if (!p) {
39975985ea8bSSteven Rostedt (VMware) 		iter->flags &= ~FTRACE_ITER_MOD;
39985985ea8bSSteven Rostedt (VMware) 		return t_probe_start(m, pos);
39995985ea8bSSteven Rostedt (VMware) 	}
40005985ea8bSSteven Rostedt (VMware) 
40015985ea8bSSteven Rostedt (VMware) 	/* Only set this if we have an item */
40025985ea8bSSteven Rostedt (VMware) 	iter->flags |= FTRACE_ITER_MOD;
40035985ea8bSSteven Rostedt (VMware) 
40045985ea8bSSteven Rostedt (VMware) 	return iter;
40055985ea8bSSteven Rostedt (VMware) }
40065985ea8bSSteven Rostedt (VMware) 
40075985ea8bSSteven Rostedt (VMware) static int
40085985ea8bSSteven Rostedt (VMware) t_mod_show(struct seq_file *m, struct ftrace_iterator *iter)
40095985ea8bSSteven Rostedt (VMware) {
40105985ea8bSSteven Rostedt (VMware) 	struct ftrace_mod_load *ftrace_mod;
40115985ea8bSSteven Rostedt (VMware) 	struct trace_array *tr = iter->tr;
40125985ea8bSSteven Rostedt (VMware) 
40135985ea8bSSteven Rostedt (VMware) 	if (WARN_ON_ONCE(!iter->mod_list) ||
40145985ea8bSSteven Rostedt (VMware) 			 iter->mod_list == &tr->mod_trace ||
40155985ea8bSSteven Rostedt (VMware) 			 iter->mod_list == &tr->mod_notrace)
40165985ea8bSSteven Rostedt (VMware) 		return -EIO;
40175985ea8bSSteven Rostedt (VMware) 
40185985ea8bSSteven Rostedt (VMware) 	ftrace_mod = list_entry(iter->mod_list, struct ftrace_mod_load, list);
40195985ea8bSSteven Rostedt (VMware) 
40205985ea8bSSteven Rostedt (VMware) 	if (ftrace_mod->func)
40215985ea8bSSteven Rostedt (VMware) 		seq_printf(m, "%s", ftrace_mod->func);
40225985ea8bSSteven Rostedt (VMware) 	else
40235985ea8bSSteven Rostedt (VMware) 		seq_putc(m, '*');
40245985ea8bSSteven Rostedt (VMware) 
40255985ea8bSSteven Rostedt (VMware) 	seq_printf(m, ":mod:%s\n", ftrace_mod->module);
40265985ea8bSSteven Rostedt (VMware) 
40275985ea8bSSteven Rostedt (VMware) 	return 0;
40285985ea8bSSteven Rostedt (VMware) }
40295985ea8bSSteven Rostedt (VMware) 
40305985ea8bSSteven Rostedt (VMware) static void *
40315bd84629SSteven Rostedt (VMware) t_func_next(struct seq_file *m, loff_t *pos)
40325072c59fSSteven Rostedt {
40335072c59fSSteven Rostedt 	struct ftrace_iterator *iter = m->private;
40345072c59fSSteven Rostedt 	struct dyn_ftrace *rec = NULL;
40355072c59fSSteven Rostedt 
40365072c59fSSteven Rostedt 	(*pos)++;
40370c75a3edSSteven Rostedt 
40385072c59fSSteven Rostedt  retry:
40395072c59fSSteven Rostedt 	if (iter->idx >= iter->pg->index) {
40405072c59fSSteven Rostedt 		if (iter->pg->next) {
40415072c59fSSteven Rostedt 			iter->pg = iter->pg->next;
40425072c59fSSteven Rostedt 			iter->idx = 0;
40435072c59fSSteven Rostedt 			goto retry;
40445072c59fSSteven Rostedt 		}
40455072c59fSSteven Rostedt 	} else {
40465072c59fSSteven Rostedt 		rec = &iter->pg->records[iter->idx++];
4047c20489daSSteven Rostedt (VMware) 		if (((iter->flags & (FTRACE_ITER_FILTER | FTRACE_ITER_NOTRACE)) &&
4048c20489daSSteven Rostedt (VMware) 		     !ftrace_lookup_ip(iter->hash, rec->ip)) ||
4049647bcd03SSteven Rostedt 
4050647bcd03SSteven Rostedt 		    ((iter->flags & FTRACE_ITER_ENABLED) &&
4051e11b521aSSteven Rostedt (Google) 		     !(rec->flags & FTRACE_FL_ENABLED)) ||
4052e11b521aSSteven Rostedt (Google) 
4053e11b521aSSteven Rostedt (Google) 		    ((iter->flags & FTRACE_ITER_TOUCHED) &&
4054e11b521aSSteven Rostedt (Google) 		     !(rec->flags & FTRACE_FL_TOUCHED))) {
4055647bcd03SSteven Rostedt 
40565072c59fSSteven Rostedt 			rec = NULL;
40575072c59fSSteven Rostedt 			goto retry;
40585072c59fSSteven Rostedt 		}
40595072c59fSSteven Rostedt 	}
40605072c59fSSteven Rostedt 
40614aeb6967SSteven Rostedt 	if (!rec)
40625bd84629SSteven Rostedt (VMware) 		return NULL;
40634aeb6967SSteven Rostedt 
40645bd84629SSteven Rostedt (VMware) 	iter->pos = iter->func_pos = *pos;
40654aeb6967SSteven Rostedt 	iter->func = rec;
40664aeb6967SSteven Rostedt 
40674aeb6967SSteven Rostedt 	return iter;
40685072c59fSSteven Rostedt }
40695072c59fSSteven Rostedt 
40705bd84629SSteven Rostedt (VMware) static void *
40715bd84629SSteven Rostedt (VMware) t_next(struct seq_file *m, void *v, loff_t *pos)
40725bd84629SSteven Rostedt (VMware) {
40735bd84629SSteven Rostedt (VMware) 	struct ftrace_iterator *iter = m->private;
40745985ea8bSSteven Rostedt (VMware) 	loff_t l = *pos; /* t_probe_start() must use original pos */
40755bd84629SSteven Rostedt (VMware) 	void *ret;
40765bd84629SSteven Rostedt (VMware) 
40775bd84629SSteven Rostedt (VMware) 	if (unlikely(ftrace_disabled))
40785bd84629SSteven Rostedt (VMware) 		return NULL;
40795bd84629SSteven Rostedt (VMware) 
4080eee8ded1SSteven Rostedt (VMware) 	if (iter->flags & FTRACE_ITER_PROBE)
4081eee8ded1SSteven Rostedt (VMware) 		return t_probe_next(m, pos);
40825bd84629SSteven Rostedt (VMware) 
40835985ea8bSSteven Rostedt (VMware) 	if (iter->flags & FTRACE_ITER_MOD)
40845985ea8bSSteven Rostedt (VMware) 		return t_mod_next(m, pos);
40855985ea8bSSteven Rostedt (VMware) 
40865bd84629SSteven Rostedt (VMware) 	if (iter->flags & FTRACE_ITER_PRINTALL) {
4087eee8ded1SSteven Rostedt (VMware) 		/* next must increment pos, and t_probe_start does not */
40885bd84629SSteven Rostedt (VMware) 		(*pos)++;
40895985ea8bSSteven Rostedt (VMware) 		return t_mod_start(m, &l);
40905bd84629SSteven Rostedt (VMware) 	}
40915bd84629SSteven Rostedt (VMware) 
40925bd84629SSteven Rostedt (VMware) 	ret = t_func_next(m, pos);
40935bd84629SSteven Rostedt (VMware) 
40945bd84629SSteven Rostedt (VMware) 	if (!ret)
40955985ea8bSSteven Rostedt (VMware) 		return t_mod_start(m, &l);
40965bd84629SSteven Rostedt (VMware) 
40975bd84629SSteven Rostedt (VMware) 	return ret;
40985bd84629SSteven Rostedt (VMware) }
40995bd84629SSteven Rostedt (VMware) 
410098c4fd04SSteven Rostedt static void reset_iter_read(struct ftrace_iterator *iter)
410198c4fd04SSteven Rostedt {
410298c4fd04SSteven Rostedt 	iter->pos = 0;
410398c4fd04SSteven Rostedt 	iter->func_pos = 0;
41045985ea8bSSteven Rostedt (VMware) 	iter->flags &= ~(FTRACE_ITER_PRINTALL | FTRACE_ITER_PROBE | FTRACE_ITER_MOD);
41055072c59fSSteven Rostedt }
41065072c59fSSteven Rostedt 
41075072c59fSSteven Rostedt static void *t_start(struct seq_file *m, loff_t *pos)
41085072c59fSSteven Rostedt {
41095072c59fSSteven Rostedt 	struct ftrace_iterator *iter = m->private;
41105072c59fSSteven Rostedt 	void *p = NULL;
4111694ce0a5SLi Zefan 	loff_t l;
41125072c59fSSteven Rostedt 
41138fc0c701SSteven Rostedt 	mutex_lock(&ftrace_lock);
411445a4a237SSteven Rostedt 
411545a4a237SSteven Rostedt 	if (unlikely(ftrace_disabled))
411645a4a237SSteven Rostedt 		return NULL;
411745a4a237SSteven Rostedt 
41180c75a3edSSteven Rostedt 	/*
411998c4fd04SSteven Rostedt 	 * If an lseek was done, then reset and start from beginning.
412098c4fd04SSteven Rostedt 	 */
412198c4fd04SSteven Rostedt 	if (*pos < iter->pos)
412298c4fd04SSteven Rostedt 		reset_iter_read(iter);
412398c4fd04SSteven Rostedt 
412498c4fd04SSteven Rostedt 	/*
41250c75a3edSSteven Rostedt 	 * For set_ftrace_filter reading, if we have the filter
41260c75a3edSSteven Rostedt 	 * off, we can short cut and just print out that all
41270c75a3edSSteven Rostedt 	 * functions are enabled.
41280c75a3edSSteven Rostedt 	 */
4129c20489daSSteven Rostedt (VMware) 	if ((iter->flags & (FTRACE_ITER_FILTER | FTRACE_ITER_NOTRACE)) &&
4130c20489daSSteven Rostedt (VMware) 	    ftrace_hash_empty(iter->hash)) {
413143ff926aSSteven Rostedt (VMware) 		iter->func_pos = 1; /* Account for the message */
41320c75a3edSSteven Rostedt 		if (*pos > 0)
41335985ea8bSSteven Rostedt (VMware) 			return t_mod_start(m, pos);
41340c75a3edSSteven Rostedt 		iter->flags |= FTRACE_ITER_PRINTALL;
4135df091625SChris Wright 		/* reset in case of seek/pread */
4136eee8ded1SSteven Rostedt (VMware) 		iter->flags &= ~FTRACE_ITER_PROBE;
41370c75a3edSSteven Rostedt 		return iter;
41380c75a3edSSteven Rostedt 	}
41390c75a3edSSteven Rostedt 
41405985ea8bSSteven Rostedt (VMware) 	if (iter->flags & FTRACE_ITER_MOD)
41415985ea8bSSteven Rostedt (VMware) 		return t_mod_start(m, pos);
41428fc0c701SSteven Rostedt 
414398c4fd04SSteven Rostedt 	/*
414498c4fd04SSteven Rostedt 	 * Unfortunately, we need to restart at ftrace_pages_start
414598c4fd04SSteven Rostedt 	 * every time we let go of the ftrace_mutex. This is because
414698c4fd04SSteven Rostedt 	 * those pointers can change without the lock.
414798c4fd04SSteven Rostedt 	 */
4148694ce0a5SLi Zefan 	iter->pg = ftrace_pages_start;
4149694ce0a5SLi Zefan 	iter->idx = 0;
4150694ce0a5SLi Zefan 	for (l = 0; l <= *pos; ) {
41515bd84629SSteven Rostedt (VMware) 		p = t_func_next(m, &l);
4152694ce0a5SLi Zefan 		if (!p)
4153694ce0a5SLi Zefan 			break;
415450cdaf08SLiming Wang 	}
41555821e1b7Swalimis 
415669a3083cSSteven Rostedt 	if (!p)
41575985ea8bSSteven Rostedt (VMware) 		return t_mod_start(m, pos);
41588fc0c701SSteven Rostedt 
41594aeb6967SSteven Rostedt 	return iter;
41605072c59fSSteven Rostedt }
41615072c59fSSteven Rostedt 
41625072c59fSSteven Rostedt static void t_stop(struct seq_file *m, void *p)
41635072c59fSSteven Rostedt {
41648fc0c701SSteven Rostedt 	mutex_unlock(&ftrace_lock);
41655072c59fSSteven Rostedt }
41665072c59fSSteven Rostedt 
416715d5b02cSSteven Rostedt (Red Hat) void * __weak
416815d5b02cSSteven Rostedt (Red Hat) arch_ftrace_trampoline_func(struct ftrace_ops *ops, struct dyn_ftrace *rec)
416915d5b02cSSteven Rostedt (Red Hat) {
417015d5b02cSSteven Rostedt (Red Hat) 	return NULL;
417115d5b02cSSteven Rostedt (Red Hat) }
417215d5b02cSSteven Rostedt (Red Hat) 
417315d5b02cSSteven Rostedt (Red Hat) static void add_trampoline_func(struct seq_file *m, struct ftrace_ops *ops,
417415d5b02cSSteven Rostedt (Red Hat) 				struct dyn_ftrace *rec)
417515d5b02cSSteven Rostedt (Red Hat) {
417615d5b02cSSteven Rostedt (Red Hat) 	void *ptr;
417715d5b02cSSteven Rostedt (Red Hat) 
417815d5b02cSSteven Rostedt (Red Hat) 	ptr = arch_ftrace_trampoline_func(ops, rec);
417915d5b02cSSteven Rostedt (Red Hat) 	if (ptr)
418015d5b02cSSteven Rostedt (Red Hat) 		seq_printf(m, " ->%pS", ptr);
418115d5b02cSSteven Rostedt (Red Hat) }
418215d5b02cSSteven Rostedt (Red Hat) 
4183b39181f7SSteven Rostedt (Google) #ifdef FTRACE_MCOUNT_MAX_OFFSET
4184b39181f7SSteven Rostedt (Google) /*
4185b39181f7SSteven Rostedt (Google)  * Weak functions can still have an mcount/fentry that is saved in
4186b39181f7SSteven Rostedt (Google)  * the __mcount_loc section. These can be detected by having a
4187b39181f7SSteven Rostedt (Google)  * symbol offset of greater than FTRACE_MCOUNT_MAX_OFFSET, as the
4188b39181f7SSteven Rostedt (Google)  * symbol found by kallsyms is not the function that the mcount/fentry
4189b39181f7SSteven Rostedt (Google)  * is part of. The offset is much greater in these cases.
4190b39181f7SSteven Rostedt (Google)  *
4191b39181f7SSteven Rostedt (Google)  * Test the record to make sure that the ip points to a valid kallsyms
4192b39181f7SSteven Rostedt (Google)  * and if not, mark it disabled.
4193b39181f7SSteven Rostedt (Google)  */
4194b39181f7SSteven Rostedt (Google) static int test_for_valid_rec(struct dyn_ftrace *rec)
4195b39181f7SSteven Rostedt (Google) {
4196b39181f7SSteven Rostedt (Google) 	char str[KSYM_SYMBOL_LEN];
4197b39181f7SSteven Rostedt (Google) 	unsigned long offset;
4198b39181f7SSteven Rostedt (Google) 	const char *ret;
4199b39181f7SSteven Rostedt (Google) 
4200b39181f7SSteven Rostedt (Google) 	ret = kallsyms_lookup(rec->ip, NULL, &offset, NULL, str);
4201b39181f7SSteven Rostedt (Google) 
4202b39181f7SSteven Rostedt (Google) 	/* Weak functions can cause invalid addresses */
4203b39181f7SSteven Rostedt (Google) 	if (!ret || offset > FTRACE_MCOUNT_MAX_OFFSET) {
4204b39181f7SSteven Rostedt (Google) 		rec->flags |= FTRACE_FL_DISABLED;
4205b39181f7SSteven Rostedt (Google) 		return 0;
4206b39181f7SSteven Rostedt (Google) 	}
4207b39181f7SSteven Rostedt (Google) 	return 1;
4208b39181f7SSteven Rostedt (Google) }
4209b39181f7SSteven Rostedt (Google) 
4210b39181f7SSteven Rostedt (Google) static struct workqueue_struct *ftrace_check_wq __initdata;
4211b39181f7SSteven Rostedt (Google) static struct work_struct ftrace_check_work __initdata;
4212b39181f7SSteven Rostedt (Google) 
4213b39181f7SSteven Rostedt (Google) /*
4214b39181f7SSteven Rostedt (Google)  * Scan all the mcount/fentry entries to make sure they are valid.
4215b39181f7SSteven Rostedt (Google)  */
4216b39181f7SSteven Rostedt (Google) static __init void ftrace_check_work_func(struct work_struct *work)
4217b39181f7SSteven Rostedt (Google) {
4218b39181f7SSteven Rostedt (Google) 	struct ftrace_page *pg;
4219b39181f7SSteven Rostedt (Google) 	struct dyn_ftrace *rec;
4220b39181f7SSteven Rostedt (Google) 
4221b39181f7SSteven Rostedt (Google) 	mutex_lock(&ftrace_lock);
4222b39181f7SSteven Rostedt (Google) 	do_for_each_ftrace_rec(pg, rec) {
4223b39181f7SSteven Rostedt (Google) 		test_for_valid_rec(rec);
4224b39181f7SSteven Rostedt (Google) 	} while_for_each_ftrace_rec();
4225b39181f7SSteven Rostedt (Google) 	mutex_unlock(&ftrace_lock);
4226b39181f7SSteven Rostedt (Google) }
4227b39181f7SSteven Rostedt (Google) 
4228b39181f7SSteven Rostedt (Google) static int __init ftrace_check_for_weak_functions(void)
4229b39181f7SSteven Rostedt (Google) {
4230b39181f7SSteven Rostedt (Google) 	INIT_WORK(&ftrace_check_work, ftrace_check_work_func);
4231b39181f7SSteven Rostedt (Google) 
4232b39181f7SSteven Rostedt (Google) 	ftrace_check_wq = alloc_workqueue("ftrace_check_wq", WQ_UNBOUND, 0);
4233b39181f7SSteven Rostedt (Google) 
4234b39181f7SSteven Rostedt (Google) 	queue_work(ftrace_check_wq, &ftrace_check_work);
4235b39181f7SSteven Rostedt (Google) 	return 0;
4236b39181f7SSteven Rostedt (Google) }
4237b39181f7SSteven Rostedt (Google) 
4238b39181f7SSteven Rostedt (Google) static int __init ftrace_check_sync(void)
4239b39181f7SSteven Rostedt (Google) {
4240b39181f7SSteven Rostedt (Google) 	/* Make sure the ftrace_check updates are finished */
4241b39181f7SSteven Rostedt (Google) 	if (ftrace_check_wq)
4242b39181f7SSteven Rostedt (Google) 		destroy_workqueue(ftrace_check_wq);
4243b39181f7SSteven Rostedt (Google) 	return 0;
4244b39181f7SSteven Rostedt (Google) }
4245b39181f7SSteven Rostedt (Google) 
4246b39181f7SSteven Rostedt (Google) late_initcall_sync(ftrace_check_sync);
4247b39181f7SSteven Rostedt (Google) subsys_initcall(ftrace_check_for_weak_functions);
4248b39181f7SSteven Rostedt (Google) 
4249b39181f7SSteven Rostedt (Google) static int print_rec(struct seq_file *m, unsigned long ip)
4250b39181f7SSteven Rostedt (Google) {
4251b39181f7SSteven Rostedt (Google) 	unsigned long offset;
4252b39181f7SSteven Rostedt (Google) 	char str[KSYM_SYMBOL_LEN];
4253b39181f7SSteven Rostedt (Google) 	char *modname;
4254b39181f7SSteven Rostedt (Google) 	const char *ret;
4255b39181f7SSteven Rostedt (Google) 
4256b39181f7SSteven Rostedt (Google) 	ret = kallsyms_lookup(ip, NULL, &offset, &modname, str);
4257b39181f7SSteven Rostedt (Google) 	/* Weak functions can cause invalid addresses */
4258b39181f7SSteven Rostedt (Google) 	if (!ret || offset > FTRACE_MCOUNT_MAX_OFFSET) {
4259b39181f7SSteven Rostedt (Google) 		snprintf(str, KSYM_SYMBOL_LEN, "%s_%ld",
4260b39181f7SSteven Rostedt (Google) 			 FTRACE_INVALID_FUNCTION, offset);
4261b39181f7SSteven Rostedt (Google) 		ret = NULL;
4262b39181f7SSteven Rostedt (Google) 	}
4263b39181f7SSteven Rostedt (Google) 
4264b39181f7SSteven Rostedt (Google) 	seq_puts(m, str);
4265b39181f7SSteven Rostedt (Google) 	if (modname)
4266b39181f7SSteven Rostedt (Google) 		seq_printf(m, " [%s]", modname);
4267b39181f7SSteven Rostedt (Google) 	return ret == NULL ? -1 : 0;
4268b39181f7SSteven Rostedt (Google) }
4269b39181f7SSteven Rostedt (Google) #else
4270b39181f7SSteven Rostedt (Google) static inline int test_for_valid_rec(struct dyn_ftrace *rec)
4271b39181f7SSteven Rostedt (Google) {
4272b39181f7SSteven Rostedt (Google) 	return 1;
4273b39181f7SSteven Rostedt (Google) }
4274b39181f7SSteven Rostedt (Google) 
4275b39181f7SSteven Rostedt (Google) static inline int print_rec(struct seq_file *m, unsigned long ip)
4276b39181f7SSteven Rostedt (Google) {
4277b39181f7SSteven Rostedt (Google) 	seq_printf(m, "%ps", (void *)ip);
4278b39181f7SSteven Rostedt (Google) 	return 0;
4279b39181f7SSteven Rostedt (Google) }
4280b39181f7SSteven Rostedt (Google) #endif
4281b39181f7SSteven Rostedt (Google) 
42825072c59fSSteven Rostedt static int t_show(struct seq_file *m, void *v)
42835072c59fSSteven Rostedt {
42840c75a3edSSteven Rostedt 	struct ftrace_iterator *iter = m->private;
42854aeb6967SSteven Rostedt 	struct dyn_ftrace *rec;
42865072c59fSSteven Rostedt 
4287eee8ded1SSteven Rostedt (VMware) 	if (iter->flags & FTRACE_ITER_PROBE)
4288eee8ded1SSteven Rostedt (VMware) 		return t_probe_show(m, iter);
42898fc0c701SSteven Rostedt 
42905985ea8bSSteven Rostedt (VMware) 	if (iter->flags & FTRACE_ITER_MOD)
42915985ea8bSSteven Rostedt (VMware) 		return t_mod_show(m, iter);
42925985ea8bSSteven Rostedt (VMware) 
42930c75a3edSSteven Rostedt 	if (iter->flags & FTRACE_ITER_PRINTALL) {
42948c006cf7SNamhyung Kim 		if (iter->flags & FTRACE_ITER_NOTRACE)
4295fa6f0cc7SRasmus Villemoes 			seq_puts(m, "#### no functions disabled ####\n");
42968c006cf7SNamhyung Kim 		else
4297fa6f0cc7SRasmus Villemoes 			seq_puts(m, "#### all functions enabled ####\n");
42980c75a3edSSteven Rostedt 		return 0;
42990c75a3edSSteven Rostedt 	}
43000c75a3edSSteven Rostedt 
43014aeb6967SSteven Rostedt 	rec = iter->func;
43024aeb6967SSteven Rostedt 
43035072c59fSSteven Rostedt 	if (!rec)
43045072c59fSSteven Rostedt 		return 0;
43055072c59fSSteven Rostedt 
430683f74441SJiri Olsa 	if (iter->flags & FTRACE_ITER_ADDRS)
430783f74441SJiri Olsa 		seq_printf(m, "%lx ", rec->ip);
430883f74441SJiri Olsa 
4309b39181f7SSteven Rostedt (Google) 	if (print_rec(m, rec->ip)) {
4310b39181f7SSteven Rostedt (Google) 		/* This should only happen when a rec is disabled */
4311b39181f7SSteven Rostedt (Google) 		WARN_ON_ONCE(!(rec->flags & FTRACE_FL_DISABLED));
4312b39181f7SSteven Rostedt (Google) 		seq_putc(m, '\n');
4313b39181f7SSteven Rostedt (Google) 		return 0;
4314b39181f7SSteven Rostedt (Google) 	}
4315b39181f7SSteven Rostedt (Google) 
4316e11b521aSSteven Rostedt (Google) 	if (iter->flags & (FTRACE_ITER_ENABLED | FTRACE_ITER_TOUCHED)) {
4317030f4e1cSSteven Rostedt (Red Hat) 		struct ftrace_ops *ops;
431815d5b02cSSteven Rostedt (Red Hat) 
43196ce2c04fSSteven Rostedt (Google) 		seq_printf(m, " (%ld)%s%s%s%s%s",
43200376bde1SSteven Rostedt (Red Hat) 			   ftrace_rec_count(rec),
4321f8b8be8aSMasami Hiramatsu 			   rec->flags & FTRACE_FL_REGS ? " R" : "  ",
4322763e34e7SSteven Rostedt (VMware) 			   rec->flags & FTRACE_FL_IPMODIFY ? " I" : "  ",
4323cbad0fb2SMark Rutland 			   rec->flags & FTRACE_FL_DIRECT ? " D" : "  ",
43246ce2c04fSSteven Rostedt (Google) 			   rec->flags & FTRACE_FL_CALL_OPS ? " O" : "  ",
43256ce2c04fSSteven Rostedt (Google) 			   rec->flags & FTRACE_FL_MODIFIED ? " M " : "   ");
43269674b2faSSteven Rostedt (Red Hat) 		if (rec->flags & FTRACE_FL_TRAMP_EN) {
43275fecaa04SSteven Rostedt (Red Hat) 			ops = ftrace_find_tramp_ops_any(rec);
432839daa7b9SSteven Rostedt (Red Hat) 			if (ops) {
432939daa7b9SSteven Rostedt (Red Hat) 				do {
433039daa7b9SSteven Rostedt (Red Hat) 					seq_printf(m, "\ttramp: %pS (%pS)",
433139daa7b9SSteven Rostedt (Red Hat) 						   (void *)ops->trampoline,
433239daa7b9SSteven Rostedt (Red Hat) 						   (void *)ops->func);
4333030f4e1cSSteven Rostedt (Red Hat) 					add_trampoline_func(m, ops, rec);
433439daa7b9SSteven Rostedt (Red Hat) 					ops = ftrace_find_tramp_ops_next(rec, ops);
433539daa7b9SSteven Rostedt (Red Hat) 				} while (ops);
433639daa7b9SSteven Rostedt (Red Hat) 			} else
4337fa6f0cc7SRasmus Villemoes 				seq_puts(m, "\ttramp: ERROR!");
4338030f4e1cSSteven Rostedt (Red Hat) 		} else {
4339030f4e1cSSteven Rostedt (Red Hat) 			add_trampoline_func(m, NULL, rec);
43409674b2faSSteven Rostedt (Red Hat) 		}
4341cbad0fb2SMark Rutland 		if (rec->flags & FTRACE_FL_CALL_OPS_EN) {
4342cbad0fb2SMark Rutland 			ops = ftrace_find_unique_ops(rec);
4343cbad0fb2SMark Rutland 			if (ops) {
4344cbad0fb2SMark Rutland 				seq_printf(m, "\tops: %pS (%pS)",
4345cbad0fb2SMark Rutland 					   ops, ops->func);
4346cbad0fb2SMark Rutland 			} else {
4347cbad0fb2SMark Rutland 				seq_puts(m, "\tops: ERROR!");
4348cbad0fb2SMark Rutland 			}
4349cbad0fb2SMark Rutland 		}
4350763e34e7SSteven Rostedt (VMware) 		if (rec->flags & FTRACE_FL_DIRECT) {
4351763e34e7SSteven Rostedt (VMware) 			unsigned long direct;
4352763e34e7SSteven Rostedt (VMware) 
4353ff205766SAlexei Starovoitov 			direct = ftrace_find_rec_direct(rec->ip);
4354763e34e7SSteven Rostedt (VMware) 			if (direct)
4355763e34e7SSteven Rostedt (VMware) 				seq_printf(m, "\n\tdirect-->%pS", (void *)direct);
4356763e34e7SSteven Rostedt (VMware) 		}
43579674b2faSSteven Rostedt (Red Hat) 	}
43589674b2faSSteven Rostedt (Red Hat) 
4359fa6f0cc7SRasmus Villemoes 	seq_putc(m, '\n');
43605072c59fSSteven Rostedt 
43615072c59fSSteven Rostedt 	return 0;
43625072c59fSSteven Rostedt }
43635072c59fSSteven Rostedt 
436488e9d34cSJames Morris static const struct seq_operations show_ftrace_seq_ops = {
43655072c59fSSteven Rostedt 	.start = t_start,
43665072c59fSSteven Rostedt 	.next = t_next,
43675072c59fSSteven Rostedt 	.stop = t_stop,
43685072c59fSSteven Rostedt 	.show = t_show,
43695072c59fSSteven Rostedt };
43705072c59fSSteven Rostedt 
4371e309b41dSIngo Molnar static int
43725072c59fSSteven Rostedt ftrace_avail_open(struct inode *inode, struct file *file)
43735072c59fSSteven Rostedt {
43745072c59fSSteven Rostedt 	struct ftrace_iterator *iter;
437517911ff3SSteven Rostedt (VMware) 	int ret;
437617911ff3SSteven Rostedt (VMware) 
437717911ff3SSteven Rostedt (VMware) 	ret = security_locked_down(LOCKDOWN_TRACEFS);
437817911ff3SSteven Rostedt (VMware) 	if (ret)
437917911ff3SSteven Rostedt (VMware) 		return ret;
43805072c59fSSteven Rostedt 
43814eebcc81SSteven Rostedt 	if (unlikely(ftrace_disabled))
43824eebcc81SSteven Rostedt 		return -ENODEV;
43834eebcc81SSteven Rostedt 
438450e18b94SJiri Olsa 	iter = __seq_open_private(file, &show_ftrace_seq_ops, sizeof(*iter));
4385c1bc5919SSteven Rostedt (VMware) 	if (!iter)
4386c1bc5919SSteven Rostedt (VMware) 		return -ENOMEM;
4387c1bc5919SSteven Rostedt (VMware) 
43885072c59fSSteven Rostedt 	iter->pg = ftrace_pages_start;
4389fc13cb0cSSteven Rostedt 	iter->ops = &global_ops;
43905072c59fSSteven Rostedt 
4391c1bc5919SSteven Rostedt (VMware) 	return 0;
43925072c59fSSteven Rostedt }
43935072c59fSSteven Rostedt 
4394647bcd03SSteven Rostedt static int
4395647bcd03SSteven Rostedt ftrace_enabled_open(struct inode *inode, struct file *file)
4396647bcd03SSteven Rostedt {
4397647bcd03SSteven Rostedt 	struct ftrace_iterator *iter;
4398647bcd03SSteven Rostedt 
439917911ff3SSteven Rostedt (VMware) 	/*
440017911ff3SSteven Rostedt (VMware) 	 * This shows us what functions are currently being
440117911ff3SSteven Rostedt (VMware) 	 * traced and by what. Not sure if we want lockdown
440217911ff3SSteven Rostedt (VMware) 	 * to hide such critical information for an admin.
440317911ff3SSteven Rostedt (VMware) 	 * Although, perhaps it can show information we don't
440417911ff3SSteven Rostedt (VMware) 	 * want people to see, but if something is tracing
440517911ff3SSteven Rostedt (VMware) 	 * something, we probably want to know about it.
440617911ff3SSteven Rostedt (VMware) 	 */
440717911ff3SSteven Rostedt (VMware) 
440850e18b94SJiri Olsa 	iter = __seq_open_private(file, &show_ftrace_seq_ops, sizeof(*iter));
4409c1bc5919SSteven Rostedt (VMware) 	if (!iter)
4410c1bc5919SSteven Rostedt (VMware) 		return -ENOMEM;
4411c1bc5919SSteven Rostedt (VMware) 
4412647bcd03SSteven Rostedt 	iter->pg = ftrace_pages_start;
4413647bcd03SSteven Rostedt 	iter->flags = FTRACE_ITER_ENABLED;
4414fc13cb0cSSteven Rostedt 	iter->ops = &global_ops;
4415647bcd03SSteven Rostedt 
4416c1bc5919SSteven Rostedt (VMware) 	return 0;
4417647bcd03SSteven Rostedt }
4418647bcd03SSteven Rostedt 
4419e11b521aSSteven Rostedt (Google) static int
4420e11b521aSSteven Rostedt (Google) ftrace_touched_open(struct inode *inode, struct file *file)
4421e11b521aSSteven Rostedt (Google) {
4422e11b521aSSteven Rostedt (Google) 	struct ftrace_iterator *iter;
4423e11b521aSSteven Rostedt (Google) 
4424e11b521aSSteven Rostedt (Google) 	/*
4425e11b521aSSteven Rostedt (Google) 	 * This shows us what functions have ever been enabled
4426e11b521aSSteven Rostedt (Google) 	 * (traced, direct, patched, etc). Not sure if we want lockdown
4427e11b521aSSteven Rostedt (Google) 	 * to hide such critical information for an admin.
4428e11b521aSSteven Rostedt (Google) 	 * Although, perhaps it can show information we don't
4429e11b521aSSteven Rostedt (Google) 	 * want people to see, but if something had traced
4430e11b521aSSteven Rostedt (Google) 	 * something, we probably want to know about it.
4431e11b521aSSteven Rostedt (Google) 	 */
4432e11b521aSSteven Rostedt (Google) 
4433e11b521aSSteven Rostedt (Google) 	iter = __seq_open_private(file, &show_ftrace_seq_ops, sizeof(*iter));
4434e11b521aSSteven Rostedt (Google) 	if (!iter)
4435e11b521aSSteven Rostedt (Google) 		return -ENOMEM;
4436e11b521aSSteven Rostedt (Google) 
4437e11b521aSSteven Rostedt (Google) 	iter->pg = ftrace_pages_start;
4438e11b521aSSteven Rostedt (Google) 	iter->flags = FTRACE_ITER_TOUCHED;
4439e11b521aSSteven Rostedt (Google) 	iter->ops = &global_ops;
4440e11b521aSSteven Rostedt (Google) 
4441e11b521aSSteven Rostedt (Google) 	return 0;
4442e11b521aSSteven Rostedt (Google) }
4443e11b521aSSteven Rostedt (Google) 
444483f74441SJiri Olsa static int
444583f74441SJiri Olsa ftrace_avail_addrs_open(struct inode *inode, struct file *file)
444683f74441SJiri Olsa {
444783f74441SJiri Olsa 	struct ftrace_iterator *iter;
444883f74441SJiri Olsa 	int ret;
444983f74441SJiri Olsa 
445083f74441SJiri Olsa 	ret = security_locked_down(LOCKDOWN_TRACEFS);
445183f74441SJiri Olsa 	if (ret)
445283f74441SJiri Olsa 		return ret;
445383f74441SJiri Olsa 
445483f74441SJiri Olsa 	if (unlikely(ftrace_disabled))
445583f74441SJiri Olsa 		return -ENODEV;
445683f74441SJiri Olsa 
445783f74441SJiri Olsa 	iter = __seq_open_private(file, &show_ftrace_seq_ops, sizeof(*iter));
445883f74441SJiri Olsa 	if (!iter)
445983f74441SJiri Olsa 		return -ENOMEM;
446083f74441SJiri Olsa 
446183f74441SJiri Olsa 	iter->pg = ftrace_pages_start;
446283f74441SJiri Olsa 	iter->flags = FTRACE_ITER_ADDRS;
446383f74441SJiri Olsa 	iter->ops = &global_ops;
446483f74441SJiri Olsa 
446583f74441SJiri Olsa 	return 0;
446683f74441SJiri Olsa }
446783f74441SJiri Olsa 
4468fc13cb0cSSteven Rostedt /**
4469fc13cb0cSSteven Rostedt  * ftrace_regex_open - initialize function tracer filter files
4470fc13cb0cSSteven Rostedt  * @ops: The ftrace_ops that hold the hash filters
4471fc13cb0cSSteven Rostedt  * @flag: The type of filter to process
4472fc13cb0cSSteven Rostedt  * @inode: The inode, usually passed in to your open routine
4473fc13cb0cSSteven Rostedt  * @file: The file, usually passed in to your open routine
4474fc13cb0cSSteven Rostedt  *
4475fc13cb0cSSteven Rostedt  * ftrace_regex_open() initializes the filter files for the
4476fc13cb0cSSteven Rostedt  * @ops. Depending on @flag it may process the filter hash or
4477fc13cb0cSSteven Rostedt  * the notrace hash of @ops. With this called from the open
4478fc13cb0cSSteven Rostedt  * routine, you can use ftrace_filter_write() for the write
4479fc13cb0cSSteven Rostedt  * routine if @flag has FTRACE_ITER_FILTER set, or
4480fc13cb0cSSteven Rostedt  * ftrace_notrace_write() if @flag has FTRACE_ITER_NOTRACE set.
4481098c879eSSteven Rostedt (Red Hat)  * tracing_lseek() should be used as the lseek routine, and
4482fc13cb0cSSteven Rostedt  * release must call ftrace_regex_release().
4483d1530413SRandy Dunlap  *
4484d1530413SRandy Dunlap  * Returns: 0 on success or a negative errno value on failure
4485fc13cb0cSSteven Rostedt  */
4486fc13cb0cSSteven Rostedt int
4487f45948e8SSteven Rostedt ftrace_regex_open(struct ftrace_ops *ops, int flag,
44881cf41dd7SSteven Rostedt 		  struct inode *inode, struct file *file)
44895072c59fSSteven Rostedt {
44905072c59fSSteven Rostedt 	struct ftrace_iterator *iter;
4491f45948e8SSteven Rostedt 	struct ftrace_hash *hash;
4492673feb9dSSteven Rostedt (VMware) 	struct list_head *mod_head;
4493673feb9dSSteven Rostedt (VMware) 	struct trace_array *tr = ops->private;
44949ef16693SSteven Rostedt (VMware) 	int ret = -ENOMEM;
44955072c59fSSteven Rostedt 
4496f04f24fbSMasami Hiramatsu 	ftrace_ops_init(ops);
4497f04f24fbSMasami Hiramatsu 
44984eebcc81SSteven Rostedt 	if (unlikely(ftrace_disabled))
44994eebcc81SSteven Rostedt 		return -ENODEV;
45004eebcc81SSteven Rostedt 
45018530dec6SSteven Rostedt (VMware) 	if (tracing_check_open_get_tr(tr))
45029ef16693SSteven Rostedt (VMware) 		return -ENODEV;
45039ef16693SSteven Rostedt (VMware) 
45045072c59fSSteven Rostedt 	iter = kzalloc(sizeof(*iter), GFP_KERNEL);
45055072c59fSSteven Rostedt 	if (!iter)
45069ef16693SSteven Rostedt (VMware) 		goto out;
45075072c59fSSteven Rostedt 
45089ef16693SSteven Rostedt (VMware) 	if (trace_parser_get_init(&iter->parser, FTRACE_BUFF_MAX))
45099ef16693SSteven Rostedt (VMware) 		goto out;
4510689fd8b6S[email protected] 
45113f2367baSMasami Hiramatsu 	iter->ops = ops;
45123f2367baSMasami Hiramatsu 	iter->flags = flag;
45135985ea8bSSteven Rostedt (VMware) 	iter->tr = tr;
45143f2367baSMasami Hiramatsu 
451533b7f99cSSteven Rostedt (Red Hat) 	mutex_lock(&ops->func_hash->regex_lock);
45163f2367baSMasami Hiramatsu 
4517673feb9dSSteven Rostedt (VMware) 	if (flag & FTRACE_ITER_NOTRACE) {
451833b7f99cSSteven Rostedt (Red Hat) 		hash = ops->func_hash->notrace_hash;
45195985ea8bSSteven Rostedt (VMware) 		mod_head = tr ? &tr->mod_notrace : NULL;
4520673feb9dSSteven Rostedt (VMware) 	} else {
452133b7f99cSSteven Rostedt (Red Hat) 		hash = ops->func_hash->filter_hash;
45225985ea8bSSteven Rostedt (VMware) 		mod_head = tr ? &tr->mod_trace : NULL;
4523673feb9dSSteven Rostedt (VMware) 	}
4524f45948e8SSteven Rostedt 
45255985ea8bSSteven Rostedt (VMware) 	iter->mod_list = mod_head;
45265985ea8bSSteven Rostedt (VMware) 
452733dc9b12SSteven Rostedt 	if (file->f_mode & FMODE_WRITE) {
4528ef2fbe16SNamhyung Kim 		const int size_bits = FTRACE_HASH_DEFAULT_BITS;
4529ef2fbe16SNamhyung Kim 
4530673feb9dSSteven Rostedt (VMware) 		if (file->f_flags & O_TRUNC) {
4531ef2fbe16SNamhyung Kim 			iter->hash = alloc_ftrace_hash(size_bits);
4532673feb9dSSteven Rostedt (VMware) 			clear_ftrace_mod_list(mod_head);
4533673feb9dSSteven Rostedt (VMware) 	        } else {
4534ef2fbe16SNamhyung Kim 			iter->hash = alloc_and_copy_ftrace_hash(size_bits, hash);
4535673feb9dSSteven Rostedt (VMware) 		}
4536ef2fbe16SNamhyung Kim 
453733dc9b12SSteven Rostedt 		if (!iter->hash) {
453833dc9b12SSteven Rostedt 			trace_parser_put(&iter->parser);
45393f2367baSMasami Hiramatsu 			goto out_unlock;
454033dc9b12SSteven Rostedt 		}
4541c20489daSSteven Rostedt (VMware) 	} else
4542c20489daSSteven Rostedt (VMware) 		iter->hash = hash;
45431cf41dd7SSteven Rostedt 
45449ef16693SSteven Rostedt (VMware) 	ret = 0;
45459ef16693SSteven Rostedt (VMware) 
45465072c59fSSteven Rostedt 	if (file->f_mode & FMODE_READ) {
45475072c59fSSteven Rostedt 		iter->pg = ftrace_pages_start;
45485072c59fSSteven Rostedt 
45495072c59fSSteven Rostedt 		ret = seq_open(file, &show_ftrace_seq_ops);
45505072c59fSSteven Rostedt 		if (!ret) {
45515072c59fSSteven Rostedt 			struct seq_file *m = file->private_data;
45525072c59fSSteven Rostedt 			m->private = iter;
455379fe249cSLi Zefan 		} else {
455433dc9b12SSteven Rostedt 			/* Failed */
455533dc9b12SSteven Rostedt 			free_ftrace_hash(iter->hash);
455679fe249cSLi Zefan 			trace_parser_put(&iter->parser);
455779fe249cSLi Zefan 		}
45585072c59fSSteven Rostedt 	} else
45595072c59fSSteven Rostedt 		file->private_data = iter;
45603f2367baSMasami Hiramatsu 
45613f2367baSMasami Hiramatsu  out_unlock:
456233b7f99cSSteven Rostedt (Red Hat) 	mutex_unlock(&ops->func_hash->regex_lock);
45635072c59fSSteven Rostedt 
45649ef16693SSteven Rostedt (VMware)  out:
45659ef16693SSteven Rostedt (VMware) 	if (ret) {
45669ef16693SSteven Rostedt (VMware) 		kfree(iter);
45679ef16693SSteven Rostedt (VMware) 		if (tr)
45689ef16693SSteven Rostedt (VMware) 			trace_array_put(tr);
45699ef16693SSteven Rostedt (VMware) 	}
45709ef16693SSteven Rostedt (VMware) 
45715072c59fSSteven Rostedt 	return ret;
45725072c59fSSteven Rostedt }
45735072c59fSSteven Rostedt 
457441c52c0dSSteven Rostedt static int
457541c52c0dSSteven Rostedt ftrace_filter_open(struct inode *inode, struct file *file)
457641c52c0dSSteven Rostedt {
4577e3b3e2e8SSteven Rostedt (Red Hat) 	struct ftrace_ops *ops = inode->i_private;
4578e3b3e2e8SSteven Rostedt (Red Hat) 
457917911ff3SSteven Rostedt (VMware) 	/* Checks for tracefs lockdown */
4580e3b3e2e8SSteven Rostedt (Red Hat) 	return ftrace_regex_open(ops,
4581eee8ded1SSteven Rostedt (VMware) 			FTRACE_ITER_FILTER | FTRACE_ITER_DO_PROBES,
45821cf41dd7SSteven Rostedt 			inode, file);
458341c52c0dSSteven Rostedt }
458441c52c0dSSteven Rostedt 
458541c52c0dSSteven Rostedt static int
458641c52c0dSSteven Rostedt ftrace_notrace_open(struct inode *inode, struct file *file)
458741c52c0dSSteven Rostedt {
4588e3b3e2e8SSteven Rostedt (Red Hat) 	struct ftrace_ops *ops = inode->i_private;
4589e3b3e2e8SSteven Rostedt (Red Hat) 
459017911ff3SSteven Rostedt (VMware) 	/* Checks for tracefs lockdown */
4591e3b3e2e8SSteven Rostedt (Red Hat) 	return ftrace_regex_open(ops, FTRACE_ITER_NOTRACE,
45921cf41dd7SSteven Rostedt 				 inode, file);
459341c52c0dSSteven Rostedt }
459441c52c0dSSteven Rostedt 
45953ba00929SDmitry Safonov /* Type for quick search ftrace basic regexes (globs) from filter_parse_regex */
45963ba00929SDmitry Safonov struct ftrace_glob {
45973ba00929SDmitry Safonov 	char *search;
45983ba00929SDmitry Safonov 	unsigned len;
45993ba00929SDmitry Safonov 	int type;
46003ba00929SDmitry Safonov };
46013ba00929SDmitry Safonov 
46027132e2d6SThiago Jung Bauermann /*
46037132e2d6SThiago Jung Bauermann  * If symbols in an architecture don't correspond exactly to the user-visible
46047132e2d6SThiago Jung Bauermann  * name of what they represent, it is possible to define this function to
46057132e2d6SThiago Jung Bauermann  * perform the necessary adjustments.
46067132e2d6SThiago Jung Bauermann */
46077132e2d6SThiago Jung Bauermann char * __weak arch_ftrace_match_adjust(char *str, const char *search)
46087132e2d6SThiago Jung Bauermann {
46097132e2d6SThiago Jung Bauermann 	return str;
46107132e2d6SThiago Jung Bauermann }
46117132e2d6SThiago Jung Bauermann 
46123ba00929SDmitry Safonov static int ftrace_match(char *str, struct ftrace_glob *g)
46139f4801e3SSteven Rostedt {
46149f4801e3SSteven Rostedt 	int matched = 0;
4615751e9983SLi Zefan 	int slen;
46169f4801e3SSteven Rostedt 
46177132e2d6SThiago Jung Bauermann 	str = arch_ftrace_match_adjust(str, g->search);
46187132e2d6SThiago Jung Bauermann 
46193ba00929SDmitry Safonov 	switch (g->type) {
46209f4801e3SSteven Rostedt 	case MATCH_FULL:
46213ba00929SDmitry Safonov 		if (strcmp(str, g->search) == 0)
46229f4801e3SSteven Rostedt 			matched = 1;
46239f4801e3SSteven Rostedt 		break;
46249f4801e3SSteven Rostedt 	case MATCH_FRONT_ONLY:
46253ba00929SDmitry Safonov 		if (strncmp(str, g->search, g->len) == 0)
46269f4801e3SSteven Rostedt 			matched = 1;
46279f4801e3SSteven Rostedt 		break;
46289f4801e3SSteven Rostedt 	case MATCH_MIDDLE_ONLY:
46293ba00929SDmitry Safonov 		if (strstr(str, g->search))
46309f4801e3SSteven Rostedt 			matched = 1;
46319f4801e3SSteven Rostedt 		break;
46329f4801e3SSteven Rostedt 	case MATCH_END_ONLY:
4633751e9983SLi Zefan 		slen = strlen(str);
46343ba00929SDmitry Safonov 		if (slen >= g->len &&
46353ba00929SDmitry Safonov 		    memcmp(str + slen - g->len, g->search, g->len) == 0)
46369f4801e3SSteven Rostedt 			matched = 1;
46379f4801e3SSteven Rostedt 		break;
463860f1d5e3SMasami Hiramatsu 	case MATCH_GLOB:
463960f1d5e3SMasami Hiramatsu 		if (glob_match(g->search, str))
464060f1d5e3SMasami Hiramatsu 			matched = 1;
464160f1d5e3SMasami Hiramatsu 		break;
46429f4801e3SSteven Rostedt 	}
46439f4801e3SSteven Rostedt 
46449f4801e3SSteven Rostedt 	return matched;
46459f4801e3SSteven Rostedt }
46469f4801e3SSteven Rostedt 
4647b448c4e3SSteven Rostedt static int
4648f0a3b154SDmitry Safonov enter_record(struct ftrace_hash *hash, struct dyn_ftrace *rec, int clear_filter)
464964e7c440SSteven Rostedt {
4650b448c4e3SSteven Rostedt 	struct ftrace_func_entry *entry;
4651b448c4e3SSteven Rostedt 	int ret = 0;
4652b448c4e3SSteven Rostedt 
46531cf41dd7SSteven Rostedt 	entry = ftrace_lookup_ip(hash, rec->ip);
4654f0a3b154SDmitry Safonov 	if (clear_filter) {
4655b448c4e3SSteven Rostedt 		/* Do nothing if it doesn't exist */
4656b448c4e3SSteven Rostedt 		if (!entry)
4657b448c4e3SSteven Rostedt 			return 0;
4658b448c4e3SSteven Rostedt 
465933dc9b12SSteven Rostedt 		free_hash_entry(hash, entry);
4660b448c4e3SSteven Rostedt 	} else {
4661b448c4e3SSteven Rostedt 		/* Do nothing if it exists */
4662b448c4e3SSteven Rostedt 		if (entry)
4663b448c4e3SSteven Rostedt 			return 0;
4664d05cb470SSteven Rostedt (Google) 		if (add_hash_entry(hash, rec->ip) == NULL)
4665d05cb470SSteven Rostedt (Google) 			ret = -ENOMEM;
4666b448c4e3SSteven Rostedt 	}
4667b448c4e3SSteven Rostedt 	return ret;
4668996e87beSSteven Rostedt }
4669996e87beSSteven Rostedt 
467064e7c440SSteven Rostedt static int
4671f79b3f33SSteven Rostedt (VMware) add_rec_by_index(struct ftrace_hash *hash, struct ftrace_glob *func_g,
4672f79b3f33SSteven Rostedt (VMware) 		 int clear_filter)
4673f79b3f33SSteven Rostedt (VMware) {
4674c5963a09SYuran Pereira 	long index;
4675f79b3f33SSteven Rostedt (VMware) 	struct ftrace_page *pg;
4676f79b3f33SSteven Rostedt (VMware) 	struct dyn_ftrace *rec;
4677f79b3f33SSteven Rostedt (VMware) 
4678f79b3f33SSteven Rostedt (VMware) 	/* The index starts at 1 */
4679c5963a09SYuran Pereira 	if (kstrtoul(func_g->search, 0, &index) || --index < 0)
4680f79b3f33SSteven Rostedt (VMware) 		return 0;
4681f79b3f33SSteven Rostedt (VMware) 
4682f79b3f33SSteven Rostedt (VMware) 	do_for_each_ftrace_rec(pg, rec) {
4683f79b3f33SSteven Rostedt (VMware) 		if (pg->index <= index) {
4684f79b3f33SSteven Rostedt (VMware) 			index -= pg->index;
4685f79b3f33SSteven Rostedt (VMware) 			/* this is a double loop, break goes to the next page */
4686f79b3f33SSteven Rostedt (VMware) 			break;
4687f79b3f33SSteven Rostedt (VMware) 		}
4688f79b3f33SSteven Rostedt (VMware) 		rec = &pg->records[index];
4689f79b3f33SSteven Rostedt (VMware) 		enter_record(hash, rec, clear_filter);
4690f79b3f33SSteven Rostedt (VMware) 		return 1;
4691f79b3f33SSteven Rostedt (VMware) 	} while_for_each_ftrace_rec();
4692f79b3f33SSteven Rostedt (VMware) 	return 0;
4693f79b3f33SSteven Rostedt (VMware) }
4694f79b3f33SSteven Rostedt (VMware) 
4695b39181f7SSteven Rostedt (Google) #ifdef FTRACE_MCOUNT_MAX_OFFSET
4696b39181f7SSteven Rostedt (Google) static int lookup_ip(unsigned long ip, char **modname, char *str)
4697b39181f7SSteven Rostedt (Google) {
4698b39181f7SSteven Rostedt (Google) 	unsigned long offset;
4699b39181f7SSteven Rostedt (Google) 
4700b39181f7SSteven Rostedt (Google) 	kallsyms_lookup(ip, NULL, &offset, modname, str);
4701b39181f7SSteven Rostedt (Google) 	if (offset > FTRACE_MCOUNT_MAX_OFFSET)
4702b39181f7SSteven Rostedt (Google) 		return -1;
4703b39181f7SSteven Rostedt (Google) 	return 0;
4704b39181f7SSteven Rostedt (Google) }
4705b39181f7SSteven Rostedt (Google) #else
4706b39181f7SSteven Rostedt (Google) static int lookup_ip(unsigned long ip, char **modname, char *str)
4707b39181f7SSteven Rostedt (Google) {
4708b39181f7SSteven Rostedt (Google) 	kallsyms_lookup(ip, NULL, NULL, modname, str);
4709b39181f7SSteven Rostedt (Google) 	return 0;
4710b39181f7SSteven Rostedt (Google) }
4711b39181f7SSteven Rostedt (Google) #endif
4712b39181f7SSteven Rostedt (Google) 
4713f79b3f33SSteven Rostedt (VMware) static int
47140b507e1eSDmitry Safonov ftrace_match_record(struct dyn_ftrace *rec, struct ftrace_glob *func_g,
47150b507e1eSDmitry Safonov 		struct ftrace_glob *mod_g, int exclude_mod)
471664e7c440SSteven Rostedt {
471764e7c440SSteven Rostedt 	char str[KSYM_SYMBOL_LEN];
4718b9df92d2SSteven Rostedt 	char *modname;
471964e7c440SSteven Rostedt 
4720b39181f7SSteven Rostedt (Google) 	if (lookup_ip(rec->ip, &modname, str)) {
4721b39181f7SSteven Rostedt (Google) 		/* This should only happen when a rec is disabled */
4722b39181f7SSteven Rostedt (Google) 		WARN_ON_ONCE(system_state == SYSTEM_RUNNING &&
4723b39181f7SSteven Rostedt (Google) 			     !(rec->flags & FTRACE_FL_DISABLED));
4724b39181f7SSteven Rostedt (Google) 		return 0;
4725b39181f7SSteven Rostedt (Google) 	}
4726b9df92d2SSteven Rostedt 
47270b507e1eSDmitry Safonov 	if (mod_g) {
47280b507e1eSDmitry Safonov 		int mod_matches = (modname) ? ftrace_match(modname, mod_g) : 0;
47290b507e1eSDmitry Safonov 
47300b507e1eSDmitry Safonov 		/* blank module name to match all modules */
47310b507e1eSDmitry Safonov 		if (!mod_g->len) {
47320b507e1eSDmitry Safonov 			/* blank module globbing: modname xor exclude_mod */
473377c0eddeSSteven Rostedt (VMware) 			if (!exclude_mod != !modname)
47340b507e1eSDmitry Safonov 				goto func_match;
47350b507e1eSDmitry Safonov 			return 0;
47360b507e1eSDmitry Safonov 		}
47370b507e1eSDmitry Safonov 
473877c0eddeSSteven Rostedt (VMware) 		/*
473977c0eddeSSteven Rostedt (VMware) 		 * exclude_mod is set to trace everything but the given
474077c0eddeSSteven Rostedt (VMware) 		 * module. If it is set and the module matches, then
474177c0eddeSSteven Rostedt (VMware) 		 * return 0. If it is not set, and the module doesn't match
474277c0eddeSSteven Rostedt (VMware) 		 * also return 0. Otherwise, check the function to see if
474377c0eddeSSteven Rostedt (VMware) 		 * that matches.
474477c0eddeSSteven Rostedt (VMware) 		 */
474577c0eddeSSteven Rostedt (VMware) 		if (!mod_matches == !exclude_mod)
47460b507e1eSDmitry Safonov 			return 0;
47470b507e1eSDmitry Safonov func_match:
4748b9df92d2SSteven Rostedt 		/* blank search means to match all funcs in the mod */
47493ba00929SDmitry Safonov 		if (!func_g->len)
4750b9df92d2SSteven Rostedt 			return 1;
4751b9df92d2SSteven Rostedt 	}
4752b9df92d2SSteven Rostedt 
47533ba00929SDmitry Safonov 	return ftrace_match(str, func_g);
475464e7c440SSteven Rostedt }
475564e7c440SSteven Rostedt 
47561cf41dd7SSteven Rostedt static int
47573ba00929SDmitry Safonov match_records(struct ftrace_hash *hash, char *func, int len, char *mod)
47589f4801e3SSteven Rostedt {
47599f4801e3SSteven Rostedt 	struct ftrace_page *pg;
47609f4801e3SSteven Rostedt 	struct dyn_ftrace *rec;
47613ba00929SDmitry Safonov 	struct ftrace_glob func_g = { .type = MATCH_FULL };
47620b507e1eSDmitry Safonov 	struct ftrace_glob mod_g = { .type = MATCH_FULL };
47630b507e1eSDmitry Safonov 	struct ftrace_glob *mod_match = (mod) ? &mod_g : NULL;
47640b507e1eSDmitry Safonov 	int exclude_mod = 0;
4765311d16daSLi Zefan 	int found = 0;
4766b448c4e3SSteven Rostedt 	int ret;
47672e028c4fSDan Carpenter 	int clear_filter = 0;
47689f4801e3SSteven Rostedt 
47690b507e1eSDmitry Safonov 	if (func) {
47703ba00929SDmitry Safonov 		func_g.type = filter_parse_regex(func, len, &func_g.search,
47713ba00929SDmitry Safonov 						 &clear_filter);
47723ba00929SDmitry Safonov 		func_g.len = strlen(func_g.search);
4773b9df92d2SSteven Rostedt 	}
4774b9df92d2SSteven Rostedt 
47750b507e1eSDmitry Safonov 	if (mod) {
47760b507e1eSDmitry Safonov 		mod_g.type = filter_parse_regex(mod, strlen(mod),
47770b507e1eSDmitry Safonov 				&mod_g.search, &exclude_mod);
47780b507e1eSDmitry Safonov 		mod_g.len = strlen(mod_g.search);
4779b9df92d2SSteven Rostedt 	}
4780b9df92d2SSteven Rostedt 
478152baf119SSteven Rostedt 	mutex_lock(&ftrace_lock);
4782b9df92d2SSteven Rostedt 
4783b9df92d2SSteven Rostedt 	if (unlikely(ftrace_disabled))
4784b9df92d2SSteven Rostedt 		goto out_unlock;
4785b9df92d2SSteven Rostedt 
4786f79b3f33SSteven Rostedt (VMware) 	if (func_g.type == MATCH_INDEX) {
4787f79b3f33SSteven Rostedt (VMware) 		found = add_rec_by_index(hash, &func_g, clear_filter);
4788f79b3f33SSteven Rostedt (VMware) 		goto out_unlock;
4789f79b3f33SSteven Rostedt (VMware) 	}
4790f79b3f33SSteven Rostedt (VMware) 
4791265c831cSSteven Rostedt 	do_for_each_ftrace_rec(pg, rec) {
4792546fece4SSteven Rostedt (Red Hat) 
4793546fece4SSteven Rostedt (Red Hat) 		if (rec->flags & FTRACE_FL_DISABLED)
4794546fece4SSteven Rostedt (Red Hat) 			continue;
4795546fece4SSteven Rostedt (Red Hat) 
47960b507e1eSDmitry Safonov 		if (ftrace_match_record(rec, &func_g, mod_match, exclude_mod)) {
4797f0a3b154SDmitry Safonov 			ret = enter_record(hash, rec, clear_filter);
4798b448c4e3SSteven Rostedt 			if (ret < 0) {
4799b448c4e3SSteven Rostedt 				found = ret;
4800b448c4e3SSteven Rostedt 				goto out_unlock;
4801b448c4e3SSteven Rostedt 			}
4802311d16daSLi Zefan 			found = 1;
48035072c59fSSteven Rostedt 		}
4804d0b24b4eSGuilherme G. Piccoli 		cond_resched();
4805265c831cSSteven Rostedt 	} while_for_each_ftrace_rec();
4806b9df92d2SSteven Rostedt  out_unlock:
480752baf119SSteven Rostedt 	mutex_unlock(&ftrace_lock);
4808311d16daSLi Zefan 
4809311d16daSLi Zefan 	return found;
48105072c59fSSteven Rostedt }
48115072c59fSSteven Rostedt 
481264e7c440SSteven Rostedt static int
48131cf41dd7SSteven Rostedt ftrace_match_records(struct ftrace_hash *hash, char *buff, int len)
481464e7c440SSteven Rostedt {
4815f0a3b154SDmitry Safonov 	return match_records(hash, buff, len, NULL);
481664e7c440SSteven Rostedt }
481764e7c440SSteven Rostedt 
4818e16b35ddSSteven Rostedt (VMware) static void ftrace_ops_update_code(struct ftrace_ops *ops,
4819e16b35ddSSteven Rostedt (VMware) 				   struct ftrace_ops_hash *old_hash)
4820e16b35ddSSteven Rostedt (VMware) {
4821e16b35ddSSteven Rostedt (VMware) 	struct ftrace_ops *op;
4822e16b35ddSSteven Rostedt (VMware) 
4823e16b35ddSSteven Rostedt (VMware) 	if (!ftrace_enabled)
4824e16b35ddSSteven Rostedt (VMware) 		return;
4825e16b35ddSSteven Rostedt (VMware) 
4826e16b35ddSSteven Rostedt (VMware) 	if (ops->flags & FTRACE_OPS_FL_ENABLED) {
4827e16b35ddSSteven Rostedt (VMware) 		ftrace_run_modify_code(ops, FTRACE_UPDATE_CALLS, old_hash);
4828e16b35ddSSteven Rostedt (VMware) 		return;
4829e16b35ddSSteven Rostedt (VMware) 	}
4830e16b35ddSSteven Rostedt (VMware) 
4831e16b35ddSSteven Rostedt (VMware) 	/*
4832e16b35ddSSteven Rostedt (VMware) 	 * If this is the shared global_ops filter, then we need to
4833e16b35ddSSteven Rostedt (VMware) 	 * check if there is another ops that shares it, is enabled.
4834e16b35ddSSteven Rostedt (VMware) 	 * If so, we still need to run the modify code.
4835e16b35ddSSteven Rostedt (VMware) 	 */
4836e16b35ddSSteven Rostedt (VMware) 	if (ops->func_hash != &global_ops.local_hash)
4837e16b35ddSSteven Rostedt (VMware) 		return;
4838e16b35ddSSteven Rostedt (VMware) 
4839e16b35ddSSteven Rostedt (VMware) 	do_for_each_ftrace_op(op, ftrace_ops_list) {
4840e16b35ddSSteven Rostedt (VMware) 		if (op->func_hash == &global_ops.local_hash &&
4841e16b35ddSSteven Rostedt (VMware) 		    op->flags & FTRACE_OPS_FL_ENABLED) {
4842e16b35ddSSteven Rostedt (VMware) 			ftrace_run_modify_code(op, FTRACE_UPDATE_CALLS, old_hash);
4843e16b35ddSSteven Rostedt (VMware) 			/* Only need to do this once */
4844e16b35ddSSteven Rostedt (VMware) 			return;
4845e16b35ddSSteven Rostedt (VMware) 		}
4846e16b35ddSSteven Rostedt (VMware) 	} while_for_each_ftrace_op(op);
4847e16b35ddSSteven Rostedt (VMware) }
4848e16b35ddSSteven Rostedt (VMware) 
4849e16b35ddSSteven Rostedt (VMware) static int ftrace_hash_move_and_update_ops(struct ftrace_ops *ops,
4850e16b35ddSSteven Rostedt (VMware) 					   struct ftrace_hash **orig_hash,
4851e16b35ddSSteven Rostedt (VMware) 					   struct ftrace_hash *hash,
4852e16b35ddSSteven Rostedt (VMware) 					   int enable)
4853e16b35ddSSteven Rostedt (VMware) {
4854d9bbfbd1SSteven Rostedt (Google) 	if (ops->flags & FTRACE_OPS_FL_SUBOP)
4855d9bbfbd1SSteven Rostedt (Google) 		return ftrace_hash_move_and_update_subops(ops, orig_hash, hash, enable);
4856e16b35ddSSteven Rostedt (VMware) 
4857d9bbfbd1SSteven Rostedt (Google) 	/*
4858d9bbfbd1SSteven Rostedt (Google) 	 * If this ops is not enabled, it could be sharing its filters
4859d9bbfbd1SSteven Rostedt (Google) 	 * with a subop. If that's the case, update the subop instead of
4860d9bbfbd1SSteven Rostedt (Google) 	 * this ops. Shared filters are only allowed to have one ops set
4861d9bbfbd1SSteven Rostedt (Google) 	 * at a time, and if we update the ops that is not enabled,
4862d9bbfbd1SSteven Rostedt (Google) 	 * it will not affect subops that share it.
4863d9bbfbd1SSteven Rostedt (Google) 	 */
4864d9bbfbd1SSteven Rostedt (Google) 	if (!(ops->flags & FTRACE_OPS_FL_ENABLED)) {
4865d9bbfbd1SSteven Rostedt (Google) 		struct ftrace_ops *op;
4866d9bbfbd1SSteven Rostedt (Google) 
4867d9bbfbd1SSteven Rostedt (Google) 		/* Check if any other manager subops maps to this hash */
4868d9bbfbd1SSteven Rostedt (Google) 		do_for_each_ftrace_op(op, ftrace_ops_list) {
4869d9bbfbd1SSteven Rostedt (Google) 			struct ftrace_ops *subops;
4870d9bbfbd1SSteven Rostedt (Google) 
4871d9bbfbd1SSteven Rostedt (Google) 			list_for_each_entry(subops, &op->subop_list, list) {
4872d9bbfbd1SSteven Rostedt (Google) 				if ((subops->flags & FTRACE_OPS_FL_ENABLED) &&
4873d9bbfbd1SSteven Rostedt (Google) 				     subops->func_hash == ops->func_hash) {
4874d9bbfbd1SSteven Rostedt (Google) 					return ftrace_hash_move_and_update_subops(subops, orig_hash, hash, enable);
4875e16b35ddSSteven Rostedt (VMware) 				}
4876d9bbfbd1SSteven Rostedt (Google) 			}
4877d9bbfbd1SSteven Rostedt (Google) 		} while_for_each_ftrace_op(op);
4878d9bbfbd1SSteven Rostedt (Google) 	}
4879d9bbfbd1SSteven Rostedt (Google) 
4880d9bbfbd1SSteven Rostedt (Google) 	return __ftrace_hash_move_and_update_ops(ops, orig_hash, hash, enable);
4881e16b35ddSSteven Rostedt (VMware) }
488264e7c440SSteven Rostedt 
4883673feb9dSSteven Rostedt (VMware) static bool module_exists(const char *module)
4884673feb9dSSteven Rostedt (VMware) {
4885673feb9dSSteven Rostedt (VMware) 	/* All modules have the symbol __this_module */
48860f5e5a3aSRasmus Villemoes 	static const char this_mod[] = "__this_module";
4887419e9fe5SSalvatore Mesoraca 	char modname[MAX_PARAM_PREFIX_LEN + sizeof(this_mod) + 2];
4888673feb9dSSteven Rostedt (VMware) 	unsigned long val;
4889673feb9dSSteven Rostedt (VMware) 	int n;
4890673feb9dSSteven Rostedt (VMware) 
4891419e9fe5SSalvatore Mesoraca 	n = snprintf(modname, sizeof(modname), "%s:%s", module, this_mod);
4892673feb9dSSteven Rostedt (VMware) 
4893419e9fe5SSalvatore Mesoraca 	if (n > sizeof(modname) - 1)
4894673feb9dSSteven Rostedt (VMware) 		return false;
4895673feb9dSSteven Rostedt (VMware) 
4896673feb9dSSteven Rostedt (VMware) 	val = module_kallsyms_lookup_name(modname);
4897673feb9dSSteven Rostedt (VMware) 	return val != 0;
4898673feb9dSSteven Rostedt (VMware) }
4899673feb9dSSteven Rostedt (VMware) 
4900673feb9dSSteven Rostedt (VMware) static int cache_mod(struct trace_array *tr,
4901673feb9dSSteven Rostedt (VMware) 		     const char *func, char *module, int enable)
4902673feb9dSSteven Rostedt (VMware) {
4903673feb9dSSteven Rostedt (VMware) 	struct ftrace_mod_load *ftrace_mod, *n;
4904673feb9dSSteven Rostedt (VMware) 	struct list_head *head = enable ? &tr->mod_trace : &tr->mod_notrace;
4905673feb9dSSteven Rostedt (VMware) 	int ret;
4906673feb9dSSteven Rostedt (VMware) 
4907673feb9dSSteven Rostedt (VMware) 	mutex_lock(&ftrace_lock);
4908673feb9dSSteven Rostedt (VMware) 
4909673feb9dSSteven Rostedt (VMware) 	/* We do not cache inverse filters */
4910673feb9dSSteven Rostedt (VMware) 	if (func[0] == '!') {
4911673feb9dSSteven Rostedt (VMware) 		func++;
4912673feb9dSSteven Rostedt (VMware) 		ret = -EINVAL;
4913673feb9dSSteven Rostedt (VMware) 
4914673feb9dSSteven Rostedt (VMware) 		/* Look to remove this hash */
4915673feb9dSSteven Rostedt (VMware) 		list_for_each_entry_safe(ftrace_mod, n, head, list) {
4916673feb9dSSteven Rostedt (VMware) 			if (strcmp(ftrace_mod->module, module) != 0)
4917673feb9dSSteven Rostedt (VMware) 				continue;
4918673feb9dSSteven Rostedt (VMware) 
4919673feb9dSSteven Rostedt (VMware) 			/* no func matches all */
492044925dffSDan Carpenter 			if (strcmp(func, "*") == 0 ||
4921673feb9dSSteven Rostedt (VMware) 			    (ftrace_mod->func &&
4922673feb9dSSteven Rostedt (VMware) 			     strcmp(ftrace_mod->func, func) == 0)) {
4923673feb9dSSteven Rostedt (VMware) 				ret = 0;
4924673feb9dSSteven Rostedt (VMware) 				free_ftrace_mod(ftrace_mod);
4925673feb9dSSteven Rostedt (VMware) 				continue;
4926673feb9dSSteven Rostedt (VMware) 			}
4927673feb9dSSteven Rostedt (VMware) 		}
4928673feb9dSSteven Rostedt (VMware) 		goto out;
4929673feb9dSSteven Rostedt (VMware) 	}
4930673feb9dSSteven Rostedt (VMware) 
4931673feb9dSSteven Rostedt (VMware) 	ret = -EINVAL;
4932673feb9dSSteven Rostedt (VMware) 	/* We only care about modules that have not been loaded yet */
4933673feb9dSSteven Rostedt (VMware) 	if (module_exists(module))
4934673feb9dSSteven Rostedt (VMware) 		goto out;
4935673feb9dSSteven Rostedt (VMware) 
4936673feb9dSSteven Rostedt (VMware) 	/* Save this string off, and execute it when the module is loaded */
4937673feb9dSSteven Rostedt (VMware) 	ret = ftrace_add_mod(tr, func, module, enable);
4938673feb9dSSteven Rostedt (VMware)  out:
4939673feb9dSSteven Rostedt (VMware) 	mutex_unlock(&ftrace_lock);
4940673feb9dSSteven Rostedt (VMware) 
4941673feb9dSSteven Rostedt (VMware) 	return ret;
4942673feb9dSSteven Rostedt (VMware) }
4943673feb9dSSteven Rostedt (VMware) 
4944d7fbf8dfSSteven Rostedt (VMware) static int
4945d7fbf8dfSSteven Rostedt (VMware) ftrace_set_regex(struct ftrace_ops *ops, unsigned char *buf, int len,
4946d7fbf8dfSSteven Rostedt (VMware) 		 int reset, int enable);
4947d7fbf8dfSSteven Rostedt (VMware) 
494869449bbdSArnd Bergmann #ifdef CONFIG_MODULES
4949d7fbf8dfSSteven Rostedt (VMware) static void process_mod_list(struct list_head *head, struct ftrace_ops *ops,
4950d7fbf8dfSSteven Rostedt (VMware) 			     char *mod, bool enable)
4951d7fbf8dfSSteven Rostedt (VMware) {
4952d7fbf8dfSSteven Rostedt (VMware) 	struct ftrace_mod_load *ftrace_mod, *n;
4953d7fbf8dfSSteven Rostedt (VMware) 	struct ftrace_hash **orig_hash, *new_hash;
4954d7fbf8dfSSteven Rostedt (VMware) 	LIST_HEAD(process_mods);
4955d7fbf8dfSSteven Rostedt (VMware) 	char *func;
4956d7fbf8dfSSteven Rostedt (VMware) 
4957d7fbf8dfSSteven Rostedt (VMware) 	mutex_lock(&ops->func_hash->regex_lock);
4958d7fbf8dfSSteven Rostedt (VMware) 
4959d7fbf8dfSSteven Rostedt (VMware) 	if (enable)
4960d7fbf8dfSSteven Rostedt (VMware) 		orig_hash = &ops->func_hash->filter_hash;
4961d7fbf8dfSSteven Rostedt (VMware) 	else
4962d7fbf8dfSSteven Rostedt (VMware) 		orig_hash = &ops->func_hash->notrace_hash;
4963d7fbf8dfSSteven Rostedt (VMware) 
4964d7fbf8dfSSteven Rostedt (VMware) 	new_hash = alloc_and_copy_ftrace_hash(FTRACE_HASH_DEFAULT_BITS,
4965d7fbf8dfSSteven Rostedt (VMware) 					      *orig_hash);
4966d7fbf8dfSSteven Rostedt (VMware) 	if (!new_hash)
49673b58a3c7SSteven Rostedt (VMware) 		goto out; /* warn? */
4968d7fbf8dfSSteven Rostedt (VMware) 
4969d7fbf8dfSSteven Rostedt (VMware) 	mutex_lock(&ftrace_lock);
4970d7fbf8dfSSteven Rostedt (VMware) 
4971d7fbf8dfSSteven Rostedt (VMware) 	list_for_each_entry_safe(ftrace_mod, n, head, list) {
4972d7fbf8dfSSteven Rostedt (VMware) 
4973d7fbf8dfSSteven Rostedt (VMware) 		if (strcmp(ftrace_mod->module, mod) != 0)
4974d7fbf8dfSSteven Rostedt (VMware) 			continue;
4975d7fbf8dfSSteven Rostedt (VMware) 
4976d7fbf8dfSSteven Rostedt (VMware) 		if (ftrace_mod->func)
4977d7fbf8dfSSteven Rostedt (VMware) 			func = kstrdup(ftrace_mod->func, GFP_KERNEL);
4978d7fbf8dfSSteven Rostedt (VMware) 		else
4979d7fbf8dfSSteven Rostedt (VMware) 			func = kstrdup("*", GFP_KERNEL);
4980d7fbf8dfSSteven Rostedt (VMware) 
4981d7fbf8dfSSteven Rostedt (VMware) 		if (!func) /* warn? */
4982d7fbf8dfSSteven Rostedt (VMware) 			continue;
4983d7fbf8dfSSteven Rostedt (VMware) 
49843ecda644SBaokun Li 		list_move(&ftrace_mod->list, &process_mods);
4985d7fbf8dfSSteven Rostedt (VMware) 
4986d7fbf8dfSSteven Rostedt (VMware) 		/* Use the newly allocated func, as it may be "*" */
4987d7fbf8dfSSteven Rostedt (VMware) 		kfree(ftrace_mod->func);
4988d7fbf8dfSSteven Rostedt (VMware) 		ftrace_mod->func = func;
4989d7fbf8dfSSteven Rostedt (VMware) 	}
4990d7fbf8dfSSteven Rostedt (VMware) 
4991d7fbf8dfSSteven Rostedt (VMware) 	mutex_unlock(&ftrace_lock);
4992d7fbf8dfSSteven Rostedt (VMware) 
4993d7fbf8dfSSteven Rostedt (VMware) 	list_for_each_entry_safe(ftrace_mod, n, &process_mods, list) {
4994d7fbf8dfSSteven Rostedt (VMware) 
4995d7fbf8dfSSteven Rostedt (VMware) 		func = ftrace_mod->func;
4996d7fbf8dfSSteven Rostedt (VMware) 
4997d7fbf8dfSSteven Rostedt (VMware) 		/* Grabs ftrace_lock, which is why we have this extra step */
4998d7fbf8dfSSteven Rostedt (VMware) 		match_records(new_hash, func, strlen(func), mod);
4999d7fbf8dfSSteven Rostedt (VMware) 		free_ftrace_mod(ftrace_mod);
5000d7fbf8dfSSteven Rostedt (VMware) 	}
5001d7fbf8dfSSteven Rostedt (VMware) 
50028c08f0d5SSteven Rostedt (VMware) 	if (enable && list_empty(head))
50038c08f0d5SSteven Rostedt (VMware) 		new_hash->flags &= ~FTRACE_HASH_FL_MOD;
50048c08f0d5SSteven Rostedt (VMware) 
5005d7fbf8dfSSteven Rostedt (VMware) 	mutex_lock(&ftrace_lock);
5006d7fbf8dfSSteven Rostedt (VMware) 
5007045e269cSAlex Shi 	ftrace_hash_move_and_update_ops(ops, orig_hash,
5008d7fbf8dfSSteven Rostedt (VMware) 					      new_hash, enable);
5009d7fbf8dfSSteven Rostedt (VMware) 	mutex_unlock(&ftrace_lock);
5010d7fbf8dfSSteven Rostedt (VMware) 
50113b58a3c7SSteven Rostedt (VMware)  out:
5012d7fbf8dfSSteven Rostedt (VMware) 	mutex_unlock(&ops->func_hash->regex_lock);
5013d7fbf8dfSSteven Rostedt (VMware) 
5014d7fbf8dfSSteven Rostedt (VMware) 	free_ftrace_hash(new_hash);
5015d7fbf8dfSSteven Rostedt (VMware) }
5016d7fbf8dfSSteven Rostedt (VMware) 
5017d7fbf8dfSSteven Rostedt (VMware) static void process_cached_mods(const char *mod_name)
5018d7fbf8dfSSteven Rostedt (VMware) {
5019d7fbf8dfSSteven Rostedt (VMware) 	struct trace_array *tr;
5020d7fbf8dfSSteven Rostedt (VMware) 	char *mod;
5021d7fbf8dfSSteven Rostedt (VMware) 
5022d7fbf8dfSSteven Rostedt (VMware) 	mod = kstrdup(mod_name, GFP_KERNEL);
5023d7fbf8dfSSteven Rostedt (VMware) 	if (!mod)
5024d7fbf8dfSSteven Rostedt (VMware) 		return;
5025d7fbf8dfSSteven Rostedt (VMware) 
5026d7fbf8dfSSteven Rostedt (VMware) 	mutex_lock(&trace_types_lock);
5027d7fbf8dfSSteven Rostedt (VMware) 	list_for_each_entry(tr, &ftrace_trace_arrays, list) {
5028d7fbf8dfSSteven Rostedt (VMware) 		if (!list_empty(&tr->mod_trace))
5029d7fbf8dfSSteven Rostedt (VMware) 			process_mod_list(&tr->mod_trace, tr->ops, mod, true);
5030d7fbf8dfSSteven Rostedt (VMware) 		if (!list_empty(&tr->mod_notrace))
5031d7fbf8dfSSteven Rostedt (VMware) 			process_mod_list(&tr->mod_notrace, tr->ops, mod, false);
5032d7fbf8dfSSteven Rostedt (VMware) 	}
5033d7fbf8dfSSteven Rostedt (VMware) 	mutex_unlock(&trace_types_lock);
5034d7fbf8dfSSteven Rostedt (VMware) 
5035d7fbf8dfSSteven Rostedt (VMware) 	kfree(mod);
5036d7fbf8dfSSteven Rostedt (VMware) }
503769449bbdSArnd Bergmann #endif
5038d7fbf8dfSSteven Rostedt (VMware) 
5039f6180773SSteven Rostedt /*
5040f6180773SSteven Rostedt  * We register the module command as a template to show others how
5041f6180773SSteven Rostedt  * to register the a command as well.
5042f6180773SSteven Rostedt  */
5043f6180773SSteven Rostedt 
5044f6180773SSteven Rostedt static int
504504ec7bb6SSteven Rostedt (VMware) ftrace_mod_callback(struct trace_array *tr, struct ftrace_hash *hash,
5046673feb9dSSteven Rostedt (VMware) 		    char *func_orig, char *cmd, char *module, int enable)
5047f6180773SSteven Rostedt {
5048673feb9dSSteven Rostedt (VMware) 	char *func;
50495e3949f0SDmitry Safonov 	int ret;
5050f6180773SSteven Rostedt 
5051673feb9dSSteven Rostedt (VMware) 	/* match_records() modifies func, and we need the original */
5052673feb9dSSteven Rostedt (VMware) 	func = kstrdup(func_orig, GFP_KERNEL);
5053673feb9dSSteven Rostedt (VMware) 	if (!func)
5054673feb9dSSteven Rostedt (VMware) 		return -ENOMEM;
5055673feb9dSSteven Rostedt (VMware) 
5056f6180773SSteven Rostedt 	/*
5057f6180773SSteven Rostedt 	 * cmd == 'mod' because we only registered this func
5058f6180773SSteven Rostedt 	 * for the 'mod' ftrace_func_command.
5059f6180773SSteven Rostedt 	 * But if you register one func with multiple commands,
5060f6180773SSteven Rostedt 	 * you can tell which command was used by the cmd
5061f6180773SSteven Rostedt 	 * parameter.
5062f6180773SSteven Rostedt 	 */
5063f0a3b154SDmitry Safonov 	ret = match_records(hash, func, strlen(func), module);
5064673feb9dSSteven Rostedt (VMware) 	kfree(func);
5065673feb9dSSteven Rostedt (VMware) 
5066b448c4e3SSteven Rostedt 	if (!ret)
5067673feb9dSSteven Rostedt (VMware) 		return cache_mod(tr, func_orig, module, enable);
5068b448c4e3SSteven Rostedt 	if (ret < 0)
5069b448c4e3SSteven Rostedt 		return ret;
5070f6180773SSteven Rostedt 	return 0;
5071f6180773SSteven Rostedt }
5072f6180773SSteven Rostedt 
5073f6180773SSteven Rostedt static struct ftrace_func_command ftrace_mod_cmd = {
5074f6180773SSteven Rostedt 	.name			= "mod",
5075f6180773SSteven Rostedt 	.func			= ftrace_mod_callback,
5076f6180773SSteven Rostedt };
5077f6180773SSteven Rostedt 
5078f6180773SSteven Rostedt static int __init ftrace_mod_cmd_init(void)
5079f6180773SSteven Rostedt {
5080f6180773SSteven Rostedt 	return register_ftrace_command(&ftrace_mod_cmd);
5081f6180773SSteven Rostedt }
50826f415672SSteven Rostedt core_initcall(ftrace_mod_cmd_init);
5083f6180773SSteven Rostedt 
50842f5f6ad9SSteven Rostedt static void function_trace_probe_call(unsigned long ip, unsigned long parent_ip,
5085d19ad077SSteven Rostedt (VMware) 				      struct ftrace_ops *op, struct ftrace_regs *fregs)
508659df055fSSteven Rostedt {
5087eee8ded1SSteven Rostedt (VMware) 	struct ftrace_probe_ops *probe_ops;
50887b60f3d8SSteven Rostedt (VMware) 	struct ftrace_func_probe *probe;
508959df055fSSteven Rostedt 
50907b60f3d8SSteven Rostedt (VMware) 	probe = container_of(op, struct ftrace_func_probe, ops);
50917b60f3d8SSteven Rostedt (VMware) 	probe_ops = probe->probe_ops;
509259df055fSSteven Rostedt 
509359df055fSSteven Rostedt 	/*
509459df055fSSteven Rostedt 	 * Disable preemption for these calls to prevent a RCU grace
509559df055fSSteven Rostedt 	 * period. This syncs the hash iteration and freeing of items
509659df055fSSteven Rostedt 	 * on the hash. rcu_read_lock is too dangerous here.
509759df055fSSteven Rostedt 	 */
50985168ae50SSteven Rostedt 	preempt_disable_notrace();
50996e444319SSteven Rostedt (VMware) 	probe_ops->func(ip, parent_ip, probe->tr, probe_ops, probe->data);
51005168ae50SSteven Rostedt 	preempt_enable_notrace();
510159df055fSSteven Rostedt }
510259df055fSSteven Rostedt 
510341794f19SSteven Rostedt (VMware) struct ftrace_func_map {
510441794f19SSteven Rostedt (VMware) 	struct ftrace_func_entry	entry;
510541794f19SSteven Rostedt (VMware) 	void				*data;
510659df055fSSteven Rostedt };
510759df055fSSteven Rostedt 
510841794f19SSteven Rostedt (VMware) struct ftrace_func_mapper {
510941794f19SSteven Rostedt (VMware) 	struct ftrace_hash		hash;
511041794f19SSteven Rostedt (VMware) };
511159df055fSSteven Rostedt 
511241794f19SSteven Rostedt (VMware) /**
511341794f19SSteven Rostedt (VMware)  * allocate_ftrace_func_mapper - allocate a new ftrace_func_mapper
511441794f19SSteven Rostedt (VMware)  *
5115d1530413SRandy Dunlap  * Returns: a ftrace_func_mapper descriptor that can be used to map ips to data.
511641794f19SSteven Rostedt (VMware)  */
511741794f19SSteven Rostedt (VMware) struct ftrace_func_mapper *allocate_ftrace_func_mapper(void)
511859df055fSSteven Rostedt {
5119e1df4cb6SSteven Rostedt (Red Hat) 	struct ftrace_hash *hash;
512059df055fSSteven Rostedt 
512141794f19SSteven Rostedt (VMware) 	/*
512241794f19SSteven Rostedt (VMware) 	 * The mapper is simply a ftrace_hash, but since the entries
512341794f19SSteven Rostedt (VMware) 	 * in the hash are not ftrace_func_entry type, we define it
512441794f19SSteven Rostedt (VMware) 	 * as a separate structure.
512541794f19SSteven Rostedt (VMware) 	 */
512641794f19SSteven Rostedt (VMware) 	hash = alloc_ftrace_hash(FTRACE_HASH_DEFAULT_BITS);
512741794f19SSteven Rostedt (VMware) 	return (struct ftrace_func_mapper *)hash;
5128e1df4cb6SSteven Rostedt (Red Hat) }
5129e1df4cb6SSteven Rostedt (Red Hat) 
513041794f19SSteven Rostedt (VMware) /**
513141794f19SSteven Rostedt (VMware)  * ftrace_func_mapper_find_ip - Find some data mapped to an ip
513241794f19SSteven Rostedt (VMware)  * @mapper: The mapper that has the ip maps
513341794f19SSteven Rostedt (VMware)  * @ip: the instruction pointer to find the data for
513441794f19SSteven Rostedt (VMware)  *
5135d1530413SRandy Dunlap  * Returns: the data mapped to @ip if found otherwise NULL. The return
513641794f19SSteven Rostedt (VMware)  * is actually the address of the mapper data pointer. The address is
513741794f19SSteven Rostedt (VMware)  * returned for use cases where the data is no bigger than a long, and
513841794f19SSteven Rostedt (VMware)  * the user can use the data pointer as its data instead of having to
513941794f19SSteven Rostedt (VMware)  * allocate more memory for the reference.
514041794f19SSteven Rostedt (VMware)  */
514141794f19SSteven Rostedt (VMware) void **ftrace_func_mapper_find_ip(struct ftrace_func_mapper *mapper,
514241794f19SSteven Rostedt (VMware) 				  unsigned long ip)
514341794f19SSteven Rostedt (VMware) {
514441794f19SSteven Rostedt (VMware) 	struct ftrace_func_entry *entry;
514541794f19SSteven Rostedt (VMware) 	struct ftrace_func_map *map;
514641794f19SSteven Rostedt (VMware) 
514741794f19SSteven Rostedt (VMware) 	entry = ftrace_lookup_ip(&mapper->hash, ip);
514841794f19SSteven Rostedt (VMware) 	if (!entry)
514941794f19SSteven Rostedt (VMware) 		return NULL;
515041794f19SSteven Rostedt (VMware) 
515141794f19SSteven Rostedt (VMware) 	map = (struct ftrace_func_map *)entry;
515241794f19SSteven Rostedt (VMware) 	return &map->data;
5153e1df4cb6SSteven Rostedt (Red Hat) }
515445a4a237SSteven Rostedt 
515541794f19SSteven Rostedt (VMware) /**
515641794f19SSteven Rostedt (VMware)  * ftrace_func_mapper_add_ip - Map some data to an ip
515741794f19SSteven Rostedt (VMware)  * @mapper: The mapper that has the ip maps
515841794f19SSteven Rostedt (VMware)  * @ip: The instruction pointer address to map @data to
515941794f19SSteven Rostedt (VMware)  * @data: The data to map to @ip
516041794f19SSteven Rostedt (VMware)  *
5161d1530413SRandy Dunlap  * Returns: 0 on success otherwise an error.
516241794f19SSteven Rostedt (VMware)  */
516341794f19SSteven Rostedt (VMware) int ftrace_func_mapper_add_ip(struct ftrace_func_mapper *mapper,
516441794f19SSteven Rostedt (VMware) 			      unsigned long ip, void *data)
516541794f19SSteven Rostedt (VMware) {
516641794f19SSteven Rostedt (VMware) 	struct ftrace_func_entry *entry;
516741794f19SSteven Rostedt (VMware) 	struct ftrace_func_map *map;
516841794f19SSteven Rostedt (VMware) 
516941794f19SSteven Rostedt (VMware) 	entry = ftrace_lookup_ip(&mapper->hash, ip);
517041794f19SSteven Rostedt (VMware) 	if (entry)
517141794f19SSteven Rostedt (VMware) 		return -EBUSY;
517241794f19SSteven Rostedt (VMware) 
517341794f19SSteven Rostedt (VMware) 	map = kmalloc(sizeof(*map), GFP_KERNEL);
517441794f19SSteven Rostedt (VMware) 	if (!map)
517541794f19SSteven Rostedt (VMware) 		return -ENOMEM;
517641794f19SSteven Rostedt (VMware) 
517741794f19SSteven Rostedt (VMware) 	map->entry.ip = ip;
517841794f19SSteven Rostedt (VMware) 	map->data = data;
517941794f19SSteven Rostedt (VMware) 
518041794f19SSteven Rostedt (VMware) 	__add_hash_entry(&mapper->hash, &map->entry);
518141794f19SSteven Rostedt (VMware) 
518241794f19SSteven Rostedt (VMware) 	return 0;
518341794f19SSteven Rostedt (VMware) }
518441794f19SSteven Rostedt (VMware) 
518541794f19SSteven Rostedt (VMware) /**
518641794f19SSteven Rostedt (VMware)  * ftrace_func_mapper_remove_ip - Remove an ip from the mapping
518741794f19SSteven Rostedt (VMware)  * @mapper: The mapper that has the ip maps
518841794f19SSteven Rostedt (VMware)  * @ip: The instruction pointer address to remove the data from
518941794f19SSteven Rostedt (VMware)  *
5190d1530413SRandy Dunlap  * Returns: the data if it is found, otherwise NULL.
519141794f19SSteven Rostedt (VMware)  * Note, if the data pointer is used as the data itself, (see
519241794f19SSteven Rostedt (VMware)  * ftrace_func_mapper_find_ip(), then the return value may be meaningless,
519341794f19SSteven Rostedt (VMware)  * if the data pointer was set to zero.
519441794f19SSteven Rostedt (VMware)  */
519541794f19SSteven Rostedt (VMware) void *ftrace_func_mapper_remove_ip(struct ftrace_func_mapper *mapper,
519641794f19SSteven Rostedt (VMware) 				   unsigned long ip)
519741794f19SSteven Rostedt (VMware) {
519841794f19SSteven Rostedt (VMware) 	struct ftrace_func_entry *entry;
519941794f19SSteven Rostedt (VMware) 	struct ftrace_func_map *map;
520041794f19SSteven Rostedt (VMware) 	void *data;
520141794f19SSteven Rostedt (VMware) 
520241794f19SSteven Rostedt (VMware) 	entry = ftrace_lookup_ip(&mapper->hash, ip);
520341794f19SSteven Rostedt (VMware) 	if (!entry)
520441794f19SSteven Rostedt (VMware) 		return NULL;
520541794f19SSteven Rostedt (VMware) 
520641794f19SSteven Rostedt (VMware) 	map = (struct ftrace_func_map *)entry;
520741794f19SSteven Rostedt (VMware) 	data = map->data;
520841794f19SSteven Rostedt (VMware) 
520941794f19SSteven Rostedt (VMware) 	remove_hash_entry(&mapper->hash, entry);
521041794f19SSteven Rostedt (VMware) 	kfree(entry);
521141794f19SSteven Rostedt (VMware) 
521241794f19SSteven Rostedt (VMware) 	return data;
521341794f19SSteven Rostedt (VMware) }
521441794f19SSteven Rostedt (VMware) 
521541794f19SSteven Rostedt (VMware) /**
521641794f19SSteven Rostedt (VMware)  * free_ftrace_func_mapper - free a mapping of ips and data
521741794f19SSteven Rostedt (VMware)  * @mapper: The mapper that has the ip maps
521841794f19SSteven Rostedt (VMware)  * @free_func: A function to be called on each data item.
521941794f19SSteven Rostedt (VMware)  *
522041794f19SSteven Rostedt (VMware)  * This is used to free the function mapper. The @free_func is optional
522141794f19SSteven Rostedt (VMware)  * and can be used if the data needs to be freed as well.
522241794f19SSteven Rostedt (VMware)  */
522341794f19SSteven Rostedt (VMware) void free_ftrace_func_mapper(struct ftrace_func_mapper *mapper,
522441794f19SSteven Rostedt (VMware) 			     ftrace_mapper_func free_func)
522541794f19SSteven Rostedt (VMware) {
522641794f19SSteven Rostedt (VMware) 	struct ftrace_func_entry *entry;
522741794f19SSteven Rostedt (VMware) 	struct ftrace_func_map *map;
522841794f19SSteven Rostedt (VMware) 	struct hlist_head *hhd;
522904e03d9aSWei Li 	int size, i;
523004e03d9aSWei Li 
523104e03d9aSWei Li 	if (!mapper)
523204e03d9aSWei Li 		return;
523341794f19SSteven Rostedt (VMware) 
523441794f19SSteven Rostedt (VMware) 	if (free_func && mapper->hash.count) {
523504e03d9aSWei Li 		size = 1 << mapper->hash.size_bits;
523641794f19SSteven Rostedt (VMware) 		for (i = 0; i < size; i++) {
523741794f19SSteven Rostedt (VMware) 			hhd = &mapper->hash.buckets[i];
523841794f19SSteven Rostedt (VMware) 			hlist_for_each_entry(entry, hhd, hlist) {
523941794f19SSteven Rostedt (VMware) 				map = (struct ftrace_func_map *)entry;
524041794f19SSteven Rostedt (VMware) 				free_func(map);
524141794f19SSteven Rostedt (VMware) 			}
524241794f19SSteven Rostedt (VMware) 		}
524341794f19SSteven Rostedt (VMware) 	}
524441794f19SSteven Rostedt (VMware) 	free_ftrace_hash(&mapper->hash);
524541794f19SSteven Rostedt (VMware) }
524641794f19SSteven Rostedt (VMware) 
52477b60f3d8SSteven Rostedt (VMware) static void release_probe(struct ftrace_func_probe *probe)
52487b60f3d8SSteven Rostedt (VMware) {
52497b60f3d8SSteven Rostedt (VMware) 	struct ftrace_probe_ops *probe_ops;
52507b60f3d8SSteven Rostedt (VMware) 
52515ae0bf59SSteven Rostedt (Red Hat) 	mutex_lock(&ftrace_lock);
52525ae0bf59SSteven Rostedt (Red Hat) 
52537b60f3d8SSteven Rostedt (VMware) 	WARN_ON(probe->ref <= 0);
525459df055fSSteven Rostedt 
52557b60f3d8SSteven Rostedt (VMware) 	/* Subtract the ref that was used to protect this instance */
52567b60f3d8SSteven Rostedt (VMware) 	probe->ref--;
5257546fece4SSteven Rostedt (Red Hat) 
52587b60f3d8SSteven Rostedt (VMware) 	if (!probe->ref) {
52597b60f3d8SSteven Rostedt (VMware) 		probe_ops = probe->probe_ops;
52606e444319SSteven Rostedt (VMware) 		/*
52616e444319SSteven Rostedt (VMware) 		 * Sending zero as ip tells probe_ops to free
52626e444319SSteven Rostedt (VMware) 		 * the probe->data itself
52636e444319SSteven Rostedt (VMware) 		 */
52646e444319SSteven Rostedt (VMware) 		if (probe_ops->free)
52656e444319SSteven Rostedt (VMware) 			probe_ops->free(probe_ops, probe->tr, 0, probe->data);
52667b60f3d8SSteven Rostedt (VMware) 		list_del(&probe->list);
52677b60f3d8SSteven Rostedt (VMware) 		kfree(probe);
52687b60f3d8SSteven Rostedt (VMware) 	}
52697b60f3d8SSteven Rostedt (VMware) 	mutex_unlock(&ftrace_lock);
527059df055fSSteven Rostedt }
527159df055fSSteven Rostedt 
52727b60f3d8SSteven Rostedt (VMware) static void acquire_probe_locked(struct ftrace_func_probe *probe)
52737b60f3d8SSteven Rostedt (VMware) {
52747b60f3d8SSteven Rostedt (VMware) 	/*
52757b60f3d8SSteven Rostedt (VMware) 	 * Add one ref to keep it from being freed when releasing the
52767b60f3d8SSteven Rostedt (VMware) 	 * ftrace_lock mutex.
52777b60f3d8SSteven Rostedt (VMware) 	 */
52787b60f3d8SSteven Rostedt (VMware) 	probe->ref++;
52797b60f3d8SSteven Rostedt (VMware) }
528059df055fSSteven Rostedt 
528159df055fSSteven Rostedt int
528204ec7bb6SSteven Rostedt (VMware) register_ftrace_function_probe(char *glob, struct trace_array *tr,
52837b60f3d8SSteven Rostedt (VMware) 			       struct ftrace_probe_ops *probe_ops,
52847b60f3d8SSteven Rostedt (VMware) 			       void *data)
528559df055fSSteven Rostedt {
5286ba27d855SJakob Koschel 	struct ftrace_func_probe *probe = NULL, *iter;
52871ec3a81aSSteven Rostedt (VMware) 	struct ftrace_func_entry *entry;
52881ec3a81aSSteven Rostedt (VMware) 	struct ftrace_hash **orig_hash;
52891ec3a81aSSteven Rostedt (VMware) 	struct ftrace_hash *old_hash;
529059df055fSSteven Rostedt 	struct ftrace_hash *hash;
529159df055fSSteven Rostedt 	int count = 0;
52921ec3a81aSSteven Rostedt (VMware) 	int size;
529359df055fSSteven Rostedt 	int ret;
52941ec3a81aSSteven Rostedt (VMware) 	int i;
529559df055fSSteven Rostedt 
529604ec7bb6SSteven Rostedt (VMware) 	if (WARN_ON(!tr))
529704ec7bb6SSteven Rostedt (VMware) 		return -EINVAL;
529804ec7bb6SSteven Rostedt (VMware) 
52991ec3a81aSSteven Rostedt (VMware) 	/* We do not support '!' for function probes */
53001ec3a81aSSteven Rostedt (VMware) 	if (WARN_ON(glob[0] == '!'))
530159df055fSSteven Rostedt 		return -EINVAL;
530259df055fSSteven Rostedt 
53037b60f3d8SSteven Rostedt (VMware) 
53047b60f3d8SSteven Rostedt (VMware) 	mutex_lock(&ftrace_lock);
53057b60f3d8SSteven Rostedt (VMware) 	/* Check if the probe_ops is already registered */
5306ba27d855SJakob Koschel 	list_for_each_entry(iter, &tr->func_probes, list) {
5307ba27d855SJakob Koschel 		if (iter->probe_ops == probe_ops) {
5308ba27d855SJakob Koschel 			probe = iter;
53097b60f3d8SSteven Rostedt (VMware) 			break;
53107b60f3d8SSteven Rostedt (VMware) 		}
5311ba27d855SJakob Koschel 	}
5312ba27d855SJakob Koschel 	if (!probe) {
53137b60f3d8SSteven Rostedt (VMware) 		probe = kzalloc(sizeof(*probe), GFP_KERNEL);
53147b60f3d8SSteven Rostedt (VMware) 		if (!probe) {
53157b60f3d8SSteven Rostedt (VMware) 			mutex_unlock(&ftrace_lock);
53167b60f3d8SSteven Rostedt (VMware) 			return -ENOMEM;
53177b60f3d8SSteven Rostedt (VMware) 		}
53187b60f3d8SSteven Rostedt (VMware) 		probe->probe_ops = probe_ops;
53197b60f3d8SSteven Rostedt (VMware) 		probe->ops.func = function_trace_probe_call;
53207b60f3d8SSteven Rostedt (VMware) 		probe->tr = tr;
53217b60f3d8SSteven Rostedt (VMware) 		ftrace_ops_init(&probe->ops);
53227b60f3d8SSteven Rostedt (VMware) 		list_add(&probe->list, &tr->func_probes);
53231ec3a81aSSteven Rostedt (VMware) 	}
532459df055fSSteven Rostedt 
53257b60f3d8SSteven Rostedt (VMware) 	acquire_probe_locked(probe);
532659df055fSSteven Rostedt 
53277b60f3d8SSteven Rostedt (VMware) 	mutex_unlock(&ftrace_lock);
53287b60f3d8SSteven Rostedt (VMware) 
5329372e0d01SSteven Rostedt (VMware) 	/*
5330372e0d01SSteven Rostedt (VMware) 	 * Note, there's a small window here that the func_hash->filter_hash
5331fdda88d3SQiujun Huang 	 * may be NULL or empty. Need to be careful when reading the loop.
5332372e0d01SSteven Rostedt (VMware) 	 */
53337b60f3d8SSteven Rostedt (VMware) 	mutex_lock(&probe->ops.func_hash->regex_lock);
53347b60f3d8SSteven Rostedt (VMware) 
53357b60f3d8SSteven Rostedt (VMware) 	orig_hash = &probe->ops.func_hash->filter_hash;
53361ec3a81aSSteven Rostedt (VMware) 	old_hash = *orig_hash;
533759df055fSSteven Rostedt 	hash = alloc_and_copy_ftrace_hash(FTRACE_HASH_DEFAULT_BITS, old_hash);
53381ec3a81aSSteven Rostedt (VMware) 
53395b0022ddSNaveen N. Rao 	if (!hash) {
53405b0022ddSNaveen N. Rao 		ret = -ENOMEM;
53415b0022ddSNaveen N. Rao 		goto out;
53425b0022ddSNaveen N. Rao 	}
53435b0022ddSNaveen N. Rao 
53441ec3a81aSSteven Rostedt (VMware) 	ret = ftrace_match_records(hash, glob, strlen(glob));
53451ec3a81aSSteven Rostedt (VMware) 
53461ec3a81aSSteven Rostedt (VMware) 	/* Nothing found? */
53471ec3a81aSSteven Rostedt (VMware) 	if (!ret)
53481ec3a81aSSteven Rostedt (VMware) 		ret = -EINVAL;
53491ec3a81aSSteven Rostedt (VMware) 
53501ec3a81aSSteven Rostedt (VMware) 	if (ret < 0)
535159df055fSSteven Rostedt 		goto out;
535259df055fSSteven Rostedt 
53531ec3a81aSSteven Rostedt (VMware) 	size = 1 << hash->size_bits;
53541ec3a81aSSteven Rostedt (VMware) 	for (i = 0; i < size; i++) {
53551ec3a81aSSteven Rostedt (VMware) 		hlist_for_each_entry(entry, &hash->buckets[i], hlist) {
53561ec3a81aSSteven Rostedt (VMware) 			if (ftrace_lookup_ip(old_hash, entry->ip))
535759df055fSSteven Rostedt 				continue;
535859df055fSSteven Rostedt 			/*
535959df055fSSteven Rostedt 			 * The caller might want to do something special
536059df055fSSteven Rostedt 			 * for each function we find. We call the callback
536159df055fSSteven Rostedt 			 * to give the caller an opportunity to do so.
536259df055fSSteven Rostedt 			 */
53637b60f3d8SSteven Rostedt (VMware) 			if (probe_ops->init) {
53647b60f3d8SSteven Rostedt (VMware) 				ret = probe_ops->init(probe_ops, tr,
53656e444319SSteven Rostedt (VMware) 						      entry->ip, data,
53666e444319SSteven Rostedt (VMware) 						      &probe->data);
53676e444319SSteven Rostedt (VMware) 				if (ret < 0) {
53686e444319SSteven Rostedt (VMware) 					if (probe_ops->free && count)
53696e444319SSteven Rostedt (VMware) 						probe_ops->free(probe_ops, tr,
53706e444319SSteven Rostedt (VMware) 								0, probe->data);
53716e444319SSteven Rostedt (VMware) 					probe->data = NULL;
5372eee8ded1SSteven Rostedt (VMware) 					goto out;
53731ec3a81aSSteven Rostedt (VMware) 				}
53746e444319SSteven Rostedt (VMware) 			}
53751ec3a81aSSteven Rostedt (VMware) 			count++;
537659df055fSSteven Rostedt 		}
537759df055fSSteven Rostedt 	}
537859df055fSSteven Rostedt 
53791ec3a81aSSteven Rostedt (VMware) 	mutex_lock(&ftrace_lock);
53801ec3a81aSSteven Rostedt (VMware) 
53817b60f3d8SSteven Rostedt (VMware) 	if (!count) {
53827b60f3d8SSteven Rostedt (VMware) 		/* Nothing was added? */
53837b60f3d8SSteven Rostedt (VMware) 		ret = -EINVAL;
5384e1df4cb6SSteven Rostedt (Red Hat) 		goto out_unlock;
5385e1df4cb6SSteven Rostedt (Red Hat) 	}
5386e1df4cb6SSteven Rostedt (Red Hat) 
53877b60f3d8SSteven Rostedt (VMware) 	ret = ftrace_hash_move_and_update_ops(&probe->ops, orig_hash,
53881ec3a81aSSteven Rostedt (VMware) 					      hash, 1);
53891ec3a81aSSteven Rostedt (VMware) 	if (ret < 0)
53908d70725eSSteven Rostedt (VMware) 		goto err_unlock;
539159df055fSSteven Rostedt 
53927b60f3d8SSteven Rostedt (VMware) 	/* One ref for each new function traced */
53937b60f3d8SSteven Rostedt (VMware) 	probe->ref += count;
539459df055fSSteven Rostedt 
53957b60f3d8SSteven Rostedt (VMware) 	if (!(probe->ops.flags & FTRACE_OPS_FL_ENABLED))
53967b60f3d8SSteven Rostedt (VMware) 		ret = ftrace_startup(&probe->ops, 0);
5397e1df4cb6SSteven Rostedt (Red Hat) 
539859df055fSSteven Rostedt  out_unlock:
53995ae0bf59SSteven Rostedt (Red Hat) 	mutex_unlock(&ftrace_lock);
540059df055fSSteven Rostedt 
540159df055fSSteven Rostedt 	if (!ret)
54021ec3a81aSSteven Rostedt (VMware) 		ret = count;
54035ae0bf59SSteven Rostedt (Red Hat)  out:
54047b60f3d8SSteven Rostedt (VMware) 	mutex_unlock(&probe->ops.func_hash->regex_lock);
5405e1df4cb6SSteven Rostedt (Red Hat) 	free_ftrace_hash(hash);
540659df055fSSteven Rostedt 
54077b60f3d8SSteven Rostedt (VMware) 	release_probe(probe);
54087b60f3d8SSteven Rostedt (VMware) 
54091ec3a81aSSteven Rostedt (VMware) 	return ret;
54108d70725eSSteven Rostedt (VMware) 
54118d70725eSSteven Rostedt (VMware)  err_unlock:
54127b60f3d8SSteven Rostedt (VMware) 	if (!probe_ops->free || !count)
54138d70725eSSteven Rostedt (VMware) 		goto out_unlock;
54148d70725eSSteven Rostedt (VMware) 
54158d70725eSSteven Rostedt (VMware) 	/* Failed to do the move, need to call the free functions */
54168d70725eSSteven Rostedt (VMware) 	for (i = 0; i < size; i++) {
54178d70725eSSteven Rostedt (VMware) 		hlist_for_each_entry(entry, &hash->buckets[i], hlist) {
54188d70725eSSteven Rostedt (VMware) 			if (ftrace_lookup_ip(old_hash, entry->ip))
54198d70725eSSteven Rostedt (VMware) 				continue;
54206e444319SSteven Rostedt (VMware) 			probe_ops->free(probe_ops, tr, entry->ip, probe->data);
54218d70725eSSteven Rostedt (VMware) 		}
54228d70725eSSteven Rostedt (VMware) 	}
54238d70725eSSteven Rostedt (VMware) 	goto out_unlock;
542459df055fSSteven Rostedt }
542559df055fSSteven Rostedt 
5426d3d532d7SSteven Rostedt (VMware) int
54277b60f3d8SSteven Rostedt (VMware) unregister_ftrace_function_probe_func(char *glob, struct trace_array *tr,
54287b60f3d8SSteven Rostedt (VMware) 				      struct ftrace_probe_ops *probe_ops)
542959df055fSSteven Rostedt {
5430ba27d855SJakob Koschel 	struct ftrace_func_probe *probe = NULL, *iter;
543182cc4fc2SSteven Rostedt (VMware) 	struct ftrace_ops_hash old_hash_ops;
5432eee8ded1SSteven Rostedt (VMware) 	struct ftrace_func_entry *entry;
54333ba00929SDmitry Safonov 	struct ftrace_glob func_g;
54341ec3a81aSSteven Rostedt (VMware) 	struct ftrace_hash **orig_hash;
54351ec3a81aSSteven Rostedt (VMware) 	struct ftrace_hash *old_hash;
54361ec3a81aSSteven Rostedt (VMware) 	struct ftrace_hash *hash = NULL;
5437b67bfe0dSSasha Levin 	struct hlist_node *tmp;
5438eee8ded1SSteven Rostedt (VMware) 	struct hlist_head hhd;
543959df055fSSteven Rostedt 	char str[KSYM_SYMBOL_LEN];
54407b60f3d8SSteven Rostedt (VMware) 	int count = 0;
54417b60f3d8SSteven Rostedt (VMware) 	int i, ret = -ENODEV;
5442eee8ded1SSteven Rostedt (VMware) 	int size;
544359df055fSSteven Rostedt 
5444cbab567cSNaveen N. Rao 	if (!glob || !strlen(glob) || !strcmp(glob, "*"))
54453ba00929SDmitry Safonov 		func_g.search = NULL;
5446cbab567cSNaveen N. Rao 	else {
544759df055fSSteven Rostedt 		int not;
544859df055fSSteven Rostedt 
54493ba00929SDmitry Safonov 		func_g.type = filter_parse_regex(glob, strlen(glob),
54503ba00929SDmitry Safonov 						 &func_g.search, &not);
54513ba00929SDmitry Safonov 		func_g.len = strlen(func_g.search);
545259df055fSSteven Rostedt 
5453b6887d79SSteven Rostedt 		/* we do not support '!' for function probes */
545459df055fSSteven Rostedt 		if (WARN_ON(not))
5455d3d532d7SSteven Rostedt (VMware) 			return -EINVAL;
545659df055fSSteven Rostedt 	}
545759df055fSSteven Rostedt 
54587b60f3d8SSteven Rostedt (VMware) 	mutex_lock(&ftrace_lock);
54597b60f3d8SSteven Rostedt (VMware) 	/* Check if the probe_ops is already registered */
5460ba27d855SJakob Koschel 	list_for_each_entry(iter, &tr->func_probes, list) {
5461ba27d855SJakob Koschel 		if (iter->probe_ops == probe_ops) {
5462ba27d855SJakob Koschel 			probe = iter;
54637b60f3d8SSteven Rostedt (VMware) 			break;
54647b60f3d8SSteven Rostedt (VMware) 		}
5465ba27d855SJakob Koschel 	}
5466ba27d855SJakob Koschel 	if (!probe)
54677b60f3d8SSteven Rostedt (VMware) 		goto err_unlock_ftrace;
54681ec3a81aSSteven Rostedt (VMware) 
54691ec3a81aSSteven Rostedt (VMware) 	ret = -EINVAL;
54707b60f3d8SSteven Rostedt (VMware) 	if (!(probe->ops.flags & FTRACE_OPS_FL_INITIALIZED))
54717b60f3d8SSteven Rostedt (VMware) 		goto err_unlock_ftrace;
54727b60f3d8SSteven Rostedt (VMware) 
54737b60f3d8SSteven Rostedt (VMware) 	acquire_probe_locked(probe);
54747b60f3d8SSteven Rostedt (VMware) 
54757b60f3d8SSteven Rostedt (VMware) 	mutex_unlock(&ftrace_lock);
54767b60f3d8SSteven Rostedt (VMware) 
54777b60f3d8SSteven Rostedt (VMware) 	mutex_lock(&probe->ops.func_hash->regex_lock);
54787b60f3d8SSteven Rostedt (VMware) 
54797b60f3d8SSteven Rostedt (VMware) 	orig_hash = &probe->ops.func_hash->filter_hash;
54807b60f3d8SSteven Rostedt (VMware) 	old_hash = *orig_hash;
54817b60f3d8SSteven Rostedt (VMware) 
54821ec3a81aSSteven Rostedt (VMware) 	if (ftrace_hash_empty(old_hash))
54831ec3a81aSSteven Rostedt (VMware) 		goto out_unlock;
5484e1df4cb6SSteven Rostedt (Red Hat) 
548582cc4fc2SSteven Rostedt (VMware) 	old_hash_ops.filter_hash = old_hash;
548682cc4fc2SSteven Rostedt (VMware) 	/* Probes only have filters */
548782cc4fc2SSteven Rostedt (VMware) 	old_hash_ops.notrace_hash = NULL;
548882cc4fc2SSteven Rostedt (VMware) 
5489d3d532d7SSteven Rostedt (VMware) 	ret = -ENOMEM;
54901ec3a81aSSteven Rostedt (VMware) 	hash = alloc_and_copy_ftrace_hash(FTRACE_HASH_DEFAULT_BITS, old_hash);
5491e1df4cb6SSteven Rostedt (Red Hat) 	if (!hash)
5492e1df4cb6SSteven Rostedt (Red Hat) 		goto out_unlock;
5493e1df4cb6SSteven Rostedt (Red Hat) 
5494eee8ded1SSteven Rostedt (VMware) 	INIT_HLIST_HEAD(&hhd);
54957818b388SSteven Rostedt (Red Hat) 
5496eee8ded1SSteven Rostedt (VMware) 	size = 1 << hash->size_bits;
5497eee8ded1SSteven Rostedt (VMware) 	for (i = 0; i < size; i++) {
5498eee8ded1SSteven Rostedt (VMware) 		hlist_for_each_entry_safe(entry, tmp, &hash->buckets[i], hlist) {
549959df055fSSteven Rostedt 
55003ba00929SDmitry Safonov 			if (func_g.search) {
550159df055fSSteven Rostedt 				kallsyms_lookup(entry->ip, NULL, NULL,
550259df055fSSteven Rostedt 						NULL, str);
55033ba00929SDmitry Safonov 				if (!ftrace_match(str, &func_g))
550459df055fSSteven Rostedt 					continue;
550559df055fSSteven Rostedt 			}
55067b60f3d8SSteven Rostedt (VMware) 			count++;
5507eee8ded1SSteven Rostedt (VMware) 			remove_hash_entry(hash, entry);
5508eee8ded1SSteven Rostedt (VMware) 			hlist_add_head(&entry->hlist, &hhd);
550959df055fSSteven Rostedt 		}
551059df055fSSteven Rostedt 	}
5511d3d532d7SSteven Rostedt (VMware) 
5512d3d532d7SSteven Rostedt (VMware) 	/* Nothing found? */
55137b60f3d8SSteven Rostedt (VMware) 	if (!count) {
5514d3d532d7SSteven Rostedt (VMware) 		ret = -EINVAL;
5515d3d532d7SSteven Rostedt (VMware) 		goto out_unlock;
5516d3d532d7SSteven Rostedt (VMware) 	}
5517d3d532d7SSteven Rostedt (VMware) 
55183f2367baSMasami Hiramatsu 	mutex_lock(&ftrace_lock);
55191ec3a81aSSteven Rostedt (VMware) 
55207b60f3d8SSteven Rostedt (VMware) 	WARN_ON(probe->ref < count);
5521eee8ded1SSteven Rostedt (VMware) 
55227b60f3d8SSteven Rostedt (VMware) 	probe->ref -= count;
55231ec3a81aSSteven Rostedt (VMware) 
55247b60f3d8SSteven Rostedt (VMware) 	if (ftrace_hash_empty(hash))
55257b60f3d8SSteven Rostedt (VMware) 		ftrace_shutdown(&probe->ops, 0);
55267b60f3d8SSteven Rostedt (VMware) 
55277b60f3d8SSteven Rostedt (VMware) 	ret = ftrace_hash_move_and_update_ops(&probe->ops, orig_hash,
55281ec3a81aSSteven Rostedt (VMware) 					      hash, 1);
552982cc4fc2SSteven Rostedt (VMware) 
553082cc4fc2SSteven Rostedt (VMware) 	/* still need to update the function call sites */
55311ec3a81aSSteven Rostedt (VMware) 	if (ftrace_enabled && !ftrace_hash_empty(hash))
55327b60f3d8SSteven Rostedt (VMware) 		ftrace_run_modify_code(&probe->ops, FTRACE_UPDATE_CALLS,
553382cc4fc2SSteven Rostedt (VMware) 				       &old_hash_ops);
553474401729SPaul E. McKenney 	synchronize_rcu();
55353296fc4eSSteven Rostedt (Red Hat) 
5536eee8ded1SSteven Rostedt (VMware) 	hlist_for_each_entry_safe(entry, tmp, &hhd, hlist) {
5537eee8ded1SSteven Rostedt (VMware) 		hlist_del(&entry->hlist);
55387b60f3d8SSteven Rostedt (VMware) 		if (probe_ops->free)
55396e444319SSteven Rostedt (VMware) 			probe_ops->free(probe_ops, tr, entry->ip, probe->data);
5540eee8ded1SSteven Rostedt (VMware) 		kfree(entry);
55417818b388SSteven Rostedt (Red Hat) 	}
55423f2367baSMasami Hiramatsu 	mutex_unlock(&ftrace_lock);
55437818b388SSteven Rostedt (Red Hat) 
5544e1df4cb6SSteven Rostedt (Red Hat)  out_unlock:
55457b60f3d8SSteven Rostedt (VMware) 	mutex_unlock(&probe->ops.func_hash->regex_lock);
5546e1df4cb6SSteven Rostedt (Red Hat) 	free_ftrace_hash(hash);
554759df055fSSteven Rostedt 
55487b60f3d8SSteven Rostedt (VMware) 	release_probe(probe);
554959df055fSSteven Rostedt 
55507b60f3d8SSteven Rostedt (VMware) 	return ret;
555159df055fSSteven Rostedt 
55527b60f3d8SSteven Rostedt (VMware)  err_unlock_ftrace:
55537b60f3d8SSteven Rostedt (VMware) 	mutex_unlock(&ftrace_lock);
5554d3d532d7SSteven Rostedt (VMware) 	return ret;
555559df055fSSteven Rostedt }
555659df055fSSteven Rostedt 
5557a0e6369eSNaveen N. Rao void clear_ftrace_function_probes(struct trace_array *tr)
5558a0e6369eSNaveen N. Rao {
5559a0e6369eSNaveen N. Rao 	struct ftrace_func_probe *probe, *n;
5560a0e6369eSNaveen N. Rao 
5561a0e6369eSNaveen N. Rao 	list_for_each_entry_safe(probe, n, &tr->func_probes, list)
5562a0e6369eSNaveen N. Rao 		unregister_ftrace_function_probe_func(NULL, tr, probe->probe_ops);
5563a0e6369eSNaveen N. Rao }
5564a0e6369eSNaveen N. Rao 
5565f6180773SSteven Rostedt static LIST_HEAD(ftrace_commands);
5566f6180773SSteven Rostedt static DEFINE_MUTEX(ftrace_cmd_mutex);
5567f6180773SSteven Rostedt 
556838de93abSTom Zanussi /*
556938de93abSTom Zanussi  * Currently we only register ftrace commands from __init, so mark this
557038de93abSTom Zanussi  * __init too.
557138de93abSTom Zanussi  */
557238de93abSTom Zanussi __init int register_ftrace_command(struct ftrace_func_command *cmd)
5573f6180773SSteven Rostedt {
5574f6180773SSteven Rostedt 	struct ftrace_func_command *p;
5575f6180773SSteven Rostedt 	int ret = 0;
5576f6180773SSteven Rostedt 
5577f6180773SSteven Rostedt 	mutex_lock(&ftrace_cmd_mutex);
5578f6180773SSteven Rostedt 	list_for_each_entry(p, &ftrace_commands, list) {
5579f6180773SSteven Rostedt 		if (strcmp(cmd->name, p->name) == 0) {
5580f6180773SSteven Rostedt 			ret = -EBUSY;
5581f6180773SSteven Rostedt 			goto out_unlock;
5582f6180773SSteven Rostedt 		}
5583f6180773SSteven Rostedt 	}
5584f6180773SSteven Rostedt 	list_add(&cmd->list, &ftrace_commands);
5585f6180773SSteven Rostedt  out_unlock:
5586f6180773SSteven Rostedt 	mutex_unlock(&ftrace_cmd_mutex);
5587f6180773SSteven Rostedt 
5588f6180773SSteven Rostedt 	return ret;
5589f6180773SSteven Rostedt }
5590f6180773SSteven Rostedt 
559138de93abSTom Zanussi /*
559238de93abSTom Zanussi  * Currently we only unregister ftrace commands from __init, so mark
559338de93abSTom Zanussi  * this __init too.
559438de93abSTom Zanussi  */
559538de93abSTom Zanussi __init int unregister_ftrace_command(struct ftrace_func_command *cmd)
5596f6180773SSteven Rostedt {
5597f6180773SSteven Rostedt 	struct ftrace_func_command *p, *n;
5598f6180773SSteven Rostedt 	int ret = -ENODEV;
5599f6180773SSteven Rostedt 
5600f6180773SSteven Rostedt 	mutex_lock(&ftrace_cmd_mutex);
5601f6180773SSteven Rostedt 	list_for_each_entry_safe(p, n, &ftrace_commands, list) {
5602f6180773SSteven Rostedt 		if (strcmp(cmd->name, p->name) == 0) {
5603f6180773SSteven Rostedt 			ret = 0;
5604f6180773SSteven Rostedt 			list_del_init(&p->list);
5605f6180773SSteven Rostedt 			goto out_unlock;
5606f6180773SSteven Rostedt 		}
5607f6180773SSteven Rostedt 	}
5608f6180773SSteven Rostedt  out_unlock:
5609f6180773SSteven Rostedt 	mutex_unlock(&ftrace_cmd_mutex);
5610f6180773SSteven Rostedt 
5611f6180773SSteven Rostedt 	return ret;
5612f6180773SSteven Rostedt }
5613f6180773SSteven Rostedt 
561404ec7bb6SSteven Rostedt (VMware) static int ftrace_process_regex(struct ftrace_iterator *iter,
561533dc9b12SSteven Rostedt 				char *buff, int len, int enable)
561664e7c440SSteven Rostedt {
561704ec7bb6SSteven Rostedt (VMware) 	struct ftrace_hash *hash = iter->hash;
5618d2afd57aSSteven Rostedt (VMware) 	struct trace_array *tr = iter->ops->private;
5619f6180773SSteven Rostedt 	char *func, *command, *next = buff;
56206a24a244SSteven Rostedt 	struct ftrace_func_command *p;
56210aff1c0cSGuoWen Li 	int ret = -EINVAL;
562264e7c440SSteven Rostedt 
562364e7c440SSteven Rostedt 	func = strsep(&next, ":");
562464e7c440SSteven Rostedt 
562564e7c440SSteven Rostedt 	if (!next) {
56261cf41dd7SSteven Rostedt 		ret = ftrace_match_records(hash, func, len);
5627b448c4e3SSteven Rostedt 		if (!ret)
5628b448c4e3SSteven Rostedt 			ret = -EINVAL;
5629b448c4e3SSteven Rostedt 		if (ret < 0)
5630311d16daSLi Zefan 			return ret;
5631b448c4e3SSteven Rostedt 		return 0;
563264e7c440SSteven Rostedt 	}
563364e7c440SSteven Rostedt 
5634f6180773SSteven Rostedt 	/* command found */
563564e7c440SSteven Rostedt 
563664e7c440SSteven Rostedt 	command = strsep(&next, ":");
563764e7c440SSteven Rostedt 
5638f6180773SSteven Rostedt 	mutex_lock(&ftrace_cmd_mutex);
5639f6180773SSteven Rostedt 	list_for_each_entry(p, &ftrace_commands, list) {
5640f6180773SSteven Rostedt 		if (strcmp(p->name, command) == 0) {
564104ec7bb6SSteven Rostedt (VMware) 			ret = p->func(tr, hash, func, command, next, enable);
5642f6180773SSteven Rostedt 			goto out_unlock;
564364e7c440SSteven Rostedt 		}
5644f6180773SSteven Rostedt 	}
5645f6180773SSteven Rostedt  out_unlock:
5646f6180773SSteven Rostedt 	mutex_unlock(&ftrace_cmd_mutex);
564764e7c440SSteven Rostedt 
5648f6180773SSteven Rostedt 	return ret;
564964e7c440SSteven Rostedt }
565064e7c440SSteven Rostedt 
5651e309b41dSIngo Molnar static ssize_t
565241c52c0dSSteven Rostedt ftrace_regex_write(struct file *file, const char __user *ubuf,
565341c52c0dSSteven Rostedt 		   size_t cnt, loff_t *ppos, int enable)
56545072c59fSSteven Rostedt {
56555072c59fSSteven Rostedt 	struct ftrace_iterator *iter;
5656689fd8b6S[email protected] 	struct trace_parser *parser;
5657689fd8b6S[email protected] 	ssize_t ret, read;
56585072c59fSSteven Rostedt 
56594ba7978eSLi Zefan 	if (!cnt)
56605072c59fSSteven Rostedt 		return 0;
56615072c59fSSteven Rostedt 
56625072c59fSSteven Rostedt 	if (file->f_mode & FMODE_READ) {
56635072c59fSSteven Rostedt 		struct seq_file *m = file->private_data;
56645072c59fSSteven Rostedt 		iter = m->private;
56655072c59fSSteven Rostedt 	} else
56665072c59fSSteven Rostedt 		iter = file->private_data;
56675072c59fSSteven Rostedt 
5668f04f24fbSMasami Hiramatsu 	if (unlikely(ftrace_disabled))
56693f2367baSMasami Hiramatsu 		return -ENODEV;
56703f2367baSMasami Hiramatsu 
56713f2367baSMasami Hiramatsu 	/* iter->hash is a local copy, so we don't need regex_lock */
5672f04f24fbSMasami Hiramatsu 
5673689fd8b6S[email protected] 	parser = &iter->parser;
5674689fd8b6S[email protected] 	read = trace_get_user(parser, ubuf, cnt, ppos);
56755072c59fSSteven Rostedt 
56764ba7978eSLi Zefan 	if (read >= 0 && trace_parser_loaded(parser) &&
5677689fd8b6S[email protected] 	    !trace_parser_cont(parser)) {
567804ec7bb6SSteven Rostedt (VMware) 		ret = ftrace_process_regex(iter, parser->buffer,
5679689fd8b6S[email protected] 					   parser->idx, enable);
5680313254a9SLi Zefan 		trace_parser_clear(parser);
56817c088b51SSteven Rostedt (Red Hat) 		if (ret < 0)
56823f2367baSMasami Hiramatsu 			goto out;
56835072c59fSSteven Rostedt 	}
56845072c59fSSteven Rostedt 
56855072c59fSSteven Rostedt 	ret = read;
56863f2367baSMasami Hiramatsu  out:
56875072c59fSSteven Rostedt 	return ret;
56885072c59fSSteven Rostedt }
56895072c59fSSteven Rostedt 
5690fc13cb0cSSteven Rostedt ssize_t
569141c52c0dSSteven Rostedt ftrace_filter_write(struct file *file, const char __user *ubuf,
569241c52c0dSSteven Rostedt 		    size_t cnt, loff_t *ppos)
569341c52c0dSSteven Rostedt {
569441c52c0dSSteven Rostedt 	return ftrace_regex_write(file, ubuf, cnt, ppos, 1);
569541c52c0dSSteven Rostedt }
569641c52c0dSSteven Rostedt 
5697fc13cb0cSSteven Rostedt ssize_t
569841c52c0dSSteven Rostedt ftrace_notrace_write(struct file *file, const char __user *ubuf,
569941c52c0dSSteven Rostedt 		     size_t cnt, loff_t *ppos)
570041c52c0dSSteven Rostedt {
570141c52c0dSSteven Rostedt 	return ftrace_regex_write(file, ubuf, cnt, ppos, 0);
570241c52c0dSSteven Rostedt }
570341c52c0dSSteven Rostedt 
570433dc9b12SSteven Rostedt static int
57054f554e95SJiri Olsa __ftrace_match_addr(struct ftrace_hash *hash, unsigned long ip, int remove)
5706647664eaSMasami Hiramatsu {
5707647664eaSMasami Hiramatsu 	struct ftrace_func_entry *entry;
5708647664eaSMasami Hiramatsu 
5709aebfd125SPeter Zijlstra 	ip = ftrace_location(ip);
5710aebfd125SPeter Zijlstra 	if (!ip)
5711647664eaSMasami Hiramatsu 		return -EINVAL;
5712647664eaSMasami Hiramatsu 
5713647664eaSMasami Hiramatsu 	if (remove) {
5714647664eaSMasami Hiramatsu 		entry = ftrace_lookup_ip(hash, ip);
5715647664eaSMasami Hiramatsu 		if (!entry)
5716647664eaSMasami Hiramatsu 			return -ENOENT;
5717647664eaSMasami Hiramatsu 		free_hash_entry(hash, entry);
5718647664eaSMasami Hiramatsu 		return 0;
5719647664eaSMasami Hiramatsu 	}
5720647664eaSMasami Hiramatsu 
5721d05cb470SSteven Rostedt (Google) 	entry = add_hash_entry(hash, ip);
5722d05cb470SSteven Rostedt (Google) 	return entry ? 0 :  -ENOMEM;
5723647664eaSMasami Hiramatsu }
5724647664eaSMasami Hiramatsu 
5725647664eaSMasami Hiramatsu static int
57264f554e95SJiri Olsa ftrace_match_addr(struct ftrace_hash *hash, unsigned long *ips,
57274f554e95SJiri Olsa 		  unsigned int cnt, int remove)
57284f554e95SJiri Olsa {
57294f554e95SJiri Olsa 	unsigned int i;
57304f554e95SJiri Olsa 	int err;
57314f554e95SJiri Olsa 
57324f554e95SJiri Olsa 	for (i = 0; i < cnt; i++) {
57334f554e95SJiri Olsa 		err = __ftrace_match_addr(hash, ips[i], remove);
57344f554e95SJiri Olsa 		if (err) {
57354f554e95SJiri Olsa 			/*
57364f554e95SJiri Olsa 			 * This expects the @hash is a temporary hash and if this
57374f554e95SJiri Olsa 			 * fails the caller must free the @hash.
57384f554e95SJiri Olsa 			 */
57394f554e95SJiri Olsa 			return err;
57404f554e95SJiri Olsa 		}
57414f554e95SJiri Olsa 	}
57424f554e95SJiri Olsa 	return 0;
57434f554e95SJiri Olsa }
57444f554e95SJiri Olsa 
57454f554e95SJiri Olsa static int
5746647664eaSMasami Hiramatsu ftrace_set_hash(struct ftrace_ops *ops, unsigned char *buf, int len,
57474f554e95SJiri Olsa 		unsigned long *ips, unsigned int cnt,
57484f554e95SJiri Olsa 		int remove, int reset, int enable)
574941c52c0dSSteven Rostedt {
575033dc9b12SSteven Rostedt 	struct ftrace_hash **orig_hash;
5751f45948e8SSteven Rostedt 	struct ftrace_hash *hash;
575233dc9b12SSteven Rostedt 	int ret;
5753f45948e8SSteven Rostedt 
575441c52c0dSSteven Rostedt 	if (unlikely(ftrace_disabled))
575533dc9b12SSteven Rostedt 		return -ENODEV;
575641c52c0dSSteven Rostedt 
575733b7f99cSSteven Rostedt (Red Hat) 	mutex_lock(&ops->func_hash->regex_lock);
57583f2367baSMasami Hiramatsu 
5759f45948e8SSteven Rostedt 	if (enable)
576033b7f99cSSteven Rostedt (Red Hat) 		orig_hash = &ops->func_hash->filter_hash;
5761f45948e8SSteven Rostedt 	else
576233b7f99cSSteven Rostedt (Red Hat) 		orig_hash = &ops->func_hash->notrace_hash;
576333dc9b12SSteven Rostedt 
5764b972cc58SWang Nan 	if (reset)
5765b972cc58SWang Nan 		hash = alloc_ftrace_hash(FTRACE_HASH_DEFAULT_BITS);
5766b972cc58SWang Nan 	else
576733dc9b12SSteven Rostedt 		hash = alloc_and_copy_ftrace_hash(FTRACE_HASH_DEFAULT_BITS, *orig_hash);
5768b972cc58SWang Nan 
57693f2367baSMasami Hiramatsu 	if (!hash) {
57703f2367baSMasami Hiramatsu 		ret = -ENOMEM;
57713f2367baSMasami Hiramatsu 		goto out_regex_unlock;
57723f2367baSMasami Hiramatsu 	}
5773f45948e8SSteven Rostedt 
5774ac483c44SJiri Olsa 	if (buf && !ftrace_match_records(hash, buf, len)) {
5775ac483c44SJiri Olsa 		ret = -EINVAL;
5776ac483c44SJiri Olsa 		goto out_regex_unlock;
5777ac483c44SJiri Olsa 	}
57784f554e95SJiri Olsa 	if (ips) {
57794f554e95SJiri Olsa 		ret = ftrace_match_addr(hash, ips, cnt, remove);
5780647664eaSMasami Hiramatsu 		if (ret < 0)
5781647664eaSMasami Hiramatsu 			goto out_regex_unlock;
5782647664eaSMasami Hiramatsu 	}
578333dc9b12SSteven Rostedt 
578433dc9b12SSteven Rostedt 	mutex_lock(&ftrace_lock);
5785e16b35ddSSteven Rostedt (VMware) 	ret = ftrace_hash_move_and_update_ops(ops, orig_hash, hash, enable);
578633dc9b12SSteven Rostedt 	mutex_unlock(&ftrace_lock);
578733dc9b12SSteven Rostedt 
5788ac483c44SJiri Olsa  out_regex_unlock:
578933b7f99cSSteven Rostedt (Red Hat) 	mutex_unlock(&ops->func_hash->regex_lock);
579033dc9b12SSteven Rostedt 
579133dc9b12SSteven Rostedt 	free_ftrace_hash(hash);
579233dc9b12SSteven Rostedt 	return ret;
579341c52c0dSSteven Rostedt }
579441c52c0dSSteven Rostedt 
5795647664eaSMasami Hiramatsu static int
57964f554e95SJiri Olsa ftrace_set_addr(struct ftrace_ops *ops, unsigned long *ips, unsigned int cnt,
57974f554e95SJiri Olsa 		int remove, int reset, int enable)
5798647664eaSMasami Hiramatsu {
57994f554e95SJiri Olsa 	return ftrace_set_hash(ops, NULL, 0, ips, cnt, remove, reset, enable);
5800647664eaSMasami Hiramatsu }
5801647664eaSMasami Hiramatsu 
5802763e34e7SSteven Rostedt (VMware) #ifdef CONFIG_DYNAMIC_FTRACE_WITH_DIRECT_CALLS
5803013bf0daSSteven Rostedt (VMware) 
580453cd885bSSong Liu static int register_ftrace_function_nolock(struct ftrace_ops *ops);
580553cd885bSSong Liu 
5806a8b9cf62SMasami Hiramatsu (Google) /*
5807a8b9cf62SMasami Hiramatsu (Google)  * If there are multiple ftrace_ops, use SAVE_REGS by default, so that direct
5808a8b9cf62SMasami Hiramatsu (Google)  * call will be jumped from ftrace_regs_caller. Only if the architecture does
5809a8b9cf62SMasami Hiramatsu (Google)  * not support ftrace_regs_caller but direct_call, use SAVE_ARGS so that it
5810a8b9cf62SMasami Hiramatsu (Google)  * jumps from ftrace_caller for multiple ftrace_ops.
5811a8b9cf62SMasami Hiramatsu (Google)  */
5812bdbddb10SPetr Pavlu #ifndef CONFIG_HAVE_DYNAMIC_FTRACE_WITH_REGS
581360c89718SFlorent Revest #define MULTI_FLAGS (FTRACE_OPS_FL_DIRECT | FTRACE_OPS_FL_SAVE_ARGS)
5814a8b9cf62SMasami Hiramatsu (Google) #else
5815a8b9cf62SMasami Hiramatsu (Google) #define MULTI_FLAGS (FTRACE_OPS_FL_DIRECT | FTRACE_OPS_FL_SAVE_REGS)
5816a8b9cf62SMasami Hiramatsu (Google) #endif
5817f64dd462SJiri Olsa 
5818f64dd462SJiri Olsa static int check_direct_multi(struct ftrace_ops *ops)
5819f64dd462SJiri Olsa {
5820f64dd462SJiri Olsa 	if (!(ops->flags & FTRACE_OPS_FL_INITIALIZED))
5821f64dd462SJiri Olsa 		return -EINVAL;
5822f64dd462SJiri Olsa 	if ((ops->flags & MULTI_FLAGS) != MULTI_FLAGS)
5823f64dd462SJiri Olsa 		return -EINVAL;
5824f64dd462SJiri Olsa 	return 0;
5825f64dd462SJiri Olsa }
5826f64dd462SJiri Olsa 
5827f64dd462SJiri Olsa static void remove_direct_functions_hash(struct ftrace_hash *hash, unsigned long addr)
5828f64dd462SJiri Olsa {
5829f64dd462SJiri Olsa 	struct ftrace_func_entry *entry, *del;
5830f64dd462SJiri Olsa 	int size, i;
5831f64dd462SJiri Olsa 
5832f64dd462SJiri Olsa 	size = 1 << hash->size_bits;
5833f64dd462SJiri Olsa 	for (i = 0; i < size; i++) {
5834f64dd462SJiri Olsa 		hlist_for_each_entry(entry, &hash->buckets[i], hlist) {
5835f64dd462SJiri Olsa 			del = __ftrace_lookup_ip(direct_functions, entry->ip);
5836f64dd462SJiri Olsa 			if (del && del->direct == addr) {
5837f64dd462SJiri Olsa 				remove_hash_entry(direct_functions, del);
5838f64dd462SJiri Olsa 				kfree(del);
5839f64dd462SJiri Olsa 			}
5840f64dd462SJiri Olsa 		}
5841f64dd462SJiri Olsa 	}
5842f64dd462SJiri Olsa }
5843f64dd462SJiri Olsa 
584433f13714SPaul E. McKenney static void register_ftrace_direct_cb(struct rcu_head *rhp)
584533f13714SPaul E. McKenney {
584633f13714SPaul E. McKenney 	struct ftrace_hash *fhp = container_of(rhp, struct ftrace_hash, rcu);
584733f13714SPaul E. McKenney 
584833f13714SPaul E. McKenney 	free_ftrace_hash(fhp);
584933f13714SPaul E. McKenney }
585033f13714SPaul E. McKenney 
5851f64dd462SJiri Olsa /**
5852da8bdfbdSFlorent Revest  * register_ftrace_direct - Call a custom trampoline directly
5853f64dd462SJiri Olsa  * for multiple functions registered in @ops
5854f64dd462SJiri Olsa  * @ops: The address of the struct ftrace_ops object
5855f64dd462SJiri Olsa  * @addr: The address of the trampoline to call at @ops functions
5856f64dd462SJiri Olsa  *
5857f64dd462SJiri Olsa  * This is used to connect a direct calls to @addr from the nop locations
5858f64dd462SJiri Olsa  * of the functions registered in @ops (with by ftrace_set_filter_ip
5859f64dd462SJiri Olsa  * function).
5860f64dd462SJiri Olsa  *
5861f64dd462SJiri Olsa  * The location that it calls (@addr) must be able to handle a direct call,
5862f64dd462SJiri Olsa  * and save the parameters of the function being traced, and restore them
5863f64dd462SJiri Olsa  * (or inject new ones if needed), before returning.
5864f64dd462SJiri Olsa  *
5865f64dd462SJiri Olsa  * Returns:
5866f64dd462SJiri Olsa  *  0 on success
5867f64dd462SJiri Olsa  *  -EINVAL  - The @ops object was already registered with this call or
5868f64dd462SJiri Olsa  *             when there are no functions in @ops object.
5869f64dd462SJiri Olsa  *  -EBUSY   - Another direct function is already attached (there can be only one)
5870f64dd462SJiri Olsa  *  -ENODEV  - @ip does not point to a ftrace nop location (or not supported)
5871f64dd462SJiri Olsa  *  -ENOMEM  - There was an allocation failure.
5872f64dd462SJiri Olsa  */
5873da8bdfbdSFlorent Revest int register_ftrace_direct(struct ftrace_ops *ops, unsigned long addr)
5874f64dd462SJiri Olsa {
5875d05cb470SSteven Rostedt (Google) 	struct ftrace_hash *hash, *new_hash = NULL, *free_hash = NULL;
5876f64dd462SJiri Olsa 	struct ftrace_func_entry *entry, *new;
5877f64dd462SJiri Olsa 	int err = -EBUSY, size, i;
5878f64dd462SJiri Olsa 
5879f64dd462SJiri Olsa 	if (ops->func || ops->trampoline)
5880f64dd462SJiri Olsa 		return -EINVAL;
5881f64dd462SJiri Olsa 	if (!(ops->flags & FTRACE_OPS_FL_INITIALIZED))
5882f64dd462SJiri Olsa 		return -EINVAL;
5883f64dd462SJiri Olsa 	if (ops->flags & FTRACE_OPS_FL_ENABLED)
5884f64dd462SJiri Olsa 		return -EINVAL;
5885f64dd462SJiri Olsa 
5886f64dd462SJiri Olsa 	hash = ops->func_hash->filter_hash;
5887f64dd462SJiri Olsa 	if (ftrace_hash_empty(hash))
5888f64dd462SJiri Olsa 		return -EINVAL;
5889f64dd462SJiri Olsa 
5890f64dd462SJiri Olsa 	mutex_lock(&direct_mutex);
5891f64dd462SJiri Olsa 
5892f64dd462SJiri Olsa 	/* Make sure requested entries are not already registered.. */
5893f64dd462SJiri Olsa 	size = 1 << hash->size_bits;
5894f64dd462SJiri Olsa 	for (i = 0; i < size; i++) {
5895f64dd462SJiri Olsa 		hlist_for_each_entry(entry, &hash->buckets[i], hlist) {
5896f64dd462SJiri Olsa 			if (ftrace_find_rec_direct(entry->ip))
5897f64dd462SJiri Olsa 				goto out_unlock;
5898f64dd462SJiri Olsa 		}
5899f64dd462SJiri Olsa 	}
5900f64dd462SJiri Olsa 
5901f64dd462SJiri Olsa 	err = -ENOMEM;
5902d05cb470SSteven Rostedt (Google) 
5903d05cb470SSteven Rostedt (Google) 	/* Make a copy hash to place the new and the old entries in */
5904d05cb470SSteven Rostedt (Google) 	size = hash->count + direct_functions->count;
5905d05cb470SSteven Rostedt (Google) 	if (size > 32)
5906d05cb470SSteven Rostedt (Google) 		size = 32;
5907d05cb470SSteven Rostedt (Google) 	new_hash = alloc_ftrace_hash(fls(size));
5908d05cb470SSteven Rostedt (Google) 	if (!new_hash)
5909d05cb470SSteven Rostedt (Google) 		goto out_unlock;
5910d05cb470SSteven Rostedt (Google) 
5911d05cb470SSteven Rostedt (Google) 	/* Now copy over the existing direct entries */
5912d05cb470SSteven Rostedt (Google) 	size = 1 << direct_functions->size_bits;
5913d05cb470SSteven Rostedt (Google) 	for (i = 0; i < size; i++) {
5914d05cb470SSteven Rostedt (Google) 		hlist_for_each_entry(entry, &direct_functions->buckets[i], hlist) {
5915d05cb470SSteven Rostedt (Google) 			new = add_hash_entry(new_hash, entry->ip);
5916d05cb470SSteven Rostedt (Google) 			if (!new)
5917d05cb470SSteven Rostedt (Google) 				goto out_unlock;
5918d05cb470SSteven Rostedt (Google) 			new->direct = entry->direct;
5919d05cb470SSteven Rostedt (Google) 		}
5920d05cb470SSteven Rostedt (Google) 	}
5921d05cb470SSteven Rostedt (Google) 
5922d05cb470SSteven Rostedt (Google) 	/* ... and add the new entries */
5923d05cb470SSteven Rostedt (Google) 	size = 1 << hash->size_bits;
5924f64dd462SJiri Olsa 	for (i = 0; i < size; i++) {
5925f64dd462SJiri Olsa 		hlist_for_each_entry(entry, &hash->buckets[i], hlist) {
5926d05cb470SSteven Rostedt (Google) 			new = add_hash_entry(new_hash, entry->ip);
5927f64dd462SJiri Olsa 			if (!new)
5928d05cb470SSteven Rostedt (Google) 				goto out_unlock;
5929d05cb470SSteven Rostedt (Google) 			/* Update both the copy and the hash entry */
5930d05cb470SSteven Rostedt (Google) 			new->direct = addr;
5931f64dd462SJiri Olsa 			entry->direct = addr;
5932f64dd462SJiri Olsa 		}
5933f64dd462SJiri Olsa 	}
5934f64dd462SJiri Olsa 
5935d05cb470SSteven Rostedt (Google) 	free_hash = direct_functions;
5936d05cb470SSteven Rostedt (Google) 	rcu_assign_pointer(direct_functions, new_hash);
5937d05cb470SSteven Rostedt (Google) 	new_hash = NULL;
5938d05cb470SSteven Rostedt (Google) 
5939f64dd462SJiri Olsa 	ops->func = call_direct_funcs;
5940f64dd462SJiri Olsa 	ops->flags = MULTI_FLAGS;
5941f64dd462SJiri Olsa 	ops->trampoline = FTRACE_REGS_ADDR;
5942dbaccb61SFlorent Revest 	ops->direct_call = addr;
5943f64dd462SJiri Olsa 
594453cd885bSSong Liu 	err = register_ftrace_function_nolock(ops);
5945f64dd462SJiri Olsa 
5946f64dd462SJiri Olsa  out_unlock:
5947f64dd462SJiri Olsa 	mutex_unlock(&direct_mutex);
5948f64dd462SJiri Olsa 
594933f13714SPaul E. McKenney 	if (free_hash && free_hash != EMPTY_HASH)
595033f13714SPaul E. McKenney 		call_rcu_tasks(&free_hash->rcu, register_ftrace_direct_cb);
5951d05cb470SSteven Rostedt (Google) 
5952d05cb470SSteven Rostedt (Google) 	if (new_hash)
5953d05cb470SSteven Rostedt (Google) 		free_ftrace_hash(new_hash);
5954d05cb470SSteven Rostedt (Google) 
5955f64dd462SJiri Olsa 	return err;
5956f64dd462SJiri Olsa }
5957da8bdfbdSFlorent Revest EXPORT_SYMBOL_GPL(register_ftrace_direct);
5958f64dd462SJiri Olsa 
5959f64dd462SJiri Olsa /**
5960da8bdfbdSFlorent Revest  * unregister_ftrace_direct - Remove calls to custom trampoline
5961da8bdfbdSFlorent Revest  * previously registered by register_ftrace_direct for @ops object.
5962f64dd462SJiri Olsa  * @ops: The address of the struct ftrace_ops object
5963f64dd462SJiri Olsa  *
5964f64dd462SJiri Olsa  * This is used to remove a direct calls to @addr from the nop locations
5965f64dd462SJiri Olsa  * of the functions registered in @ops (with by ftrace_set_filter_ip
5966f64dd462SJiri Olsa  * function).
5967f64dd462SJiri Olsa  *
5968f64dd462SJiri Olsa  * Returns:
5969f64dd462SJiri Olsa  *  0 on success
5970f64dd462SJiri Olsa  *  -EINVAL - The @ops object was not properly registered.
5971f64dd462SJiri Olsa  */
5972da8bdfbdSFlorent Revest int unregister_ftrace_direct(struct ftrace_ops *ops, unsigned long addr,
597359495740SFlorent Revest 			     bool free_filters)
5974f64dd462SJiri Olsa {
5975f64dd462SJiri Olsa 	struct ftrace_hash *hash = ops->func_hash->filter_hash;
5976f64dd462SJiri Olsa 	int err;
5977f64dd462SJiri Olsa 
5978f64dd462SJiri Olsa 	if (check_direct_multi(ops))
5979f64dd462SJiri Olsa 		return -EINVAL;
5980f64dd462SJiri Olsa 	if (!(ops->flags & FTRACE_OPS_FL_ENABLED))
5981f64dd462SJiri Olsa 		return -EINVAL;
5982f64dd462SJiri Olsa 
5983f64dd462SJiri Olsa 	mutex_lock(&direct_mutex);
5984f64dd462SJiri Olsa 	err = unregister_ftrace_function(ops);
5985f64dd462SJiri Olsa 	remove_direct_functions_hash(hash, addr);
5986f64dd462SJiri Olsa 	mutex_unlock(&direct_mutex);
5987fea3ffa4SJiri Olsa 
5988fea3ffa4SJiri Olsa 	/* cleanup for possible another register call */
5989fea3ffa4SJiri Olsa 	ops->func = NULL;
5990fea3ffa4SJiri Olsa 	ops->trampoline = 0;
599159495740SFlorent Revest 
599259495740SFlorent Revest 	if (free_filters)
599359495740SFlorent Revest 		ftrace_free_filter(ops);
5994f64dd462SJiri Olsa 	return err;
5995f64dd462SJiri Olsa }
5996da8bdfbdSFlorent Revest EXPORT_SYMBOL_GPL(unregister_ftrace_direct);
5997ccf5a89eSJiri Olsa 
5998f96f644aSSong Liu static int
5999da8bdfbdSFlorent Revest __modify_ftrace_direct(struct ftrace_ops *ops, unsigned long addr)
6000ccf5a89eSJiri Olsa {
6001ed292718SSteven Rostedt (VMware) 	struct ftrace_hash *hash;
6002ccf5a89eSJiri Olsa 	struct ftrace_func_entry *entry, *iter;
6003ed292718SSteven Rostedt (VMware) 	static struct ftrace_ops tmp_ops = {
6004ed292718SSteven Rostedt (VMware) 		.func		= ftrace_stub,
6005ed292718SSteven Rostedt (VMware) 		.flags		= FTRACE_OPS_FL_STUB,
6006ed292718SSteven Rostedt (VMware) 	};
6007ccf5a89eSJiri Olsa 	int i, size;
6008ccf5a89eSJiri Olsa 	int err;
6009ccf5a89eSJiri Olsa 
6010f96f644aSSong Liu 	lockdep_assert_held_once(&direct_mutex);
6011ed292718SSteven Rostedt (VMware) 
6012ed292718SSteven Rostedt (VMware) 	/* Enable the tmp_ops to have the same functions as the direct ops */
6013ed292718SSteven Rostedt (VMware) 	ftrace_ops_init(&tmp_ops);
6014ed292718SSteven Rostedt (VMware) 	tmp_ops.func_hash = ops->func_hash;
6015dbaccb61SFlorent Revest 	tmp_ops.direct_call = addr;
6016ed292718SSteven Rostedt (VMware) 
601753cd885bSSong Liu 	err = register_ftrace_function_nolock(&tmp_ops);
6018ed292718SSteven Rostedt (VMware) 	if (err)
6019f96f644aSSong Liu 		return err;
6020ccf5a89eSJiri Olsa 
6021ccf5a89eSJiri Olsa 	/*
6022ed292718SSteven Rostedt (VMware) 	 * Now the ftrace_ops_list_func() is called to do the direct callers.
6023ed292718SSteven Rostedt (VMware) 	 * We can safely change the direct functions attached to each entry.
6024ccf5a89eSJiri Olsa 	 */
6025ed292718SSteven Rostedt (VMware) 	mutex_lock(&ftrace_lock);
6026ccf5a89eSJiri Olsa 
6027ed292718SSteven Rostedt (VMware) 	hash = ops->func_hash->filter_hash;
6028ccf5a89eSJiri Olsa 	size = 1 << hash->size_bits;
6029ccf5a89eSJiri Olsa 	for (i = 0; i < size; i++) {
6030ccf5a89eSJiri Olsa 		hlist_for_each_entry(iter, &hash->buckets[i], hlist) {
6031ccf5a89eSJiri Olsa 			entry = __ftrace_lookup_ip(direct_functions, iter->ip);
6032ccf5a89eSJiri Olsa 			if (!entry)
6033ccf5a89eSJiri Olsa 				continue;
6034ccf5a89eSJiri Olsa 			entry->direct = addr;
6035ccf5a89eSJiri Olsa 		}
6036ccf5a89eSJiri Olsa 	}
6037dbaccb61SFlorent Revest 	/* Prevent store tearing if a trampoline concurrently accesses the value */
6038dbaccb61SFlorent Revest 	WRITE_ONCE(ops->direct_call, addr);
6039ccf5a89eSJiri Olsa 
60402e6e9058SJiri Olsa 	mutex_unlock(&ftrace_lock);
60412e6e9058SJiri Olsa 
6042ed292718SSteven Rostedt (VMware) 	/* Removing the tmp_ops will add the updated direct callers to the functions */
6043ed292718SSteven Rostedt (VMware) 	unregister_ftrace_function(&tmp_ops);
6044ccf5a89eSJiri Olsa 
6045f96f644aSSong Liu 	return err;
6046f96f644aSSong Liu }
6047f96f644aSSong Liu 
6048f96f644aSSong Liu /**
6049da8bdfbdSFlorent Revest  * modify_ftrace_direct_nolock - Modify an existing direct 'multi' call
6050f96f644aSSong Liu  * to call something else
6051f96f644aSSong Liu  * @ops: The address of the struct ftrace_ops object
6052f96f644aSSong Liu  * @addr: The address of the new trampoline to call at @ops functions
6053f96f644aSSong Liu  *
6054f96f644aSSong Liu  * This is used to unregister currently registered direct caller and
6055f96f644aSSong Liu  * register new one @addr on functions registered in @ops object.
6056f96f644aSSong Liu  *
6057f96f644aSSong Liu  * Note there's window between ftrace_shutdown and ftrace_startup calls
6058f96f644aSSong Liu  * where there will be no callbacks called.
6059f96f644aSSong Liu  *
6060f96f644aSSong Liu  * Caller should already have direct_mutex locked, so we don't lock
6061f96f644aSSong Liu  * direct_mutex here.
6062f96f644aSSong Liu  *
6063f96f644aSSong Liu  * Returns: zero on success. Non zero on error, which includes:
6064f96f644aSSong Liu  *  -EINVAL - The @ops object was not properly registered.
6065f96f644aSSong Liu  */
6066da8bdfbdSFlorent Revest int modify_ftrace_direct_nolock(struct ftrace_ops *ops, unsigned long addr)
6067f96f644aSSong Liu {
6068f96f644aSSong Liu 	if (check_direct_multi(ops))
6069f96f644aSSong Liu 		return -EINVAL;
6070f96f644aSSong Liu 	if (!(ops->flags & FTRACE_OPS_FL_ENABLED))
6071f96f644aSSong Liu 		return -EINVAL;
6072f96f644aSSong Liu 
6073da8bdfbdSFlorent Revest 	return __modify_ftrace_direct(ops, addr);
6074f96f644aSSong Liu }
6075da8bdfbdSFlorent Revest EXPORT_SYMBOL_GPL(modify_ftrace_direct_nolock);
6076f96f644aSSong Liu 
6077f96f644aSSong Liu /**
6078da8bdfbdSFlorent Revest  * modify_ftrace_direct - Modify an existing direct 'multi' call
6079f96f644aSSong Liu  * to call something else
6080f96f644aSSong Liu  * @ops: The address of the struct ftrace_ops object
6081f96f644aSSong Liu  * @addr: The address of the new trampoline to call at @ops functions
6082f96f644aSSong Liu  *
6083f96f644aSSong Liu  * This is used to unregister currently registered direct caller and
6084f96f644aSSong Liu  * register new one @addr on functions registered in @ops object.
6085f96f644aSSong Liu  *
6086f96f644aSSong Liu  * Note there's window between ftrace_shutdown and ftrace_startup calls
6087f96f644aSSong Liu  * where there will be no callbacks called.
6088f96f644aSSong Liu  *
6089f96f644aSSong Liu  * Returns: zero on success. Non zero on error, which includes:
6090f96f644aSSong Liu  *  -EINVAL - The @ops object was not properly registered.
6091f96f644aSSong Liu  */
6092da8bdfbdSFlorent Revest int modify_ftrace_direct(struct ftrace_ops *ops, unsigned long addr)
6093f96f644aSSong Liu {
6094f96f644aSSong Liu 	int err;
6095f96f644aSSong Liu 
6096f96f644aSSong Liu 	if (check_direct_multi(ops))
6097f96f644aSSong Liu 		return -EINVAL;
6098f96f644aSSong Liu 	if (!(ops->flags & FTRACE_OPS_FL_ENABLED))
6099f96f644aSSong Liu 		return -EINVAL;
6100f96f644aSSong Liu 
6101f96f644aSSong Liu 	mutex_lock(&direct_mutex);
6102da8bdfbdSFlorent Revest 	err = __modify_ftrace_direct(ops, addr);
6103ccf5a89eSJiri Olsa 	mutex_unlock(&direct_mutex);
6104ccf5a89eSJiri Olsa 	return err;
6105ccf5a89eSJiri Olsa }
6106da8bdfbdSFlorent Revest EXPORT_SYMBOL_GPL(modify_ftrace_direct);
6107763e34e7SSteven Rostedt (VMware) #endif /* CONFIG_DYNAMIC_FTRACE_WITH_DIRECT_CALLS */
6108763e34e7SSteven Rostedt (VMware) 
6109647664eaSMasami Hiramatsu /**
6110647664eaSMasami Hiramatsu  * ftrace_set_filter_ip - set a function to filter on in ftrace by address
6111d1530413SRandy Dunlap  * @ops: the ops to set the filter with
6112d1530413SRandy Dunlap  * @ip: the address to add to or remove from the filter.
6113d1530413SRandy Dunlap  * @remove: non zero to remove the ip from the filter
6114d1530413SRandy Dunlap  * @reset: non zero to reset all filters before applying this filter.
6115647664eaSMasami Hiramatsu  *
6116647664eaSMasami Hiramatsu  * Filters denote which functions should be enabled when tracing is enabled
6117f2cc020dSIngo Molnar  * If @ip is NULL, it fails to update filter.
61188be9fbd5SMark Rutland  *
61198be9fbd5SMark Rutland  * This can allocate memory which must be freed before @ops can be freed,
61208be9fbd5SMark Rutland  * either by removing each filtered addr or by using
61218be9fbd5SMark Rutland  * ftrace_free_filter(@ops).
6122647664eaSMasami Hiramatsu  */
6123647664eaSMasami Hiramatsu int ftrace_set_filter_ip(struct ftrace_ops *ops, unsigned long ip,
6124647664eaSMasami Hiramatsu 			 int remove, int reset)
6125647664eaSMasami Hiramatsu {
6126f04f24fbSMasami Hiramatsu 	ftrace_ops_init(ops);
61274f554e95SJiri Olsa 	return ftrace_set_addr(ops, &ip, 1, remove, reset, 1);
6128647664eaSMasami Hiramatsu }
6129647664eaSMasami Hiramatsu EXPORT_SYMBOL_GPL(ftrace_set_filter_ip);
6130647664eaSMasami Hiramatsu 
6131d032ae89SJoel Fernandes /**
61324f554e95SJiri Olsa  * ftrace_set_filter_ips - set functions to filter on in ftrace by addresses
6133d1530413SRandy Dunlap  * @ops: the ops to set the filter with
6134d1530413SRandy Dunlap  * @ips: the array of addresses to add to or remove from the filter.
6135d1530413SRandy Dunlap  * @cnt: the number of addresses in @ips
6136d1530413SRandy Dunlap  * @remove: non zero to remove ips from the filter
6137d1530413SRandy Dunlap  * @reset: non zero to reset all filters before applying this filter.
61384f554e95SJiri Olsa  *
61394f554e95SJiri Olsa  * Filters denote which functions should be enabled when tracing is enabled
61404f554e95SJiri Olsa  * If @ips array or any ip specified within is NULL , it fails to update filter.
61418be9fbd5SMark Rutland  *
61428be9fbd5SMark Rutland  * This can allocate memory which must be freed before @ops can be freed,
61438be9fbd5SMark Rutland  * either by removing each filtered addr or by using
61448be9fbd5SMark Rutland  * ftrace_free_filter(@ops).
61454f554e95SJiri Olsa */
61464f554e95SJiri Olsa int ftrace_set_filter_ips(struct ftrace_ops *ops, unsigned long *ips,
61474f554e95SJiri Olsa 			  unsigned int cnt, int remove, int reset)
61484f554e95SJiri Olsa {
61494f554e95SJiri Olsa 	ftrace_ops_init(ops);
61504f554e95SJiri Olsa 	return ftrace_set_addr(ops, ips, cnt, remove, reset, 1);
61514f554e95SJiri Olsa }
61524f554e95SJiri Olsa EXPORT_SYMBOL_GPL(ftrace_set_filter_ips);
61534f554e95SJiri Olsa 
61544f554e95SJiri Olsa /**
6155d032ae89SJoel Fernandes  * ftrace_ops_set_global_filter - setup ops to use global filters
6156d1530413SRandy Dunlap  * @ops: the ops which will use the global filters
6157d032ae89SJoel Fernandes  *
6158d032ae89SJoel Fernandes  * ftrace users who need global function trace filtering should call this.
6159d032ae89SJoel Fernandes  * It can set the global filter only if ops were not initialized before.
6160d032ae89SJoel Fernandes  */
6161d032ae89SJoel Fernandes void ftrace_ops_set_global_filter(struct ftrace_ops *ops)
6162d032ae89SJoel Fernandes {
6163d032ae89SJoel Fernandes 	if (ops->flags & FTRACE_OPS_FL_INITIALIZED)
6164d032ae89SJoel Fernandes 		return;
6165d032ae89SJoel Fernandes 
6166d032ae89SJoel Fernandes 	ftrace_ops_init(ops);
6167d032ae89SJoel Fernandes 	ops->func_hash = &global_ops.local_hash;
6168d032ae89SJoel Fernandes }
6169d032ae89SJoel Fernandes EXPORT_SYMBOL_GPL(ftrace_ops_set_global_filter);
6170d032ae89SJoel Fernandes 
6171647664eaSMasami Hiramatsu static int
6172647664eaSMasami Hiramatsu ftrace_set_regex(struct ftrace_ops *ops, unsigned char *buf, int len,
6173647664eaSMasami Hiramatsu 		 int reset, int enable)
6174647664eaSMasami Hiramatsu {
61754f554e95SJiri Olsa 	return ftrace_set_hash(ops, buf, len, NULL, 0, 0, reset, enable);
6176647664eaSMasami Hiramatsu }
6177647664eaSMasami Hiramatsu 
617877a2b37dSSteven Rostedt /**
617977a2b37dSSteven Rostedt  * ftrace_set_filter - set a function to filter on in ftrace
6180d1530413SRandy Dunlap  * @ops: the ops to set the filter with
6181d1530413SRandy Dunlap  * @buf: the string that holds the function filter text.
6182d1530413SRandy Dunlap  * @len: the length of the string.
6183d1530413SRandy Dunlap  * @reset: non-zero to reset all filters before applying this filter.
618477a2b37dSSteven Rostedt  *
618577a2b37dSSteven Rostedt  * Filters denote which functions should be enabled when tracing is enabled.
618677a2b37dSSteven Rostedt  * If @buf is NULL and reset is set, all functions will be enabled for tracing.
61878be9fbd5SMark Rutland  *
61888be9fbd5SMark Rutland  * This can allocate memory which must be freed before @ops can be freed,
61898be9fbd5SMark Rutland  * either by removing each filtered addr or by using
61908be9fbd5SMark Rutland  * ftrace_free_filter(@ops).
619177a2b37dSSteven Rostedt  */
6192ac483c44SJiri Olsa int ftrace_set_filter(struct ftrace_ops *ops, unsigned char *buf,
6193936e074bSSteven Rostedt 		       int len, int reset)
619477a2b37dSSteven Rostedt {
6195f04f24fbSMasami Hiramatsu 	ftrace_ops_init(ops);
6196ac483c44SJiri Olsa 	return ftrace_set_regex(ops, buf, len, reset, 1);
619741c52c0dSSteven Rostedt }
6198936e074bSSteven Rostedt EXPORT_SYMBOL_GPL(ftrace_set_filter);
61994eebcc81SSteven Rostedt 
620041c52c0dSSteven Rostedt /**
620141c52c0dSSteven Rostedt  * ftrace_set_notrace - set a function to not trace in ftrace
6202d1530413SRandy Dunlap  * @ops: the ops to set the notrace filter with
6203d1530413SRandy Dunlap  * @buf: the string that holds the function notrace text.
6204d1530413SRandy Dunlap  * @len: the length of the string.
6205d1530413SRandy Dunlap  * @reset: non-zero to reset all filters before applying this filter.
620641c52c0dSSteven Rostedt  *
620741c52c0dSSteven Rostedt  * Notrace Filters denote which functions should not be enabled when tracing
620841c52c0dSSteven Rostedt  * is enabled. If @buf is NULL and reset is set, all functions will be enabled
620941c52c0dSSteven Rostedt  * for tracing.
62108be9fbd5SMark Rutland  *
62118be9fbd5SMark Rutland  * This can allocate memory which must be freed before @ops can be freed,
62128be9fbd5SMark Rutland  * either by removing each filtered addr or by using
62138be9fbd5SMark Rutland  * ftrace_free_filter(@ops).
621441c52c0dSSteven Rostedt  */
6215ac483c44SJiri Olsa int ftrace_set_notrace(struct ftrace_ops *ops, unsigned char *buf,
6216936e074bSSteven Rostedt 			int len, int reset)
6217936e074bSSteven Rostedt {
6218f04f24fbSMasami Hiramatsu 	ftrace_ops_init(ops);
6219ac483c44SJiri Olsa 	return ftrace_set_regex(ops, buf, len, reset, 0);
6220936e074bSSteven Rostedt }
6221936e074bSSteven Rostedt EXPORT_SYMBOL_GPL(ftrace_set_notrace);
6222936e074bSSteven Rostedt /**
62238d1b065dSJiaxing Wang  * ftrace_set_global_filter - set a function to filter on with global tracers
6224d1530413SRandy Dunlap  * @buf: the string that holds the function filter text.
6225d1530413SRandy Dunlap  * @len: the length of the string.
6226d1530413SRandy Dunlap  * @reset: non-zero to reset all filters before applying this filter.
6227936e074bSSteven Rostedt  *
6228936e074bSSteven Rostedt  * Filters denote which functions should be enabled when tracing is enabled.
6229936e074bSSteven Rostedt  * If @buf is NULL and reset is set, all functions will be enabled for tracing.
6230936e074bSSteven Rostedt  */
6231936e074bSSteven Rostedt void ftrace_set_global_filter(unsigned char *buf, int len, int reset)
6232936e074bSSteven Rostedt {
6233936e074bSSteven Rostedt 	ftrace_set_regex(&global_ops, buf, len, reset, 1);
6234936e074bSSteven Rostedt }
6235936e074bSSteven Rostedt EXPORT_SYMBOL_GPL(ftrace_set_global_filter);
6236936e074bSSteven Rostedt 
6237936e074bSSteven Rostedt /**
62388d1b065dSJiaxing Wang  * ftrace_set_global_notrace - set a function to not trace with global tracers
6239d1530413SRandy Dunlap  * @buf: the string that holds the function notrace text.
6240d1530413SRandy Dunlap  * @len: the length of the string.
6241d1530413SRandy Dunlap  * @reset: non-zero to reset all filters before applying this filter.
6242936e074bSSteven Rostedt  *
6243936e074bSSteven Rostedt  * Notrace Filters denote which functions should not be enabled when tracing
6244936e074bSSteven Rostedt  * is enabled. If @buf is NULL and reset is set, all functions will be enabled
6245936e074bSSteven Rostedt  * for tracing.
6246936e074bSSteven Rostedt  */
6247936e074bSSteven Rostedt void ftrace_set_global_notrace(unsigned char *buf, int len, int reset)
624841c52c0dSSteven Rostedt {
6249f45948e8SSteven Rostedt 	ftrace_set_regex(&global_ops, buf, len, reset, 0);
625077a2b37dSSteven Rostedt }
6251936e074bSSteven Rostedt EXPORT_SYMBOL_GPL(ftrace_set_global_notrace);
625277a2b37dSSteven Rostedt 
62532af15d6aSSteven Rostedt /*
62542af15d6aSSteven Rostedt  * command line interface to allow users to set filters on boot up.
62552af15d6aSSteven Rostedt  */
62562af15d6aSSteven Rostedt #define FTRACE_FILTER_SIZE		COMMAND_LINE_SIZE
62572af15d6aSSteven Rostedt static char ftrace_notrace_buf[FTRACE_FILTER_SIZE] __initdata;
62582af15d6aSSteven Rostedt static char ftrace_filter_buf[FTRACE_FILTER_SIZE] __initdata;
62592af15d6aSSteven Rostedt 
6260f1ed7c74SSteven Rostedt (Red Hat) /* Used by function selftest to not test if filter is set */
6261f1ed7c74SSteven Rostedt (Red Hat) bool ftrace_filter_param __initdata;
6262f1ed7c74SSteven Rostedt (Red Hat) 
62632af15d6aSSteven Rostedt static int __init set_ftrace_notrace(char *str)
62642af15d6aSSteven Rostedt {
6265f1ed7c74SSteven Rostedt (Red Hat) 	ftrace_filter_param = true;
6266d0c2d66fSAzeem Shaikh 	strscpy(ftrace_notrace_buf, str, FTRACE_FILTER_SIZE);
62672af15d6aSSteven Rostedt 	return 1;
62682af15d6aSSteven Rostedt }
62692af15d6aSSteven Rostedt __setup("ftrace_notrace=", set_ftrace_notrace);
62702af15d6aSSteven Rostedt 
62712af15d6aSSteven Rostedt static int __init set_ftrace_filter(char *str)
62722af15d6aSSteven Rostedt {
6273f1ed7c74SSteven Rostedt (Red Hat) 	ftrace_filter_param = true;
6274d0c2d66fSAzeem Shaikh 	strscpy(ftrace_filter_buf, str, FTRACE_FILTER_SIZE);
62752af15d6aSSteven Rostedt 	return 1;
62762af15d6aSSteven Rostedt }
62772af15d6aSSteven Rostedt __setup("ftrace_filter=", set_ftrace_filter);
62782af15d6aSSteven Rostedt 
6279369bc18fSStefan Assmann #ifdef CONFIG_FUNCTION_GRAPH_TRACER
6280f6060f46SLai Jiangshan static char ftrace_graph_buf[FTRACE_FILTER_SIZE] __initdata;
62810d7d9a16SNamhyung Kim static char ftrace_graph_notrace_buf[FTRACE_FILTER_SIZE] __initdata;
6282b9b0c831SNamhyung Kim static int ftrace_graph_set_hash(struct ftrace_hash *hash, char *buffer);
6283801c29fdSSteven Rostedt 
6284369bc18fSStefan Assmann static int __init set_graph_function(char *str)
6285369bc18fSStefan Assmann {
6286d0c2d66fSAzeem Shaikh 	strscpy(ftrace_graph_buf, str, FTRACE_FILTER_SIZE);
6287369bc18fSStefan Assmann 	return 1;
6288369bc18fSStefan Assmann }
6289369bc18fSStefan Assmann __setup("ftrace_graph_filter=", set_graph_function);
6290369bc18fSStefan Assmann 
62910d7d9a16SNamhyung Kim static int __init set_graph_notrace_function(char *str)
62920d7d9a16SNamhyung Kim {
6293d0c2d66fSAzeem Shaikh 	strscpy(ftrace_graph_notrace_buf, str, FTRACE_FILTER_SIZE);
62940d7d9a16SNamhyung Kim 	return 1;
62950d7d9a16SNamhyung Kim }
62960d7d9a16SNamhyung Kim __setup("ftrace_graph_notrace=", set_graph_notrace_function);
62970d7d9a16SNamhyung Kim 
629865a50c65STodd Brandt static int __init set_graph_max_depth_function(char *str)
629965a50c65STodd Brandt {
6300c5963a09SYuran Pereira 	if (!str || kstrtouint(str, 0, &fgraph_max_depth))
630165a50c65STodd Brandt 		return 0;
630265a50c65STodd Brandt 	return 1;
630365a50c65STodd Brandt }
630465a50c65STodd Brandt __setup("ftrace_graph_max_depth=", set_graph_max_depth_function);
630565a50c65STodd Brandt 
63060d7d9a16SNamhyung Kim static void __init set_ftrace_early_graph(char *buf, int enable)
6307369bc18fSStefan Assmann {
6308369bc18fSStefan Assmann 	int ret;
6309369bc18fSStefan Assmann 	char *func;
6310b9b0c831SNamhyung Kim 	struct ftrace_hash *hash;
63110d7d9a16SNamhyung Kim 
631292ad18ecSSteven Rostedt (VMware) 	hash = alloc_ftrace_hash(FTRACE_HASH_DEFAULT_BITS);
631324589e3aSSteven Rostedt (VMware) 	if (MEM_FAIL(!hash, "Failed to allocate hash\n"))
631492ad18ecSSteven Rostedt (VMware) 		return;
6315369bc18fSStefan Assmann 
6316369bc18fSStefan Assmann 	while (buf) {
6317369bc18fSStefan Assmann 		func = strsep(&buf, ",");
6318369bc18fSStefan Assmann 		/* we allow only one expression at a time */
6319b9b0c831SNamhyung Kim 		ret = ftrace_graph_set_hash(hash, func);
6320369bc18fSStefan Assmann 		if (ret)
6321369bc18fSStefan Assmann 			printk(KERN_DEBUG "ftrace: function %s not "
6322369bc18fSStefan Assmann 					  "traceable\n", func);
6323369bc18fSStefan Assmann 	}
632492ad18ecSSteven Rostedt (VMware) 
632592ad18ecSSteven Rostedt (VMware) 	if (enable)
632692ad18ecSSteven Rostedt (VMware) 		ftrace_graph_hash = hash;
632792ad18ecSSteven Rostedt (VMware) 	else
632892ad18ecSSteven Rostedt (VMware) 		ftrace_graph_notrace_hash = hash;
6329369bc18fSStefan Assmann }
6330369bc18fSStefan Assmann #endif /* CONFIG_FUNCTION_GRAPH_TRACER */
6331369bc18fSStefan Assmann 
63322a85a37fSSteven Rostedt void __init
63332a85a37fSSteven Rostedt ftrace_set_early_filter(struct ftrace_ops *ops, char *buf, int enable)
63342af15d6aSSteven Rostedt {
63352af15d6aSSteven Rostedt 	char *func;
63362af15d6aSSteven Rostedt 
6337f04f24fbSMasami Hiramatsu 	ftrace_ops_init(ops);
6338f04f24fbSMasami Hiramatsu 
63392af15d6aSSteven Rostedt 	while (buf) {
63402af15d6aSSteven Rostedt 		func = strsep(&buf, ",");
6341f45948e8SSteven Rostedt 		ftrace_set_regex(ops, func, strlen(func), 0, enable);
63422af15d6aSSteven Rostedt 	}
63432af15d6aSSteven Rostedt }
63442af15d6aSSteven Rostedt 
63452af15d6aSSteven Rostedt static void __init set_ftrace_early_filters(void)
63462af15d6aSSteven Rostedt {
63472af15d6aSSteven Rostedt 	if (ftrace_filter_buf[0])
63482a85a37fSSteven Rostedt 		ftrace_set_early_filter(&global_ops, ftrace_filter_buf, 1);
63492af15d6aSSteven Rostedt 	if (ftrace_notrace_buf[0])
63502a85a37fSSteven Rostedt 		ftrace_set_early_filter(&global_ops, ftrace_notrace_buf, 0);
6351369bc18fSStefan Assmann #ifdef CONFIG_FUNCTION_GRAPH_TRACER
6352369bc18fSStefan Assmann 	if (ftrace_graph_buf[0])
63530d7d9a16SNamhyung Kim 		set_ftrace_early_graph(ftrace_graph_buf, 1);
63540d7d9a16SNamhyung Kim 	if (ftrace_graph_notrace_buf[0])
63550d7d9a16SNamhyung Kim 		set_ftrace_early_graph(ftrace_graph_notrace_buf, 0);
6356369bc18fSStefan Assmann #endif /* CONFIG_FUNCTION_GRAPH_TRACER */
63572af15d6aSSteven Rostedt }
63582af15d6aSSteven Rostedt 
6359fc13cb0cSSteven Rostedt int ftrace_regex_release(struct inode *inode, struct file *file)
63605072c59fSSteven Rostedt {
63615072c59fSSteven Rostedt 	struct seq_file *m = (struct seq_file *)file->private_data;
63625072c59fSSteven Rostedt 	struct ftrace_iterator *iter;
636333dc9b12SSteven Rostedt 	struct ftrace_hash **orig_hash;
6364689fd8b6S[email protected] 	struct trace_parser *parser;
6365ed926f9bSSteven Rostedt 	int filter_hash;
63665072c59fSSteven Rostedt 
63675072c59fSSteven Rostedt 	if (file->f_mode & FMODE_READ) {
63685072c59fSSteven Rostedt 		iter = m->private;
63695072c59fSSteven Rostedt 		seq_release(inode, file);
63705072c59fSSteven Rostedt 	} else
63715072c59fSSteven Rostedt 		iter = file->private_data;
63725072c59fSSteven Rostedt 
6373689fd8b6S[email protected] 	parser = &iter->parser;
6374689fd8b6S[email protected] 	if (trace_parser_loaded(parser)) {
63758c9af478SSteven Rostedt (VMware) 		int enable = !(iter->flags & FTRACE_ITER_NOTRACE);
63768c9af478SSteven Rostedt (VMware) 
63778c9af478SSteven Rostedt (VMware) 		ftrace_process_regex(iter, parser->buffer,
63788c9af478SSteven Rostedt (VMware) 				     parser->idx, enable);
63795072c59fSSteven Rostedt 	}
63805072c59fSSteven Rostedt 
6381058e297dSSteven Rostedt 	trace_parser_put(parser);
6382058e297dSSteven Rostedt 
638333b7f99cSSteven Rostedt (Red Hat) 	mutex_lock(&iter->ops->func_hash->regex_lock);
63843f2367baSMasami Hiramatsu 
6385058e297dSSteven Rostedt 	if (file->f_mode & FMODE_WRITE) {
6386ed926f9bSSteven Rostedt 		filter_hash = !!(iter->flags & FTRACE_ITER_FILTER);
6387ed926f9bSSteven Rostedt 
63888c08f0d5SSteven Rostedt (VMware) 		if (filter_hash) {
638933b7f99cSSteven Rostedt (Red Hat) 			orig_hash = &iter->ops->func_hash->filter_hash;
63900ce0638eSZheng Yejian 			if (iter->tr) {
63910ce0638eSZheng Yejian 				if (list_empty(&iter->tr->mod_trace))
63920ce0638eSZheng Yejian 					iter->hash->flags &= ~FTRACE_HASH_FL_MOD;
63930ce0638eSZheng Yejian 				else
63948c08f0d5SSteven Rostedt (VMware) 					iter->hash->flags |= FTRACE_HASH_FL_MOD;
63950ce0638eSZheng Yejian 			}
63968c08f0d5SSteven Rostedt (VMware) 		} else
639733b7f99cSSteven Rostedt (Red Hat) 			orig_hash = &iter->ops->func_hash->notrace_hash;
639833dc9b12SSteven Rostedt 
6399e6ea44e9SSteven Rostedt 		mutex_lock(&ftrace_lock);
6400045e269cSAlex Shi 		ftrace_hash_move_and_update_ops(iter->ops, orig_hash,
6401e16b35ddSSteven Rostedt (VMware) 						      iter->hash, filter_hash);
6402e6ea44e9SSteven Rostedt 		mutex_unlock(&ftrace_lock);
6403c20489daSSteven Rostedt (VMware) 	} else {
6404c20489daSSteven Rostedt (VMware) 		/* For read only, the hash is the ops hash */
6405c20489daSSteven Rostedt (VMware) 		iter->hash = NULL;
6406058e297dSSteven Rostedt 	}
64073f2367baSMasami Hiramatsu 
640833b7f99cSSteven Rostedt (Red Hat) 	mutex_unlock(&iter->ops->func_hash->regex_lock);
640933dc9b12SSteven Rostedt 	free_ftrace_hash(iter->hash);
64109ef16693SSteven Rostedt (VMware) 	if (iter->tr)
64119ef16693SSteven Rostedt (VMware) 		trace_array_put(iter->tr);
641233dc9b12SSteven Rostedt 	kfree(iter);
6413689fd8b6S[email protected] 
64145072c59fSSteven Rostedt 	return 0;
64155072c59fSSteven Rostedt }
64165072c59fSSteven Rostedt 
64175e2336a0SSteven Rostedt static const struct file_operations ftrace_avail_fops = {
64185072c59fSSteven Rostedt 	.open = ftrace_avail_open,
64195072c59fSSteven Rostedt 	.read = seq_read,
64205072c59fSSteven Rostedt 	.llseek = seq_lseek,
64213be04b47SLi Zefan 	.release = seq_release_private,
64225072c59fSSteven Rostedt };
64235072c59fSSteven Rostedt 
6424647bcd03SSteven Rostedt static const struct file_operations ftrace_enabled_fops = {
6425647bcd03SSteven Rostedt 	.open = ftrace_enabled_open,
6426647bcd03SSteven Rostedt 	.read = seq_read,
6427647bcd03SSteven Rostedt 	.llseek = seq_lseek,
6428647bcd03SSteven Rostedt 	.release = seq_release_private,
6429647bcd03SSteven Rostedt };
6430647bcd03SSteven Rostedt 
6431e11b521aSSteven Rostedt (Google) static const struct file_operations ftrace_touched_fops = {
6432e11b521aSSteven Rostedt (Google) 	.open = ftrace_touched_open,
6433e11b521aSSteven Rostedt (Google) 	.read = seq_read,
6434e11b521aSSteven Rostedt (Google) 	.llseek = seq_lseek,
6435e11b521aSSteven Rostedt (Google) 	.release = seq_release_private,
6436e11b521aSSteven Rostedt (Google) };
6437e11b521aSSteven Rostedt (Google) 
643883f74441SJiri Olsa static const struct file_operations ftrace_avail_addrs_fops = {
643983f74441SJiri Olsa 	.open = ftrace_avail_addrs_open,
644083f74441SJiri Olsa 	.read = seq_read,
644183f74441SJiri Olsa 	.llseek = seq_lseek,
644283f74441SJiri Olsa 	.release = seq_release_private,
644383f74441SJiri Olsa };
644483f74441SJiri Olsa 
64455e2336a0SSteven Rostedt static const struct file_operations ftrace_filter_fops = {
64465072c59fSSteven Rostedt 	.open = ftrace_filter_open,
6447850a80cfSLai Jiangshan 	.read = seq_read,
64485072c59fSSteven Rostedt 	.write = ftrace_filter_write,
6449098c879eSSteven Rostedt (Red Hat) 	.llseek = tracing_lseek,
64501cf41dd7SSteven Rostedt 	.release = ftrace_regex_release,
64515072c59fSSteven Rostedt };
64525072c59fSSteven Rostedt 
64535e2336a0SSteven Rostedt static const struct file_operations ftrace_notrace_fops = {
645441c52c0dSSteven Rostedt 	.open = ftrace_notrace_open,
6455850a80cfSLai Jiangshan 	.read = seq_read,
645641c52c0dSSteven Rostedt 	.write = ftrace_notrace_write,
6457098c879eSSteven Rostedt (Red Hat) 	.llseek = tracing_lseek,
64581cf41dd7SSteven Rostedt 	.release = ftrace_regex_release,
645941c52c0dSSteven Rostedt };
646041c52c0dSSteven Rostedt 
6461ea4e2bc4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
6462ea4e2bc4SSteven Rostedt 
6463ea4e2bc4SSteven Rostedt static DEFINE_MUTEX(graph_lock);
6464ea4e2bc4SSteven Rostedt 
646524a9729fSAmol Grover struct ftrace_hash __rcu *ftrace_graph_hash = EMPTY_HASH;
6466fd0e6852SAmol Grover struct ftrace_hash __rcu *ftrace_graph_notrace_hash = EMPTY_HASH;
6467b9b0c831SNamhyung Kim 
6468b9b0c831SNamhyung Kim enum graph_filter_type {
6469b9b0c831SNamhyung Kim 	GRAPH_FILTER_NOTRACE	= 0,
6470b9b0c831SNamhyung Kim 	GRAPH_FILTER_FUNCTION,
6471b9b0c831SNamhyung Kim };
6472ea4e2bc4SSteven Rostedt 
6473555fc781SSteven Rostedt (VMware) #define FTRACE_GRAPH_EMPTY	((void *)1)
6474555fc781SSteven Rostedt (VMware) 
6475faf982a6SNamhyung Kim struct ftrace_graph_data {
6476b9b0c831SNamhyung Kim 	struct ftrace_hash		*hash;
6477b9b0c831SNamhyung Kim 	struct ftrace_func_entry	*entry;
6478b9b0c831SNamhyung Kim 	int				idx;   /* for hash table iteration */
6479b9b0c831SNamhyung Kim 	enum graph_filter_type		type;
6480b9b0c831SNamhyung Kim 	struct ftrace_hash		*new_hash;
6481faf982a6SNamhyung Kim 	const struct seq_operations	*seq_ops;
6482e704eff3SSteven Rostedt (VMware) 	struct trace_parser		parser;
6483faf982a6SNamhyung Kim };
6484faf982a6SNamhyung Kim 
6485ea4e2bc4SSteven Rostedt static void *
648685951842SLi Zefan __g_next(struct seq_file *m, loff_t *pos)
6487ea4e2bc4SSteven Rostedt {
6488faf982a6SNamhyung Kim 	struct ftrace_graph_data *fgd = m->private;
6489b9b0c831SNamhyung Kim 	struct ftrace_func_entry *entry = fgd->entry;
6490b9b0c831SNamhyung Kim 	struct hlist_head *head;
6491b9b0c831SNamhyung Kim 	int i, idx = fgd->idx;
6492faf982a6SNamhyung Kim 
6493b9b0c831SNamhyung Kim 	if (*pos >= fgd->hash->count)
6494ea4e2bc4SSteven Rostedt 		return NULL;
6495b9b0c831SNamhyung Kim 
6496b9b0c831SNamhyung Kim 	if (entry) {
6497b9b0c831SNamhyung Kim 		hlist_for_each_entry_continue(entry, hlist) {
6498b9b0c831SNamhyung Kim 			fgd->entry = entry;
6499b9b0c831SNamhyung Kim 			return entry;
6500b9b0c831SNamhyung Kim 		}
6501b9b0c831SNamhyung Kim 
6502b9b0c831SNamhyung Kim 		idx++;
6503b9b0c831SNamhyung Kim 	}
6504b9b0c831SNamhyung Kim 
6505b9b0c831SNamhyung Kim 	for (i = idx; i < 1 << fgd->hash->size_bits; i++) {
6506b9b0c831SNamhyung Kim 		head = &fgd->hash->buckets[i];
6507b9b0c831SNamhyung Kim 		hlist_for_each_entry(entry, head, hlist) {
6508b9b0c831SNamhyung Kim 			fgd->entry = entry;
6509b9b0c831SNamhyung Kim 			fgd->idx = i;
6510b9b0c831SNamhyung Kim 			return entry;
6511b9b0c831SNamhyung Kim 		}
6512b9b0c831SNamhyung Kim 	}
6513b9b0c831SNamhyung Kim 	return NULL;
651485951842SLi Zefan }
6515ea4e2bc4SSteven Rostedt 
651685951842SLi Zefan static void *
651785951842SLi Zefan g_next(struct seq_file *m, void *v, loff_t *pos)
651885951842SLi Zefan {
651985951842SLi Zefan 	(*pos)++;
652085951842SLi Zefan 	return __g_next(m, pos);
6521ea4e2bc4SSteven Rostedt }
6522ea4e2bc4SSteven Rostedt 
6523ea4e2bc4SSteven Rostedt static void *g_start(struct seq_file *m, loff_t *pos)
6524ea4e2bc4SSteven Rostedt {
6525faf982a6SNamhyung Kim 	struct ftrace_graph_data *fgd = m->private;
6526faf982a6SNamhyung Kim 
6527ea4e2bc4SSteven Rostedt 	mutex_lock(&graph_lock);
6528ea4e2bc4SSteven Rostedt 
6529649b988bSSteven Rostedt (VMware) 	if (fgd->type == GRAPH_FILTER_FUNCTION)
6530649b988bSSteven Rostedt (VMware) 		fgd->hash = rcu_dereference_protected(ftrace_graph_hash,
6531649b988bSSteven Rostedt (VMware) 					lockdep_is_held(&graph_lock));
6532649b988bSSteven Rostedt (VMware) 	else
6533649b988bSSteven Rostedt (VMware) 		fgd->hash = rcu_dereference_protected(ftrace_graph_notrace_hash,
6534649b988bSSteven Rostedt (VMware) 					lockdep_is_held(&graph_lock));
6535649b988bSSteven Rostedt (VMware) 
6536f9349a8fSFrederic Weisbecker 	/* Nothing, tell g_show to print all functions are enabled */
6537b9b0c831SNamhyung Kim 	if (ftrace_hash_empty(fgd->hash) && !*pos)
6538555fc781SSteven Rostedt (VMware) 		return FTRACE_GRAPH_EMPTY;
6539f9349a8fSFrederic Weisbecker 
6540b9b0c831SNamhyung Kim 	fgd->idx = 0;
6541b9b0c831SNamhyung Kim 	fgd->entry = NULL;
654285951842SLi Zefan 	return __g_next(m, pos);
6543ea4e2bc4SSteven Rostedt }
6544ea4e2bc4SSteven Rostedt 
6545ea4e2bc4SSteven Rostedt static void g_stop(struct seq_file *m, void *p)
6546ea4e2bc4SSteven Rostedt {
6547ea4e2bc4SSteven Rostedt 	mutex_unlock(&graph_lock);
6548ea4e2bc4SSteven Rostedt }
6549ea4e2bc4SSteven Rostedt 
6550ea4e2bc4SSteven Rostedt static int g_show(struct seq_file *m, void *v)
6551ea4e2bc4SSteven Rostedt {
6552b9b0c831SNamhyung Kim 	struct ftrace_func_entry *entry = v;
6553ea4e2bc4SSteven Rostedt 
6554b9b0c831SNamhyung Kim 	if (!entry)
6555ea4e2bc4SSteven Rostedt 		return 0;
6556ea4e2bc4SSteven Rostedt 
6557555fc781SSteven Rostedt (VMware) 	if (entry == FTRACE_GRAPH_EMPTY) {
6558280d1429SNamhyung Kim 		struct ftrace_graph_data *fgd = m->private;
6559280d1429SNamhyung Kim 
6560b9b0c831SNamhyung Kim 		if (fgd->type == GRAPH_FILTER_FUNCTION)
6561fa6f0cc7SRasmus Villemoes 			seq_puts(m, "#### all functions enabled ####\n");
6562280d1429SNamhyung Kim 		else
6563fa6f0cc7SRasmus Villemoes 			seq_puts(m, "#### no functions disabled ####\n");
6564f9349a8fSFrederic Weisbecker 		return 0;
6565f9349a8fSFrederic Weisbecker 	}
6566f9349a8fSFrederic Weisbecker 
6567b9b0c831SNamhyung Kim 	seq_printf(m, "%ps\n", (void *)entry->ip);
6568ea4e2bc4SSteven Rostedt 
6569ea4e2bc4SSteven Rostedt 	return 0;
6570ea4e2bc4SSteven Rostedt }
6571ea4e2bc4SSteven Rostedt 
657288e9d34cSJames Morris static const struct seq_operations ftrace_graph_seq_ops = {
6573ea4e2bc4SSteven Rostedt 	.start = g_start,
6574ea4e2bc4SSteven Rostedt 	.next = g_next,
6575ea4e2bc4SSteven Rostedt 	.stop = g_stop,
6576ea4e2bc4SSteven Rostedt 	.show = g_show,
6577ea4e2bc4SSteven Rostedt };
6578ea4e2bc4SSteven Rostedt 
6579ea4e2bc4SSteven Rostedt static int
6580faf982a6SNamhyung Kim __ftrace_graph_open(struct inode *inode, struct file *file,
6581faf982a6SNamhyung Kim 		    struct ftrace_graph_data *fgd)
6582ea4e2bc4SSteven Rostedt {
658317911ff3SSteven Rostedt (VMware) 	int ret;
6584b9b0c831SNamhyung Kim 	struct ftrace_hash *new_hash = NULL;
6585ea4e2bc4SSteven Rostedt 
658617911ff3SSteven Rostedt (VMware) 	ret = security_locked_down(LOCKDOWN_TRACEFS);
658717911ff3SSteven Rostedt (VMware) 	if (ret)
658817911ff3SSteven Rostedt (VMware) 		return ret;
658917911ff3SSteven Rostedt (VMware) 
6590b9b0c831SNamhyung Kim 	if (file->f_mode & FMODE_WRITE) {
6591b9b0c831SNamhyung Kim 		const int size_bits = FTRACE_HASH_DEFAULT_BITS;
6592b9b0c831SNamhyung Kim 
6593e704eff3SSteven Rostedt (VMware) 		if (trace_parser_get_init(&fgd->parser, FTRACE_BUFF_MAX))
6594e704eff3SSteven Rostedt (VMware) 			return -ENOMEM;
6595e704eff3SSteven Rostedt (VMware) 
6596b9b0c831SNamhyung Kim 		if (file->f_flags & O_TRUNC)
6597b9b0c831SNamhyung Kim 			new_hash = alloc_ftrace_hash(size_bits);
6598b9b0c831SNamhyung Kim 		else
6599b9b0c831SNamhyung Kim 			new_hash = alloc_and_copy_ftrace_hash(size_bits,
6600b9b0c831SNamhyung Kim 							      fgd->hash);
6601b9b0c831SNamhyung Kim 		if (!new_hash) {
6602b9b0c831SNamhyung Kim 			ret = -ENOMEM;
6603b9b0c831SNamhyung Kim 			goto out;
6604ea4e2bc4SSteven Rostedt 		}
6605b9b0c831SNamhyung Kim 	}
6606ea4e2bc4SSteven Rostedt 
6607faf982a6SNamhyung Kim 	if (file->f_mode & FMODE_READ) {
6608b9b0c831SNamhyung Kim 		ret = seq_open(file, &ftrace_graph_seq_ops);
6609faf982a6SNamhyung Kim 		if (!ret) {
6610faf982a6SNamhyung Kim 			struct seq_file *m = file->private_data;
6611faf982a6SNamhyung Kim 			m->private = fgd;
6612b9b0c831SNamhyung Kim 		} else {
6613b9b0c831SNamhyung Kim 			/* Failed */
6614b9b0c831SNamhyung Kim 			free_ftrace_hash(new_hash);
6615b9b0c831SNamhyung Kim 			new_hash = NULL;
6616faf982a6SNamhyung Kim 		}
6617faf982a6SNamhyung Kim 	} else
6618faf982a6SNamhyung Kim 		file->private_data = fgd;
6619a4ec5e0cSLi Zefan 
6620b9b0c831SNamhyung Kim out:
6621e704eff3SSteven Rostedt (VMware) 	if (ret < 0 && file->f_mode & FMODE_WRITE)
6622e704eff3SSteven Rostedt (VMware) 		trace_parser_put(&fgd->parser);
6623e704eff3SSteven Rostedt (VMware) 
6624b9b0c831SNamhyung Kim 	fgd->new_hash = new_hash;
6625649b988bSSteven Rostedt (VMware) 
6626649b988bSSteven Rostedt (VMware) 	/*
6627649b988bSSteven Rostedt (VMware) 	 * All uses of fgd->hash must be taken with the graph_lock
6628649b988bSSteven Rostedt (VMware) 	 * held. The graph_lock is going to be released, so force
6629649b988bSSteven Rostedt (VMware) 	 * fgd->hash to be reinitialized when it is taken again.
6630649b988bSSteven Rostedt (VMware) 	 */
6631649b988bSSteven Rostedt (VMware) 	fgd->hash = NULL;
6632649b988bSSteven Rostedt (VMware) 
6633ea4e2bc4SSteven Rostedt 	return ret;
6634ea4e2bc4SSteven Rostedt }
6635ea4e2bc4SSteven Rostedt 
6636ea4e2bc4SSteven Rostedt static int
6637faf982a6SNamhyung Kim ftrace_graph_open(struct inode *inode, struct file *file)
6638faf982a6SNamhyung Kim {
6639faf982a6SNamhyung Kim 	struct ftrace_graph_data *fgd;
6640b9b0c831SNamhyung Kim 	int ret;
6641faf982a6SNamhyung Kim 
6642faf982a6SNamhyung Kim 	if (unlikely(ftrace_disabled))
6643faf982a6SNamhyung Kim 		return -ENODEV;
6644faf982a6SNamhyung Kim 
6645faf982a6SNamhyung Kim 	fgd = kmalloc(sizeof(*fgd), GFP_KERNEL);
6646faf982a6SNamhyung Kim 	if (fgd == NULL)
6647faf982a6SNamhyung Kim 		return -ENOMEM;
6648faf982a6SNamhyung Kim 
6649b9b0c831SNamhyung Kim 	mutex_lock(&graph_lock);
6650b9b0c831SNamhyung Kim 
6651649b988bSSteven Rostedt (VMware) 	fgd->hash = rcu_dereference_protected(ftrace_graph_hash,
6652649b988bSSteven Rostedt (VMware) 					lockdep_is_held(&graph_lock));
6653b9b0c831SNamhyung Kim 	fgd->type = GRAPH_FILTER_FUNCTION;
6654faf982a6SNamhyung Kim 	fgd->seq_ops = &ftrace_graph_seq_ops;
6655faf982a6SNamhyung Kim 
6656b9b0c831SNamhyung Kim 	ret = __ftrace_graph_open(inode, file, fgd);
6657b9b0c831SNamhyung Kim 	if (ret < 0)
6658b9b0c831SNamhyung Kim 		kfree(fgd);
6659b9b0c831SNamhyung Kim 
6660b9b0c831SNamhyung Kim 	mutex_unlock(&graph_lock);
6661b9b0c831SNamhyung Kim 	return ret;
6662faf982a6SNamhyung Kim }
6663faf982a6SNamhyung Kim 
6664faf982a6SNamhyung Kim static int
666529ad23b0SNamhyung Kim ftrace_graph_notrace_open(struct inode *inode, struct file *file)
666629ad23b0SNamhyung Kim {
666729ad23b0SNamhyung Kim 	struct ftrace_graph_data *fgd;
6668b9b0c831SNamhyung Kim 	int ret;
666929ad23b0SNamhyung Kim 
667029ad23b0SNamhyung Kim 	if (unlikely(ftrace_disabled))
667129ad23b0SNamhyung Kim 		return -ENODEV;
667229ad23b0SNamhyung Kim 
667329ad23b0SNamhyung Kim 	fgd = kmalloc(sizeof(*fgd), GFP_KERNEL);
667429ad23b0SNamhyung Kim 	if (fgd == NULL)
667529ad23b0SNamhyung Kim 		return -ENOMEM;
667629ad23b0SNamhyung Kim 
6677b9b0c831SNamhyung Kim 	mutex_lock(&graph_lock);
6678b9b0c831SNamhyung Kim 
6679649b988bSSteven Rostedt (VMware) 	fgd->hash = rcu_dereference_protected(ftrace_graph_notrace_hash,
6680649b988bSSteven Rostedt (VMware) 					lockdep_is_held(&graph_lock));
6681b9b0c831SNamhyung Kim 	fgd->type = GRAPH_FILTER_NOTRACE;
668229ad23b0SNamhyung Kim 	fgd->seq_ops = &ftrace_graph_seq_ops;
668329ad23b0SNamhyung Kim 
6684b9b0c831SNamhyung Kim 	ret = __ftrace_graph_open(inode, file, fgd);
6685b9b0c831SNamhyung Kim 	if (ret < 0)
6686b9b0c831SNamhyung Kim 		kfree(fgd);
6687b9b0c831SNamhyung Kim 
6688b9b0c831SNamhyung Kim 	mutex_unlock(&graph_lock);
6689b9b0c831SNamhyung Kim 	return ret;
669029ad23b0SNamhyung Kim }
669129ad23b0SNamhyung Kim 
669229ad23b0SNamhyung Kim static int
669387827111SLi Zefan ftrace_graph_release(struct inode *inode, struct file *file)
669487827111SLi Zefan {
6695b9b0c831SNamhyung Kim 	struct ftrace_graph_data *fgd;
6696e704eff3SSteven Rostedt (VMware) 	struct ftrace_hash *old_hash, *new_hash;
6697e704eff3SSteven Rostedt (VMware) 	struct trace_parser *parser;
6698e704eff3SSteven Rostedt (VMware) 	int ret = 0;
6699b9b0c831SNamhyung Kim 
6700faf982a6SNamhyung Kim 	if (file->f_mode & FMODE_READ) {
6701faf982a6SNamhyung Kim 		struct seq_file *m = file->private_data;
6702faf982a6SNamhyung Kim 
6703b9b0c831SNamhyung Kim 		fgd = m->private;
670487827111SLi Zefan 		seq_release(inode, file);
6705faf982a6SNamhyung Kim 	} else {
6706b9b0c831SNamhyung Kim 		fgd = file->private_data;
6707faf982a6SNamhyung Kim 	}
6708faf982a6SNamhyung Kim 
6709e704eff3SSteven Rostedt (VMware) 
6710e704eff3SSteven Rostedt (VMware) 	if (file->f_mode & FMODE_WRITE) {
6711e704eff3SSteven Rostedt (VMware) 
6712e704eff3SSteven Rostedt (VMware) 		parser = &fgd->parser;
6713e704eff3SSteven Rostedt (VMware) 
6714e704eff3SSteven Rostedt (VMware) 		if (trace_parser_loaded((parser))) {
6715e704eff3SSteven Rostedt (VMware) 			ret = ftrace_graph_set_hash(fgd->new_hash,
6716e704eff3SSteven Rostedt (VMware) 						    parser->buffer);
6717e704eff3SSteven Rostedt (VMware) 		}
6718e704eff3SSteven Rostedt (VMware) 
6719e704eff3SSteven Rostedt (VMware) 		trace_parser_put(parser);
6720e704eff3SSteven Rostedt (VMware) 
6721e704eff3SSteven Rostedt (VMware) 		new_hash = __ftrace_hash_move(fgd->new_hash);
6722e704eff3SSteven Rostedt (VMware) 		if (!new_hash) {
6723e704eff3SSteven Rostedt (VMware) 			ret = -ENOMEM;
6724e704eff3SSteven Rostedt (VMware) 			goto out;
6725e704eff3SSteven Rostedt (VMware) 		}
6726e704eff3SSteven Rostedt (VMware) 
6727e704eff3SSteven Rostedt (VMware) 		mutex_lock(&graph_lock);
6728e704eff3SSteven Rostedt (VMware) 
6729e704eff3SSteven Rostedt (VMware) 		if (fgd->type == GRAPH_FILTER_FUNCTION) {
6730e704eff3SSteven Rostedt (VMware) 			old_hash = rcu_dereference_protected(ftrace_graph_hash,
6731e704eff3SSteven Rostedt (VMware) 					lockdep_is_held(&graph_lock));
6732e704eff3SSteven Rostedt (VMware) 			rcu_assign_pointer(ftrace_graph_hash, new_hash);
6733e704eff3SSteven Rostedt (VMware) 		} else {
6734e704eff3SSteven Rostedt (VMware) 			old_hash = rcu_dereference_protected(ftrace_graph_notrace_hash,
6735e704eff3SSteven Rostedt (VMware) 					lockdep_is_held(&graph_lock));
6736e704eff3SSteven Rostedt (VMware) 			rcu_assign_pointer(ftrace_graph_notrace_hash, new_hash);
6737e704eff3SSteven Rostedt (VMware) 		}
6738e704eff3SSteven Rostedt (VMware) 
6739e704eff3SSteven Rostedt (VMware) 		mutex_unlock(&graph_lock);
6740e704eff3SSteven Rostedt (VMware) 
674154a16ff6SSteven Rostedt (VMware) 		/*
674254a16ff6SSteven Rostedt (VMware) 		 * We need to do a hard force of sched synchronization.
674354a16ff6SSteven Rostedt (VMware) 		 * This is because we use preempt_disable() to do RCU, but
674454a16ff6SSteven Rostedt (VMware) 		 * the function tracers can be called where RCU is not watching
674554a16ff6SSteven Rostedt (VMware) 		 * (like before user_exit()). We can not rely on the RCU
674654a16ff6SSteven Rostedt (VMware) 		 * infrastructure to do the synchronization, thus we must do it
674754a16ff6SSteven Rostedt (VMware) 		 * ourselves.
674854a16ff6SSteven Rostedt (VMware) 		 */
674968e83498SNicolas Saenz Julienne 		if (old_hash != EMPTY_HASH)
6750e5a971d7SPaul E. McKenney 			synchronize_rcu_tasks_rude();
6751e704eff3SSteven Rostedt (VMware) 
6752e704eff3SSteven Rostedt (VMware) 		free_ftrace_hash(old_hash);
6753e704eff3SSteven Rostedt (VMware) 	}
6754e704eff3SSteven Rostedt (VMware) 
6755e704eff3SSteven Rostedt (VMware)  out:
6756f9797c2fSLuis Henriques 	free_ftrace_hash(fgd->new_hash);
6757b9b0c831SNamhyung Kim 	kfree(fgd);
6758b9b0c831SNamhyung Kim 
6759e704eff3SSteven Rostedt (VMware) 	return ret;
676087827111SLi Zefan }
676187827111SLi Zefan 
676287827111SLi Zefan static int
6763b9b0c831SNamhyung Kim ftrace_graph_set_hash(struct ftrace_hash *hash, char *buffer)
6764ea4e2bc4SSteven Rostedt {
67653ba00929SDmitry Safonov 	struct ftrace_glob func_g;
6766ea4e2bc4SSteven Rostedt 	struct dyn_ftrace *rec;
6767ea4e2bc4SSteven Rostedt 	struct ftrace_page *pg;
6768b9b0c831SNamhyung Kim 	struct ftrace_func_entry *entry;
6769c7c6b1feSLi Zefan 	int fail = 1;
67703ba00929SDmitry Safonov 	int not;
6771ea4e2bc4SSteven Rostedt 
6772f9349a8fSFrederic Weisbecker 	/* decode regex */
67733ba00929SDmitry Safonov 	func_g.type = filter_parse_regex(buffer, strlen(buffer),
67743ba00929SDmitry Safonov 					 &func_g.search, &not);
6775f9349a8fSFrederic Weisbecker 
67763ba00929SDmitry Safonov 	func_g.len = strlen(func_g.search);
6777f9349a8fSFrederic Weisbecker 
677852baf119SSteven Rostedt 	mutex_lock(&ftrace_lock);
677945a4a237SSteven Rostedt 
678045a4a237SSteven Rostedt 	if (unlikely(ftrace_disabled)) {
678145a4a237SSteven Rostedt 		mutex_unlock(&ftrace_lock);
678245a4a237SSteven Rostedt 		return -ENODEV;
678345a4a237SSteven Rostedt 	}
678445a4a237SSteven Rostedt 
6785265c831cSSteven Rostedt 	do_for_each_ftrace_rec(pg, rec) {
6786ea4e2bc4SSteven Rostedt 
6787546fece4SSteven Rostedt (Red Hat) 		if (rec->flags & FTRACE_FL_DISABLED)
6788546fece4SSteven Rostedt (Red Hat) 			continue;
6789546fece4SSteven Rostedt (Red Hat) 
67900b507e1eSDmitry Safonov 		if (ftrace_match_record(rec, &func_g, NULL, 0)) {
6791b9b0c831SNamhyung Kim 			entry = ftrace_lookup_ip(hash, rec->ip);
6792c7c6b1feSLi Zefan 
6793c7c6b1feSLi Zefan 			if (!not) {
6794c7c6b1feSLi Zefan 				fail = 0;
6795b9b0c831SNamhyung Kim 
6796b9b0c831SNamhyung Kim 				if (entry)
6797b9b0c831SNamhyung Kim 					continue;
6798d05cb470SSteven Rostedt (Google) 				if (add_hash_entry(hash, rec->ip) == NULL)
6799c7c6b1feSLi Zefan 					goto out;
6800c7c6b1feSLi Zefan 			} else {
6801b9b0c831SNamhyung Kim 				if (entry) {
6802b9b0c831SNamhyung Kim 					free_hash_entry(hash, entry);
6803c7c6b1feSLi Zefan 					fail = 0;
6804c7c6b1feSLi Zefan 				}
6805c7c6b1feSLi Zefan 			}
6806f9349a8fSFrederic Weisbecker 		}
6807265c831cSSteven Rostedt 	} while_for_each_ftrace_rec();
6808c7c6b1feSLi Zefan out:
680952baf119SSteven Rostedt 	mutex_unlock(&ftrace_lock);
6810ea4e2bc4SSteven Rostedt 
6811c7c6b1feSLi Zefan 	if (fail)
6812c7c6b1feSLi Zefan 		return -EINVAL;
6813c7c6b1feSLi Zefan 
6814c7c6b1feSLi Zefan 	return 0;
6815ea4e2bc4SSteven Rostedt }
6816ea4e2bc4SSteven Rostedt 
6817ea4e2bc4SSteven Rostedt static ssize_t
6818ea4e2bc4SSteven Rostedt ftrace_graph_write(struct file *file, const char __user *ubuf,
6819ea4e2bc4SSteven Rostedt 		   size_t cnt, loff_t *ppos)
6820ea4e2bc4SSteven Rostedt {
68216a10108bSNamhyung Kim 	ssize_t read, ret = 0;
6822faf982a6SNamhyung Kim 	struct ftrace_graph_data *fgd = file->private_data;
6823e704eff3SSteven Rostedt (VMware) 	struct trace_parser *parser;
6824ea4e2bc4SSteven Rostedt 
6825c7c6b1feSLi Zefan 	if (!cnt)
6826ea4e2bc4SSteven Rostedt 		return 0;
6827ea4e2bc4SSteven Rostedt 
6828ae98d27aSSteven Rostedt (VMware) 	/* Read mode uses seq functions */
6829ae98d27aSSteven Rostedt (VMware) 	if (file->f_mode & FMODE_READ) {
6830ae98d27aSSteven Rostedt (VMware) 		struct seq_file *m = file->private_data;
6831ae98d27aSSteven Rostedt (VMware) 		fgd = m->private;
6832ae98d27aSSteven Rostedt (VMware) 	}
6833ae98d27aSSteven Rostedt (VMware) 
6834e704eff3SSteven Rostedt (VMware) 	parser = &fgd->parser;
6835689fd8b6S[email protected] 
6836e704eff3SSteven Rostedt (VMware) 	read = trace_get_user(parser, ubuf, cnt, ppos);
6837ea4e2bc4SSteven Rostedt 
6838e704eff3SSteven Rostedt (VMware) 	if (read >= 0 && trace_parser_loaded(parser) &&
6839e704eff3SSteven Rostedt (VMware) 	    !trace_parser_cont(parser)) {
68406a10108bSNamhyung Kim 
6841b9b0c831SNamhyung Kim 		ret = ftrace_graph_set_hash(fgd->new_hash,
6842e704eff3SSteven Rostedt (VMware) 					    parser->buffer);
6843e704eff3SSteven Rostedt (VMware) 		trace_parser_clear(parser);
6844689fd8b6S[email protected] 	}
6845ea4e2bc4SSteven Rostedt 
68466a10108bSNamhyung Kim 	if (!ret)
6847ea4e2bc4SSteven Rostedt 		ret = read;
68481eb90f13SLi Zefan 
6849ea4e2bc4SSteven Rostedt 	return ret;
6850ea4e2bc4SSteven Rostedt }
6851ea4e2bc4SSteven Rostedt 
6852ea4e2bc4SSteven Rostedt static const struct file_operations ftrace_graph_fops = {
6853ea4e2bc4SSteven Rostedt 	.open		= ftrace_graph_open,
6854850a80cfSLai Jiangshan 	.read		= seq_read,
6855ea4e2bc4SSteven Rostedt 	.write		= ftrace_graph_write,
6856098c879eSSteven Rostedt (Red Hat) 	.llseek		= tracing_lseek,
685787827111SLi Zefan 	.release	= ftrace_graph_release,
6858ea4e2bc4SSteven Rostedt };
685929ad23b0SNamhyung Kim 
686029ad23b0SNamhyung Kim static const struct file_operations ftrace_graph_notrace_fops = {
686129ad23b0SNamhyung Kim 	.open		= ftrace_graph_notrace_open,
686229ad23b0SNamhyung Kim 	.read		= seq_read,
686329ad23b0SNamhyung Kim 	.write		= ftrace_graph_write,
6864098c879eSSteven Rostedt (Red Hat) 	.llseek		= tracing_lseek,
686529ad23b0SNamhyung Kim 	.release	= ftrace_graph_release,
686629ad23b0SNamhyung Kim };
6867ea4e2bc4SSteven Rostedt #endif /* CONFIG_FUNCTION_GRAPH_TRACER */
6868ea4e2bc4SSteven Rostedt 
6869591dffdaSSteven Rostedt (Red Hat) void ftrace_create_filter_files(struct ftrace_ops *ops,
6870591dffdaSSteven Rostedt (Red Hat) 				struct dentry *parent)
6871591dffdaSSteven Rostedt (Red Hat) {
6872591dffdaSSteven Rostedt (Red Hat) 
687321ccc9cdSSteven Rostedt (VMware) 	trace_create_file("set_ftrace_filter", TRACE_MODE_WRITE, parent,
6874591dffdaSSteven Rostedt (Red Hat) 			  ops, &ftrace_filter_fops);
6875591dffdaSSteven Rostedt (Red Hat) 
687621ccc9cdSSteven Rostedt (VMware) 	trace_create_file("set_ftrace_notrace", TRACE_MODE_WRITE, parent,
6877591dffdaSSteven Rostedt (Red Hat) 			  ops, &ftrace_notrace_fops);
6878591dffdaSSteven Rostedt (Red Hat) }
6879591dffdaSSteven Rostedt (Red Hat) 
6880591dffdaSSteven Rostedt (Red Hat) /*
6881591dffdaSSteven Rostedt (Red Hat)  * The name "destroy_filter_files" is really a misnomer. Although
68829efb85c5SHariprasad Kelam  * in the future, it may actually delete the files, but this is
6883591dffdaSSteven Rostedt (Red Hat)  * really intended to make sure the ops passed in are disabled
6884591dffdaSSteven Rostedt (Red Hat)  * and that when this function returns, the caller is free to
6885591dffdaSSteven Rostedt (Red Hat)  * free the ops.
6886591dffdaSSteven Rostedt (Red Hat)  *
6887591dffdaSSteven Rostedt (Red Hat)  * The "destroy" name is only to match the "create" name that this
6888591dffdaSSteven Rostedt (Red Hat)  * should be paired with.
6889591dffdaSSteven Rostedt (Red Hat)  */
6890591dffdaSSteven Rostedt (Red Hat) void ftrace_destroy_filter_files(struct ftrace_ops *ops)
6891591dffdaSSteven Rostedt (Red Hat) {
6892591dffdaSSteven Rostedt (Red Hat) 	mutex_lock(&ftrace_lock);
6893591dffdaSSteven Rostedt (Red Hat) 	if (ops->flags & FTRACE_OPS_FL_ENABLED)
6894591dffdaSSteven Rostedt (Red Hat) 		ftrace_shutdown(ops, 0);
6895591dffdaSSteven Rostedt (Red Hat) 	ops->flags |= FTRACE_OPS_FL_DELETED;
68962840f84fSSteven Rostedt (VMware) 	ftrace_free_filter(ops);
6897591dffdaSSteven Rostedt (Red Hat) 	mutex_unlock(&ftrace_lock);
6898591dffdaSSteven Rostedt (Red Hat) }
6899591dffdaSSteven Rostedt (Red Hat) 
69008434dc93SSteven Rostedt (Red Hat) static __init int ftrace_init_dyn_tracefs(struct dentry *d_tracer)
69015072c59fSSteven Rostedt {
69025072c59fSSteven Rostedt 
690321ccc9cdSSteven Rostedt (VMware) 	trace_create_file("available_filter_functions", TRACE_MODE_READ,
69045072c59fSSteven Rostedt 			d_tracer, NULL, &ftrace_avail_fops);
69055072c59fSSteven Rostedt 
690683f74441SJiri Olsa 	trace_create_file("available_filter_functions_addrs", TRACE_MODE_READ,
690783f74441SJiri Olsa 			d_tracer, NULL, &ftrace_avail_addrs_fops);
690883f74441SJiri Olsa 
690921ccc9cdSSteven Rostedt (VMware) 	trace_create_file("enabled_functions", TRACE_MODE_READ,
6910647bcd03SSteven Rostedt 			d_tracer, NULL, &ftrace_enabled_fops);
6911647bcd03SSteven Rostedt 
6912e11b521aSSteven Rostedt (Google) 	trace_create_file("touched_functions", TRACE_MODE_READ,
6913e11b521aSSteven Rostedt (Google) 			d_tracer, NULL, &ftrace_touched_fops);
6914e11b521aSSteven Rostedt (Google) 
6915591dffdaSSteven Rostedt (Red Hat) 	ftrace_create_filter_files(&global_ops, d_tracer);
6916ad90c0e3SSteven Rostedt 
6917ea4e2bc4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
691821ccc9cdSSteven Rostedt (VMware) 	trace_create_file("set_graph_function", TRACE_MODE_WRITE, d_tracer,
6919ea4e2bc4SSteven Rostedt 				    NULL,
6920ea4e2bc4SSteven Rostedt 				    &ftrace_graph_fops);
692121ccc9cdSSteven Rostedt (VMware) 	trace_create_file("set_graph_notrace", TRACE_MODE_WRITE, d_tracer,
692229ad23b0SNamhyung Kim 				    NULL,
692329ad23b0SNamhyung Kim 				    &ftrace_graph_notrace_fops);
6924ea4e2bc4SSteven Rostedt #endif /* CONFIG_FUNCTION_GRAPH_TRACER */
6925ea4e2bc4SSteven Rostedt 
69265072c59fSSteven Rostedt 	return 0;
69275072c59fSSteven Rostedt }
69285072c59fSSteven Rostedt 
69299fd49328SSteven Rostedt static int ftrace_cmp_ips(const void *a, const void *b)
693068950619SSteven Rostedt {
69319fd49328SSteven Rostedt 	const unsigned long *ipa = a;
69329fd49328SSteven Rostedt 	const unsigned long *ipb = b;
693368950619SSteven Rostedt 
69349fd49328SSteven Rostedt 	if (*ipa > *ipb)
69359fd49328SSteven Rostedt 		return 1;
69369fd49328SSteven Rostedt 	if (*ipa < *ipb)
69379fd49328SSteven Rostedt 		return -1;
69389fd49328SSteven Rostedt 	return 0;
69399fd49328SSteven Rostedt }
69409fd49328SSteven Rostedt 
69418147dc78SSteven Rostedt (VMware) #ifdef CONFIG_FTRACE_SORT_STARTUP_TEST
69428147dc78SSteven Rostedt (VMware) static void test_is_sorted(unsigned long *start, unsigned long count)
69438147dc78SSteven Rostedt (VMware) {
69448147dc78SSteven Rostedt (VMware) 	int i;
69458147dc78SSteven Rostedt (VMware) 
69468147dc78SSteven Rostedt (VMware) 	for (i = 1; i < count; i++) {
69478147dc78SSteven Rostedt (VMware) 		if (WARN(start[i - 1] > start[i],
69488147dc78SSteven Rostedt (VMware) 			 "[%d] %pS at %lx is not sorted with %pS at %lx\n", i,
69498147dc78SSteven Rostedt (VMware) 			 (void *)start[i - 1], start[i - 1],
69508147dc78SSteven Rostedt (VMware) 			 (void *)start[i], start[i]))
69518147dc78SSteven Rostedt (VMware) 			break;
69528147dc78SSteven Rostedt (VMware) 	}
69538147dc78SSteven Rostedt (VMware) 	if (i == count)
69548147dc78SSteven Rostedt (VMware) 		pr_info("ftrace section at %px sorted properly\n", start);
69558147dc78SSteven Rostedt (VMware) }
69568147dc78SSteven Rostedt (VMware) #else
69578147dc78SSteven Rostedt (VMware) static void test_is_sorted(unsigned long *start, unsigned long count)
69588147dc78SSteven Rostedt (VMware) {
69598147dc78SSteven Rostedt (VMware) }
69608147dc78SSteven Rostedt (VMware) #endif
69618147dc78SSteven Rostedt (VMware) 
69625cb084bbSJiri Olsa static int ftrace_process_locs(struct module *mod,
696331e88909SSteven Rostedt 			       unsigned long *start,
696468bf21aaSSteven Rostedt 			       unsigned long *end)
696568bf21aaSSteven Rostedt {
696626efd79cSZheng Yejian 	struct ftrace_page *pg_unuse = NULL;
6967706c81f8SSteven Rostedt 	struct ftrace_page *start_pg;
6968a7900875SSteven Rostedt 	struct ftrace_page *pg;
6969706c81f8SSteven Rostedt 	struct dyn_ftrace *rec;
697026efd79cSZheng Yejian 	unsigned long skipped = 0;
6971a7900875SSteven Rostedt 	unsigned long count;
697268bf21aaSSteven Rostedt 	unsigned long *p;
697368bf21aaSSteven Rostedt 	unsigned long addr;
69744376cac6SSteven Rostedt 	unsigned long flags = 0; /* Shut up gcc */
6975a7900875SSteven Rostedt 	int ret = -ENOMEM;
6976a7900875SSteven Rostedt 
6977a7900875SSteven Rostedt 	count = end - start;
6978a7900875SSteven Rostedt 
6979a7900875SSteven Rostedt 	if (!count)
6980a7900875SSteven Rostedt 		return 0;
6981a7900875SSteven Rostedt 
698272b3942aSYinan Liu 	/*
698372b3942aSYinan Liu 	 * Sorting mcount in vmlinux at build time depend on
69846b9b6413SSteven Rostedt (Google) 	 * CONFIG_BUILDTIME_MCOUNT_SORT, while mcount loc in
698572b3942aSYinan Liu 	 * modules can not be sorted at build time.
698672b3942aSYinan Liu 	 */
69876b9b6413SSteven Rostedt (Google) 	if (!IS_ENABLED(CONFIG_BUILDTIME_MCOUNT_SORT) || mod) {
69889fd49328SSteven Rostedt 		sort(start, count, sizeof(*start),
69896db02903SRasmus Villemoes 		     ftrace_cmp_ips, NULL);
69908147dc78SSteven Rostedt (VMware) 	} else {
69918147dc78SSteven Rostedt (VMware) 		test_is_sorted(start, count);
699272b3942aSYinan Liu 	}
69939fd49328SSteven Rostedt 
6994706c81f8SSteven Rostedt 	start_pg = ftrace_allocate_pages(count);
6995706c81f8SSteven Rostedt 	if (!start_pg)
6996a7900875SSteven Rostedt 		return -ENOMEM;
699768bf21aaSSteven Rostedt 
6998e6ea44e9SSteven Rostedt 	mutex_lock(&ftrace_lock);
6999a7900875SSteven Rostedt 
700032082309SSteven Rostedt 	/*
700132082309SSteven Rostedt 	 * Core and each module needs their own pages, as
700232082309SSteven Rostedt 	 * modules will free them when they are removed.
700332082309SSteven Rostedt 	 * Force a new page to be allocated for modules.
700432082309SSteven Rostedt 	 */
7005a7900875SSteven Rostedt 	if (!mod) {
7006a7900875SSteven Rostedt 		WARN_ON(ftrace_pages || ftrace_pages_start);
7007a7900875SSteven Rostedt 		/* First initialization */
7008706c81f8SSteven Rostedt 		ftrace_pages = ftrace_pages_start = start_pg;
7009a7900875SSteven Rostedt 	} else {
701032082309SSteven Rostedt 		if (!ftrace_pages)
7011a7900875SSteven Rostedt 			goto out;
701232082309SSteven Rostedt 
7013a7900875SSteven Rostedt 		if (WARN_ON(ftrace_pages->next)) {
7014a7900875SSteven Rostedt 			/* Hmm, we have free pages? */
7015a7900875SSteven Rostedt 			while (ftrace_pages->next)
701632082309SSteven Rostedt 				ftrace_pages = ftrace_pages->next;
701732082309SSteven Rostedt 		}
7018a7900875SSteven Rostedt 
7019706c81f8SSteven Rostedt 		ftrace_pages->next = start_pg;
702032082309SSteven Rostedt 	}
702132082309SSteven Rostedt 
702268bf21aaSSteven Rostedt 	p = start;
7023706c81f8SSteven Rostedt 	pg = start_pg;
702468bf21aaSSteven Rostedt 	while (p < end) {
7025db42523bSLinus Torvalds 		unsigned long end_offset;
702668bf21aaSSteven Rostedt 		addr = ftrace_call_adjust(*p++);
702720e5227eSSteven Rostedt 		/*
702820e5227eSSteven Rostedt 		 * Some architecture linkers will pad between
702920e5227eSSteven Rostedt 		 * the different mcount_loc sections of different
703020e5227eSSteven Rostedt 		 * object files to satisfy alignments.
703120e5227eSSteven Rostedt 		 * Skip any NULL pointers.
703220e5227eSSteven Rostedt 		 */
703326efd79cSZheng Yejian 		if (!addr) {
703426efd79cSZheng Yejian 			skipped++;
703520e5227eSSteven Rostedt 			continue;
703626efd79cSZheng Yejian 		}
7037706c81f8SSteven Rostedt 
7038db42523bSLinus Torvalds 		end_offset = (pg->index+1) * sizeof(pg->records[0]);
7039db42523bSLinus Torvalds 		if (end_offset > PAGE_SIZE << pg->order) {
7040706c81f8SSteven Rostedt 			/* We should have allocated enough */
7041706c81f8SSteven Rostedt 			if (WARN_ON(!pg->next))
7042a7900875SSteven Rostedt 				break;
7043706c81f8SSteven Rostedt 			pg = pg->next;
704468bf21aaSSteven Rostedt 		}
704568bf21aaSSteven Rostedt 
7046706c81f8SSteven Rostedt 		rec = &pg->records[pg->index++];
7047706c81f8SSteven Rostedt 		rec->ip = addr;
7048706c81f8SSteven Rostedt 	}
7049706c81f8SSteven Rostedt 
705026efd79cSZheng Yejian 	if (pg->next) {
705126efd79cSZheng Yejian 		pg_unuse = pg->next;
705226efd79cSZheng Yejian 		pg->next = NULL;
705326efd79cSZheng Yejian 	}
7054706c81f8SSteven Rostedt 
7055706c81f8SSteven Rostedt 	/* Assign the last page to ftrace_pages */
7056706c81f8SSteven Rostedt 	ftrace_pages = pg;
7057706c81f8SSteven Rostedt 
7058a4f18ed1SSteven Rostedt 	/*
70594376cac6SSteven Rostedt 	 * We only need to disable interrupts on start up
70604376cac6SSteven Rostedt 	 * because we are modifying code that an interrupt
70614376cac6SSteven Rostedt 	 * may execute, and the modification is not atomic.
70624376cac6SSteven Rostedt 	 * But for modules, nothing runs the code we modify
70634376cac6SSteven Rostedt 	 * until we are finished with it, and there's no
70644376cac6SSteven Rostedt 	 * reason to cause large interrupt latencies while we do it.
7065a4f18ed1SSteven Rostedt 	 */
70664376cac6SSteven Rostedt 	if (!mod)
7067a4f18ed1SSteven Rostedt 		local_irq_save(flags);
70681dc43cf0SJiri Slaby 	ftrace_update_code(mod, start_pg);
70694376cac6SSteven Rostedt 	if (!mod)
7070a4f18ed1SSteven Rostedt 		local_irq_restore(flags);
7071a7900875SSteven Rostedt 	ret = 0;
7072a7900875SSteven Rostedt  out:
7073e6ea44e9SSteven Rostedt 	mutex_unlock(&ftrace_lock);
707468bf21aaSSteven Rostedt 
707526efd79cSZheng Yejian 	/* We should have used all pages unless we skipped some */
707626efd79cSZheng Yejian 	if (pg_unuse) {
707726efd79cSZheng Yejian 		WARN_ON(!skipped);
7078e60b613dSZheng Yejian 		/* Need to synchronize with ftrace_location_range() */
7079e60b613dSZheng Yejian 		synchronize_rcu();
708026efd79cSZheng Yejian 		ftrace_free_pages(pg_unuse);
708126efd79cSZheng Yejian 	}
7082a7900875SSteven Rostedt 	return ret;
708368bf21aaSSteven Rostedt }
708468bf21aaSSteven Rostedt 
7085aba4b5c2SSteven Rostedt (VMware) struct ftrace_mod_func {
7086aba4b5c2SSteven Rostedt (VMware) 	struct list_head	list;
7087aba4b5c2SSteven Rostedt (VMware) 	char			*name;
7088aba4b5c2SSteven Rostedt (VMware) 	unsigned long		ip;
7089aba4b5c2SSteven Rostedt (VMware) 	unsigned int		size;
7090aba4b5c2SSteven Rostedt (VMware) };
7091aba4b5c2SSteven Rostedt (VMware) 
7092aba4b5c2SSteven Rostedt (VMware) struct ftrace_mod_map {
70936aa69784SSteven Rostedt (VMware) 	struct rcu_head		rcu;
7094aba4b5c2SSteven Rostedt (VMware) 	struct list_head	list;
7095aba4b5c2SSteven Rostedt (VMware) 	struct module		*mod;
7096aba4b5c2SSteven Rostedt (VMware) 	unsigned long		start_addr;
7097aba4b5c2SSteven Rostedt (VMware) 	unsigned long		end_addr;
7098aba4b5c2SSteven Rostedt (VMware) 	struct list_head	funcs;
70996171a031SSteven Rostedt (VMware) 	unsigned int		num_funcs;
7100aba4b5c2SSteven Rostedt (VMware) };
7101aba4b5c2SSteven Rostedt (VMware) 
7102fc0ea795SAdrian Hunter static int ftrace_get_trampoline_kallsym(unsigned int symnum,
7103fc0ea795SAdrian Hunter 					 unsigned long *value, char *type,
7104fc0ea795SAdrian Hunter 					 char *name, char *module_name,
7105fc0ea795SAdrian Hunter 					 int *exported)
7106fc0ea795SAdrian Hunter {
7107fc0ea795SAdrian Hunter 	struct ftrace_ops *op;
7108fc0ea795SAdrian Hunter 
7109fc0ea795SAdrian Hunter 	list_for_each_entry_rcu(op, &ftrace_ops_trampoline_list, list) {
7110fc0ea795SAdrian Hunter 		if (!op->trampoline || symnum--)
7111fc0ea795SAdrian Hunter 			continue;
7112fc0ea795SAdrian Hunter 		*value = op->trampoline;
7113fc0ea795SAdrian Hunter 		*type = 't';
7114d0c2d66fSAzeem Shaikh 		strscpy(name, FTRACE_TRAMPOLINE_SYM, KSYM_NAME_LEN);
7115d0c2d66fSAzeem Shaikh 		strscpy(module_name, FTRACE_TRAMPOLINE_MOD, MODULE_NAME_LEN);
7116fc0ea795SAdrian Hunter 		*exported = 0;
7117fc0ea795SAdrian Hunter 		return 0;
7118fc0ea795SAdrian Hunter 	}
7119fc0ea795SAdrian Hunter 
7120fc0ea795SAdrian Hunter 	return -ERANGE;
7121fc0ea795SAdrian Hunter }
7122fc0ea795SAdrian Hunter 
7123123d6455SWang Jingjin #if defined(CONFIG_DYNAMIC_FTRACE_WITH_DIRECT_CALLS) || defined(CONFIG_MODULES)
7124123d6455SWang Jingjin /*
7125123d6455SWang Jingjin  * Check if the current ops references the given ip.
7126123d6455SWang Jingjin  *
7127123d6455SWang Jingjin  * If the ops traces all functions, then it was already accounted for.
7128123d6455SWang Jingjin  * If the ops does not trace the current record function, skip it.
7129123d6455SWang Jingjin  * If the ops ignores the function via notrace filter, skip it.
7130123d6455SWang Jingjin  */
7131123d6455SWang Jingjin static bool
7132123d6455SWang Jingjin ops_references_ip(struct ftrace_ops *ops, unsigned long ip)
7133123d6455SWang Jingjin {
7134123d6455SWang Jingjin 	/* If ops isn't enabled, ignore it */
7135123d6455SWang Jingjin 	if (!(ops->flags & FTRACE_OPS_FL_ENABLED))
7136123d6455SWang Jingjin 		return false;
7137123d6455SWang Jingjin 
7138123d6455SWang Jingjin 	/* If ops traces all then it includes this function */
7139123d6455SWang Jingjin 	if (ops_traces_mod(ops))
7140123d6455SWang Jingjin 		return true;
7141123d6455SWang Jingjin 
7142123d6455SWang Jingjin 	/* The function must be in the filter */
7143123d6455SWang Jingjin 	if (!ftrace_hash_empty(ops->func_hash->filter_hash) &&
7144123d6455SWang Jingjin 	    !__ftrace_lookup_ip(ops->func_hash->filter_hash, ip))
7145123d6455SWang Jingjin 		return false;
7146123d6455SWang Jingjin 
7147123d6455SWang Jingjin 	/* If in notrace hash, we ignore it too */
7148123d6455SWang Jingjin 	if (ftrace_lookup_ip(ops->func_hash->notrace_hash, ip))
7149123d6455SWang Jingjin 		return false;
7150123d6455SWang Jingjin 
7151123d6455SWang Jingjin 	return true;
7152123d6455SWang Jingjin }
7153123d6455SWang Jingjin #endif
7154123d6455SWang Jingjin 
715593eb677dSSteven Rostedt #ifdef CONFIG_MODULES
715632082309SSteven Rostedt 
715732082309SSteven Rostedt #define next_to_ftrace_page(p) container_of(p, struct ftrace_page, next)
715832082309SSteven Rostedt 
71596aa69784SSteven Rostedt (VMware) static LIST_HEAD(ftrace_mod_maps);
71606aa69784SSteven Rostedt (VMware) 
7161b7ffffbbSSteven Rostedt (Red Hat) static int referenced_filters(struct dyn_ftrace *rec)
7162b7ffffbbSSteven Rostedt (Red Hat) {
7163b7ffffbbSSteven Rostedt (Red Hat) 	struct ftrace_ops *ops;
7164b7ffffbbSSteven Rostedt (Red Hat) 	int cnt = 0;
7165b7ffffbbSSteven Rostedt (Red Hat) 
7166b7ffffbbSSteven Rostedt (Red Hat) 	for (ops = ftrace_ops_list; ops != &ftrace_list_end; ops = ops->next) {
7167123d6455SWang Jingjin 		if (ops_references_ip(ops, rec->ip)) {
7168c5f51572SChengming Zhou 			if (WARN_ON_ONCE(ops->flags & FTRACE_OPS_FL_DIRECT))
7169c5f51572SChengming Zhou 				continue;
7170c5f51572SChengming Zhou 			if (WARN_ON_ONCE(ops->flags & FTRACE_OPS_FL_IPMODIFY))
7171c5f51572SChengming Zhou 				continue;
7172b7ffffbbSSteven Rostedt (Red Hat) 			cnt++;
71738a224ffbSChengming Zhou 			if (ops->flags & FTRACE_OPS_FL_SAVE_REGS)
71748a224ffbSChengming Zhou 				rec->flags |= FTRACE_FL_REGS;
7175c5f51572SChengming Zhou 			if (cnt == 1 && ops->trampoline)
7176c5f51572SChengming Zhou 				rec->flags |= FTRACE_FL_TRAMP;
7177c5f51572SChengming Zhou 			else
7178c5f51572SChengming Zhou 				rec->flags &= ~FTRACE_FL_TRAMP;
71798a224ffbSChengming Zhou 		}
7180b7ffffbbSSteven Rostedt (Red Hat) 	}
7181b7ffffbbSSteven Rostedt (Red Hat) 
7182b7ffffbbSSteven Rostedt (Red Hat) 	return cnt;
7183b7ffffbbSSteven Rostedt (Red Hat) }
7184b7ffffbbSSteven Rostedt (Red Hat) 
71852a5bfe47SSteven Rostedt (VMware) static void
71862a5bfe47SSteven Rostedt (VMware) clear_mod_from_hash(struct ftrace_page *pg, struct ftrace_hash *hash)
71872a5bfe47SSteven Rostedt (VMware) {
71882a5bfe47SSteven Rostedt (VMware) 	struct ftrace_func_entry *entry;
71892a5bfe47SSteven Rostedt (VMware) 	struct dyn_ftrace *rec;
71902a5bfe47SSteven Rostedt (VMware) 	int i;
71912a5bfe47SSteven Rostedt (VMware) 
71922a5bfe47SSteven Rostedt (VMware) 	if (ftrace_hash_empty(hash))
71932a5bfe47SSteven Rostedt (VMware) 		return;
71942a5bfe47SSteven Rostedt (VMware) 
71952a5bfe47SSteven Rostedt (VMware) 	for (i = 0; i < pg->index; i++) {
71962a5bfe47SSteven Rostedt (VMware) 		rec = &pg->records[i];
71972a5bfe47SSteven Rostedt (VMware) 		entry = __ftrace_lookup_ip(hash, rec->ip);
71982a5bfe47SSteven Rostedt (VMware) 		/*
71992a5bfe47SSteven Rostedt (VMware) 		 * Do not allow this rec to match again.
72002a5bfe47SSteven Rostedt (VMware) 		 * Yeah, it may waste some memory, but will be removed
72012a5bfe47SSteven Rostedt (VMware) 		 * if/when the hash is modified again.
72022a5bfe47SSteven Rostedt (VMware) 		 */
72032a5bfe47SSteven Rostedt (VMware) 		if (entry)
72042a5bfe47SSteven Rostedt (VMware) 			entry->ip = 0;
72052a5bfe47SSteven Rostedt (VMware) 	}
72062a5bfe47SSteven Rostedt (VMware) }
72072a5bfe47SSteven Rostedt (VMware) 
7208f2cc020dSIngo Molnar /* Clear any records from hashes */
72092a5bfe47SSteven Rostedt (VMware) static void clear_mod_from_hashes(struct ftrace_page *pg)
72102a5bfe47SSteven Rostedt (VMware) {
72112a5bfe47SSteven Rostedt (VMware) 	struct trace_array *tr;
72122a5bfe47SSteven Rostedt (VMware) 
72132a5bfe47SSteven Rostedt (VMware) 	mutex_lock(&trace_types_lock);
72142a5bfe47SSteven Rostedt (VMware) 	list_for_each_entry(tr, &ftrace_trace_arrays, list) {
72152a5bfe47SSteven Rostedt (VMware) 		if (!tr->ops || !tr->ops->func_hash)
72162a5bfe47SSteven Rostedt (VMware) 			continue;
72172a5bfe47SSteven Rostedt (VMware) 		mutex_lock(&tr->ops->func_hash->regex_lock);
72182a5bfe47SSteven Rostedt (VMware) 		clear_mod_from_hash(pg, tr->ops->func_hash->filter_hash);
72192a5bfe47SSteven Rostedt (VMware) 		clear_mod_from_hash(pg, tr->ops->func_hash->notrace_hash);
72202a5bfe47SSteven Rostedt (VMware) 		mutex_unlock(&tr->ops->func_hash->regex_lock);
72212a5bfe47SSteven Rostedt (VMware) 	}
72222a5bfe47SSteven Rostedt (VMware) 	mutex_unlock(&trace_types_lock);
72232a5bfe47SSteven Rostedt (VMware) }
72242a5bfe47SSteven Rostedt (VMware) 
72256aa69784SSteven Rostedt (VMware) static void ftrace_free_mod_map(struct rcu_head *rcu)
72266aa69784SSteven Rostedt (VMware) {
72276aa69784SSteven Rostedt (VMware) 	struct ftrace_mod_map *mod_map = container_of(rcu, struct ftrace_mod_map, rcu);
72286aa69784SSteven Rostedt (VMware) 	struct ftrace_mod_func *mod_func;
72296aa69784SSteven Rostedt (VMware) 	struct ftrace_mod_func *n;
72306aa69784SSteven Rostedt (VMware) 
72316aa69784SSteven Rostedt (VMware) 	/* All the contents of mod_map are now not visible to readers */
72326aa69784SSteven Rostedt (VMware) 	list_for_each_entry_safe(mod_func, n, &mod_map->funcs, list) {
72336aa69784SSteven Rostedt (VMware) 		kfree(mod_func->name);
72346aa69784SSteven Rostedt (VMware) 		list_del(&mod_func->list);
72356aa69784SSteven Rostedt (VMware) 		kfree(mod_func);
72366aa69784SSteven Rostedt (VMware) 	}
72376aa69784SSteven Rostedt (VMware) 
72386aa69784SSteven Rostedt (VMware) 	kfree(mod_map);
72396aa69784SSteven Rostedt (VMware) }
72406aa69784SSteven Rostedt (VMware) 
7241e7247a15S[email protected] void ftrace_release_mod(struct module *mod)
724293eb677dSSteven Rostedt {
72436aa69784SSteven Rostedt (VMware) 	struct ftrace_mod_map *mod_map;
72446aa69784SSteven Rostedt (VMware) 	struct ftrace_mod_map *n;
724593eb677dSSteven Rostedt 	struct dyn_ftrace *rec;
724632082309SSteven Rostedt 	struct ftrace_page **last_pg;
72472a5bfe47SSteven Rostedt (VMware) 	struct ftrace_page *tmp_page = NULL;
724893eb677dSSteven Rostedt 	struct ftrace_page *pg;
724993eb677dSSteven Rostedt 
725093eb677dSSteven Rostedt 	mutex_lock(&ftrace_lock);
725145a4a237SSteven Rostedt 
725245a4a237SSteven Rostedt 	if (ftrace_disabled)
725345a4a237SSteven Rostedt 		goto out_unlock;
725445a4a237SSteven Rostedt 
72556aa69784SSteven Rostedt (VMware) 	list_for_each_entry_safe(mod_map, n, &ftrace_mod_maps, list) {
72566aa69784SSteven Rostedt (VMware) 		if (mod_map->mod == mod) {
72576aa69784SSteven Rostedt (VMware) 			list_del_rcu(&mod_map->list);
725874401729SPaul E. McKenney 			call_rcu(&mod_map->rcu, ftrace_free_mod_map);
72596aa69784SSteven Rostedt (VMware) 			break;
72606aa69784SSteven Rostedt (VMware) 		}
72616aa69784SSteven Rostedt (VMware) 	}
72626aa69784SSteven Rostedt (VMware) 
726332082309SSteven Rostedt 	/*
726432082309SSteven Rostedt 	 * Each module has its own ftrace_pages, remove
726532082309SSteven Rostedt 	 * them from the list.
726632082309SSteven Rostedt 	 */
726732082309SSteven Rostedt 	last_pg = &ftrace_pages_start;
726832082309SSteven Rostedt 	for (pg = ftrace_pages_start; pg; pg = *last_pg) {
726932082309SSteven Rostedt 		rec = &pg->records[0];
727013511489SLevi Yun 		if (within_module(rec->ip, mod)) {
727193eb677dSSteven Rostedt 			/*
727232082309SSteven Rostedt 			 * As core pages are first, the first
727332082309SSteven Rostedt 			 * page should never be a module page.
727493eb677dSSteven Rostedt 			 */
727532082309SSteven Rostedt 			if (WARN_ON(pg == ftrace_pages_start))
727632082309SSteven Rostedt 				goto out_unlock;
727732082309SSteven Rostedt 
727832082309SSteven Rostedt 			/* Check if we are deleting the last page */
727932082309SSteven Rostedt 			if (pg == ftrace_pages)
728032082309SSteven Rostedt 				ftrace_pages = next_to_ftrace_page(last_pg);
728132082309SSteven Rostedt 
728283dd1493SSteven Rostedt (VMware) 			ftrace_update_tot_cnt -= pg->index;
728332082309SSteven Rostedt 			*last_pg = pg->next;
72842a5bfe47SSteven Rostedt (VMware) 
72852a5bfe47SSteven Rostedt (VMware) 			pg->next = tmp_page;
72862a5bfe47SSteven Rostedt (VMware) 			tmp_page = pg;
728732082309SSteven Rostedt 		} else
728832082309SSteven Rostedt 			last_pg = &pg->next;
728993eb677dSSteven Rostedt 	}
729045a4a237SSteven Rostedt  out_unlock:
729193eb677dSSteven Rostedt 	mutex_unlock(&ftrace_lock);
72922a5bfe47SSteven Rostedt (VMware) 
7293e60b613dSZheng Yejian 	/* Need to synchronize with ftrace_location_range() */
7294e60b613dSZheng Yejian 	if (tmp_page)
7295e60b613dSZheng Yejian 		synchronize_rcu();
72962a5bfe47SSteven Rostedt (VMware) 	for (pg = tmp_page; pg; pg = tmp_page) {
72972a5bfe47SSteven Rostedt (VMware) 
72982a5bfe47SSteven Rostedt (VMware) 		/* Needs to be called outside of ftrace_lock */
72992a5bfe47SSteven Rostedt (VMware) 		clear_mod_from_hashes(pg);
73002a5bfe47SSteven Rostedt (VMware) 
7301db42523bSLinus Torvalds 		if (pg->records) {
7302db42523bSLinus Torvalds 			free_pages((unsigned long)pg->records, pg->order);
7303db42523bSLinus Torvalds 			ftrace_number_of_pages -= 1 << pg->order;
7304db42523bSLinus Torvalds 		}
73052a5bfe47SSteven Rostedt (VMware) 		tmp_page = pg->next;
73062a5bfe47SSteven Rostedt (VMware) 		kfree(pg);
7307da537f0aSSteven Rostedt (VMware) 		ftrace_number_of_groups--;
73082a5bfe47SSteven Rostedt (VMware) 	}
730993eb677dSSteven Rostedt }
731093eb677dSSteven Rostedt 
73117dcd182bSJessica Yu void ftrace_module_enable(struct module *mod)
7312b7ffffbbSSteven Rostedt (Red Hat) {
7313b7ffffbbSSteven Rostedt (Red Hat) 	struct dyn_ftrace *rec;
7314b7ffffbbSSteven Rostedt (Red Hat) 	struct ftrace_page *pg;
7315b7ffffbbSSteven Rostedt (Red Hat) 
7316b7ffffbbSSteven Rostedt (Red Hat) 	mutex_lock(&ftrace_lock);
7317b7ffffbbSSteven Rostedt (Red Hat) 
7318b7ffffbbSSteven Rostedt (Red Hat) 	if (ftrace_disabled)
7319b7ffffbbSSteven Rostedt (Red Hat) 		goto out_unlock;
7320b7ffffbbSSteven Rostedt (Red Hat) 
7321b7ffffbbSSteven Rostedt (Red Hat) 	/*
7322b7ffffbbSSteven Rostedt (Red Hat) 	 * If the tracing is enabled, go ahead and enable the record.
7323b7ffffbbSSteven Rostedt (Red Hat) 	 *
73249efb85c5SHariprasad Kelam 	 * The reason not to enable the record immediately is the
7325b7ffffbbSSteven Rostedt (Red Hat) 	 * inherent check of ftrace_make_nop/ftrace_make_call for
7326b7ffffbbSSteven Rostedt (Red Hat) 	 * correct previous instructions.  Making first the NOP
7327b7ffffbbSSteven Rostedt (Red Hat) 	 * conversion puts the module to the correct state, thus
7328b7ffffbbSSteven Rostedt (Red Hat) 	 * passing the ftrace_make_call check.
7329b7ffffbbSSteven Rostedt (Red Hat) 	 *
7330b7ffffbbSSteven Rostedt (Red Hat) 	 * We also delay this to after the module code already set the
7331b7ffffbbSSteven Rostedt (Red Hat) 	 * text to read-only, as we now need to set it back to read-write
7332b7ffffbbSSteven Rostedt (Red Hat) 	 * so that we can modify the text.
7333b7ffffbbSSteven Rostedt (Red Hat) 	 */
7334b7ffffbbSSteven Rostedt (Red Hat) 	if (ftrace_start_up)
7335b7ffffbbSSteven Rostedt (Red Hat) 		ftrace_arch_code_modify_prepare();
7336b7ffffbbSSteven Rostedt (Red Hat) 
7337b7ffffbbSSteven Rostedt (Red Hat) 	do_for_each_ftrace_rec(pg, rec) {
7338b7ffffbbSSteven Rostedt (Red Hat) 		int cnt;
7339b7ffffbbSSteven Rostedt (Red Hat) 		/*
7340b7ffffbbSSteven Rostedt (Red Hat) 		 * do_for_each_ftrace_rec() is a double loop.
7341b7ffffbbSSteven Rostedt (Red Hat) 		 * module text shares the pg. If a record is
7342b7ffffbbSSteven Rostedt (Red Hat) 		 * not part of this module, then skip this pg,
7343b7ffffbbSSteven Rostedt (Red Hat) 		 * which the "break" will do.
7344b7ffffbbSSteven Rostedt (Red Hat) 		 */
734513511489SLevi Yun 		if (!within_module(rec->ip, mod))
7346b7ffffbbSSteven Rostedt (Red Hat) 			break;
7347b7ffffbbSSteven Rostedt (Red Hat) 
7348b39181f7SSteven Rostedt (Google) 		/* Weak functions should still be ignored */
7349b39181f7SSteven Rostedt (Google) 		if (!test_for_valid_rec(rec)) {
7350b39181f7SSteven Rostedt (Google) 			/* Clear all other flags. Should not be enabled anyway */
7351b39181f7SSteven Rostedt (Google) 			rec->flags = FTRACE_FL_DISABLED;
7352b39181f7SSteven Rostedt (Google) 			continue;
7353b39181f7SSteven Rostedt (Google) 		}
7354b39181f7SSteven Rostedt (Google) 
7355b7ffffbbSSteven Rostedt (Red Hat) 		cnt = 0;
7356b7ffffbbSSteven Rostedt (Red Hat) 
7357b7ffffbbSSteven Rostedt (Red Hat) 		/*
7358b7ffffbbSSteven Rostedt (Red Hat) 		 * When adding a module, we need to check if tracers are
7359b7ffffbbSSteven Rostedt (Red Hat) 		 * currently enabled and if they are, and can trace this record,
7360b7ffffbbSSteven Rostedt (Red Hat) 		 * we need to enable the module functions as well as update the
7361b7ffffbbSSteven Rostedt (Red Hat) 		 * reference counts for those function records.
7362b7ffffbbSSteven Rostedt (Red Hat) 		 */
7363b7ffffbbSSteven Rostedt (Red Hat) 		if (ftrace_start_up)
7364b7ffffbbSSteven Rostedt (Red Hat) 			cnt += referenced_filters(rec);
7365b7ffffbbSSteven Rostedt (Red Hat) 
73668a224ffbSChengming Zhou 		rec->flags &= ~FTRACE_FL_DISABLED;
73678a224ffbSChengming Zhou 		rec->flags += cnt;
7368b7ffffbbSSteven Rostedt (Red Hat) 
7369b7ffffbbSSteven Rostedt (Red Hat) 		if (ftrace_start_up && cnt) {
7370b7ffffbbSSteven Rostedt (Red Hat) 			int failed = __ftrace_replace_code(rec, 1);
7371b7ffffbbSSteven Rostedt (Red Hat) 			if (failed) {
7372b7ffffbbSSteven Rostedt (Red Hat) 				ftrace_bug(failed, rec);
7373b7ffffbbSSteven Rostedt (Red Hat) 				goto out_loop;
7374b7ffffbbSSteven Rostedt (Red Hat) 			}
7375b7ffffbbSSteven Rostedt (Red Hat) 		}
7376b7ffffbbSSteven Rostedt (Red Hat) 
7377b7ffffbbSSteven Rostedt (Red Hat) 	} while_for_each_ftrace_rec();
7378b7ffffbbSSteven Rostedt (Red Hat) 
7379b7ffffbbSSteven Rostedt (Red Hat)  out_loop:
7380b7ffffbbSSteven Rostedt (Red Hat) 	if (ftrace_start_up)
7381b7ffffbbSSteven Rostedt (Red Hat) 		ftrace_arch_code_modify_post_process();
7382b7ffffbbSSteven Rostedt (Red Hat) 
7383b7ffffbbSSteven Rostedt (Red Hat)  out_unlock:
7384b7ffffbbSSteven Rostedt (Red Hat) 	mutex_unlock(&ftrace_lock);
7385d7fbf8dfSSteven Rostedt (VMware) 
7386d7fbf8dfSSteven Rostedt (VMware) 	process_cached_mods(mod->name);
7387b7ffffbbSSteven Rostedt (Red Hat) }
7388b7ffffbbSSteven Rostedt (Red Hat) 
7389a949ae56SSteven Rostedt (Red Hat) void ftrace_module_init(struct module *mod)
739093eb677dSSteven Rostedt {
73912889c658SYuntao Wang 	int ret;
73922889c658SYuntao Wang 
739397e9b4fcSSteven Rostedt (Red Hat) 	if (ftrace_disabled || !mod->num_ftrace_callsites)
7394b6b71f66SAbel Vesa 		return;
7395b6b71f66SAbel Vesa 
73962889c658SYuntao Wang 	ret = ftrace_process_locs(mod, mod->ftrace_callsites,
739797e9b4fcSSteven Rostedt (Red Hat) 				  mod->ftrace_callsites + mod->num_ftrace_callsites);
73982889c658SYuntao Wang 	if (ret)
73992889c658SYuntao Wang 		pr_warn("ftrace: failed to allocate entries for module '%s' functions\n",
74002889c658SYuntao Wang 			mod->name);
740193eb677dSSteven Rostedt }
7402aba4b5c2SSteven Rostedt (VMware) 
7403aba4b5c2SSteven Rostedt (VMware) static void save_ftrace_mod_rec(struct ftrace_mod_map *mod_map,
7404aba4b5c2SSteven Rostedt (VMware) 				struct dyn_ftrace *rec)
7405aba4b5c2SSteven Rostedt (VMware) {
7406aba4b5c2SSteven Rostedt (VMware) 	struct ftrace_mod_func *mod_func;
7407aba4b5c2SSteven Rostedt (VMware) 	unsigned long symsize;
7408aba4b5c2SSteven Rostedt (VMware) 	unsigned long offset;
7409aba4b5c2SSteven Rostedt (VMware) 	char str[KSYM_SYMBOL_LEN];
7410aba4b5c2SSteven Rostedt (VMware) 	char *modname;
7411aba4b5c2SSteven Rostedt (VMware) 	const char *ret;
7412aba4b5c2SSteven Rostedt (VMware) 
7413aba4b5c2SSteven Rostedt (VMware) 	ret = kallsyms_lookup(rec->ip, &symsize, &offset, &modname, str);
7414aba4b5c2SSteven Rostedt (VMware) 	if (!ret)
7415aba4b5c2SSteven Rostedt (VMware) 		return;
7416aba4b5c2SSteven Rostedt (VMware) 
7417aba4b5c2SSteven Rostedt (VMware) 	mod_func = kmalloc(sizeof(*mod_func), GFP_KERNEL);
7418aba4b5c2SSteven Rostedt (VMware) 	if (!mod_func)
7419aba4b5c2SSteven Rostedt (VMware) 		return;
7420aba4b5c2SSteven Rostedt (VMware) 
7421aba4b5c2SSteven Rostedt (VMware) 	mod_func->name = kstrdup(str, GFP_KERNEL);
7422aba4b5c2SSteven Rostedt (VMware) 	if (!mod_func->name) {
7423aba4b5c2SSteven Rostedt (VMware) 		kfree(mod_func);
7424aba4b5c2SSteven Rostedt (VMware) 		return;
7425aba4b5c2SSteven Rostedt (VMware) 	}
7426aba4b5c2SSteven Rostedt (VMware) 
7427aba4b5c2SSteven Rostedt (VMware) 	mod_func->ip = rec->ip - offset;
7428aba4b5c2SSteven Rostedt (VMware) 	mod_func->size = symsize;
7429aba4b5c2SSteven Rostedt (VMware) 
74306171a031SSteven Rostedt (VMware) 	mod_map->num_funcs++;
74316171a031SSteven Rostedt (VMware) 
7432aba4b5c2SSteven Rostedt (VMware) 	list_add_rcu(&mod_func->list, &mod_map->funcs);
7433aba4b5c2SSteven Rostedt (VMware) }
7434aba4b5c2SSteven Rostedt (VMware) 
7435aba4b5c2SSteven Rostedt (VMware) static struct ftrace_mod_map *
7436aba4b5c2SSteven Rostedt (VMware) allocate_ftrace_mod_map(struct module *mod,
7437aba4b5c2SSteven Rostedt (VMware) 			unsigned long start, unsigned long end)
7438aba4b5c2SSteven Rostedt (VMware) {
7439aba4b5c2SSteven Rostedt (VMware) 	struct ftrace_mod_map *mod_map;
7440aba4b5c2SSteven Rostedt (VMware) 
7441aba4b5c2SSteven Rostedt (VMware) 	mod_map = kmalloc(sizeof(*mod_map), GFP_KERNEL);
7442aba4b5c2SSteven Rostedt (VMware) 	if (!mod_map)
7443aba4b5c2SSteven Rostedt (VMware) 		return NULL;
7444aba4b5c2SSteven Rostedt (VMware) 
7445aba4b5c2SSteven Rostedt (VMware) 	mod_map->mod = mod;
7446aba4b5c2SSteven Rostedt (VMware) 	mod_map->start_addr = start;
7447aba4b5c2SSteven Rostedt (VMware) 	mod_map->end_addr = end;
74486171a031SSteven Rostedt (VMware) 	mod_map->num_funcs = 0;
7449aba4b5c2SSteven Rostedt (VMware) 
7450aba4b5c2SSteven Rostedt (VMware) 	INIT_LIST_HEAD_RCU(&mod_map->funcs);
7451aba4b5c2SSteven Rostedt (VMware) 
7452aba4b5c2SSteven Rostedt (VMware) 	list_add_rcu(&mod_map->list, &ftrace_mod_maps);
7453aba4b5c2SSteven Rostedt (VMware) 
7454aba4b5c2SSteven Rostedt (VMware) 	return mod_map;
7455aba4b5c2SSteven Rostedt (VMware) }
7456aba4b5c2SSteven Rostedt (VMware) 
7457aba4b5c2SSteven Rostedt (VMware) static const char *
7458aba4b5c2SSteven Rostedt (VMware) ftrace_func_address_lookup(struct ftrace_mod_map *mod_map,
7459aba4b5c2SSteven Rostedt (VMware) 			   unsigned long addr, unsigned long *size,
7460aba4b5c2SSteven Rostedt (VMware) 			   unsigned long *off, char *sym)
7461aba4b5c2SSteven Rostedt (VMware) {
7462aba4b5c2SSteven Rostedt (VMware) 	struct ftrace_mod_func *found_func =  NULL;
7463aba4b5c2SSteven Rostedt (VMware) 	struct ftrace_mod_func *mod_func;
7464aba4b5c2SSteven Rostedt (VMware) 
7465aba4b5c2SSteven Rostedt (VMware) 	list_for_each_entry_rcu(mod_func, &mod_map->funcs, list) {
7466aba4b5c2SSteven Rostedt (VMware) 		if (addr >= mod_func->ip &&
7467aba4b5c2SSteven Rostedt (VMware) 		    addr < mod_func->ip + mod_func->size) {
7468aba4b5c2SSteven Rostedt (VMware) 			found_func = mod_func;
7469aba4b5c2SSteven Rostedt (VMware) 			break;
7470aba4b5c2SSteven Rostedt (VMware) 		}
7471aba4b5c2SSteven Rostedt (VMware) 	}
7472aba4b5c2SSteven Rostedt (VMware) 
7473aba4b5c2SSteven Rostedt (VMware) 	if (found_func) {
7474aba4b5c2SSteven Rostedt (VMware) 		if (size)
7475aba4b5c2SSteven Rostedt (VMware) 			*size = found_func->size;
7476aba4b5c2SSteven Rostedt (VMware) 		if (off)
7477aba4b5c2SSteven Rostedt (VMware) 			*off = addr - found_func->ip;
7478aba4b5c2SSteven Rostedt (VMware) 		if (sym)
7479d0c2d66fSAzeem Shaikh 			strscpy(sym, found_func->name, KSYM_NAME_LEN);
7480aba4b5c2SSteven Rostedt (VMware) 
7481aba4b5c2SSteven Rostedt (VMware) 		return found_func->name;
7482aba4b5c2SSteven Rostedt (VMware) 	}
7483aba4b5c2SSteven Rostedt (VMware) 
7484aba4b5c2SSteven Rostedt (VMware) 	return NULL;
7485aba4b5c2SSteven Rostedt (VMware) }
7486aba4b5c2SSteven Rostedt (VMware) 
7487aba4b5c2SSteven Rostedt (VMware) const char *
7488aba4b5c2SSteven Rostedt (VMware) ftrace_mod_address_lookup(unsigned long addr, unsigned long *size,
7489aba4b5c2SSteven Rostedt (VMware) 		   unsigned long *off, char **modname, char *sym)
7490aba4b5c2SSteven Rostedt (VMware) {
7491aba4b5c2SSteven Rostedt (VMware) 	struct ftrace_mod_map *mod_map;
7492aba4b5c2SSteven Rostedt (VMware) 	const char *ret = NULL;
7493aba4b5c2SSteven Rostedt (VMware) 
749474401729SPaul E. McKenney 	/* mod_map is freed via call_rcu() */
7495aba4b5c2SSteven Rostedt (VMware) 	preempt_disable();
7496aba4b5c2SSteven Rostedt (VMware) 	list_for_each_entry_rcu(mod_map, &ftrace_mod_maps, list) {
7497aba4b5c2SSteven Rostedt (VMware) 		ret = ftrace_func_address_lookup(mod_map, addr, size, off, sym);
7498aba4b5c2SSteven Rostedt (VMware) 		if (ret) {
7499aba4b5c2SSteven Rostedt (VMware) 			if (modname)
7500aba4b5c2SSteven Rostedt (VMware) 				*modname = mod_map->mod->name;
7501aba4b5c2SSteven Rostedt (VMware) 			break;
7502aba4b5c2SSteven Rostedt (VMware) 		}
7503aba4b5c2SSteven Rostedt (VMware) 	}
7504aba4b5c2SSteven Rostedt (VMware) 	preempt_enable();
7505aba4b5c2SSteven Rostedt (VMware) 
7506aba4b5c2SSteven Rostedt (VMware) 	return ret;
7507aba4b5c2SSteven Rostedt (VMware) }
7508aba4b5c2SSteven Rostedt (VMware) 
75096171a031SSteven Rostedt (VMware) int ftrace_mod_get_kallsym(unsigned int symnum, unsigned long *value,
75106171a031SSteven Rostedt (VMware) 			   char *type, char *name,
75116171a031SSteven Rostedt (VMware) 			   char *module_name, int *exported)
75126171a031SSteven Rostedt (VMware) {
75136171a031SSteven Rostedt (VMware) 	struct ftrace_mod_map *mod_map;
75146171a031SSteven Rostedt (VMware) 	struct ftrace_mod_func *mod_func;
7515fc0ea795SAdrian Hunter 	int ret;
75166171a031SSteven Rostedt (VMware) 
75176171a031SSteven Rostedt (VMware) 	preempt_disable();
75186171a031SSteven Rostedt (VMware) 	list_for_each_entry_rcu(mod_map, &ftrace_mod_maps, list) {
75196171a031SSteven Rostedt (VMware) 
75206171a031SSteven Rostedt (VMware) 		if (symnum >= mod_map->num_funcs) {
75216171a031SSteven Rostedt (VMware) 			symnum -= mod_map->num_funcs;
75226171a031SSteven Rostedt (VMware) 			continue;
75236171a031SSteven Rostedt (VMware) 		}
75246171a031SSteven Rostedt (VMware) 
75256171a031SSteven Rostedt (VMware) 		list_for_each_entry_rcu(mod_func, &mod_map->funcs, list) {
75266171a031SSteven Rostedt (VMware) 			if (symnum > 1) {
75276171a031SSteven Rostedt (VMware) 				symnum--;
75286171a031SSteven Rostedt (VMware) 				continue;
75296171a031SSteven Rostedt (VMware) 			}
75306171a031SSteven Rostedt (VMware) 
75316171a031SSteven Rostedt (VMware) 			*value = mod_func->ip;
75326171a031SSteven Rostedt (VMware) 			*type = 'T';
7533d0c2d66fSAzeem Shaikh 			strscpy(name, mod_func->name, KSYM_NAME_LEN);
7534d0c2d66fSAzeem Shaikh 			strscpy(module_name, mod_map->mod->name, MODULE_NAME_LEN);
75356171a031SSteven Rostedt (VMware) 			*exported = 1;
75366171a031SSteven Rostedt (VMware) 			preempt_enable();
75376171a031SSteven Rostedt (VMware) 			return 0;
75386171a031SSteven Rostedt (VMware) 		}
75396171a031SSteven Rostedt (VMware) 		WARN_ON(1);
75406171a031SSteven Rostedt (VMware) 		break;
75416171a031SSteven Rostedt (VMware) 	}
7542fc0ea795SAdrian Hunter 	ret = ftrace_get_trampoline_kallsym(symnum, value, type, name,
7543fc0ea795SAdrian Hunter 					    module_name, exported);
75446171a031SSteven Rostedt (VMware) 	preempt_enable();
7545fc0ea795SAdrian Hunter 	return ret;
75466171a031SSteven Rostedt (VMware) }
75476171a031SSteven Rostedt (VMware) 
7548aba4b5c2SSteven Rostedt (VMware) #else
7549aba4b5c2SSteven Rostedt (VMware) static void save_ftrace_mod_rec(struct ftrace_mod_map *mod_map,
7550aba4b5c2SSteven Rostedt (VMware) 				struct dyn_ftrace *rec) { }
7551aba4b5c2SSteven Rostedt (VMware) static inline struct ftrace_mod_map *
7552aba4b5c2SSteven Rostedt (VMware) allocate_ftrace_mod_map(struct module *mod,
7553aba4b5c2SSteven Rostedt (VMware) 			unsigned long start, unsigned long end)
7554aba4b5c2SSteven Rostedt (VMware) {
7555aba4b5c2SSteven Rostedt (VMware) 	return NULL;
7556aba4b5c2SSteven Rostedt (VMware) }
7557fc0ea795SAdrian Hunter int ftrace_mod_get_kallsym(unsigned int symnum, unsigned long *value,
7558fc0ea795SAdrian Hunter 			   char *type, char *name, char *module_name,
7559fc0ea795SAdrian Hunter 			   int *exported)
7560fc0ea795SAdrian Hunter {
7561fc0ea795SAdrian Hunter 	int ret;
7562fc0ea795SAdrian Hunter 
7563fc0ea795SAdrian Hunter 	preempt_disable();
7564fc0ea795SAdrian Hunter 	ret = ftrace_get_trampoline_kallsym(symnum, value, type, name,
7565fc0ea795SAdrian Hunter 					    module_name, exported);
7566fc0ea795SAdrian Hunter 	preempt_enable();
7567fc0ea795SAdrian Hunter 	return ret;
7568fc0ea795SAdrian Hunter }
756993eb677dSSteven Rostedt #endif /* CONFIG_MODULES */
757093eb677dSSteven Rostedt 
75718715b108SJoel Fernandes struct ftrace_init_func {
75728715b108SJoel Fernandes 	struct list_head list;
75738715b108SJoel Fernandes 	unsigned long ip;
75748715b108SJoel Fernandes };
75758715b108SJoel Fernandes 
75768715b108SJoel Fernandes /* Clear any init ips from hashes */
75778715b108SJoel Fernandes static void
75788715b108SJoel Fernandes clear_func_from_hash(struct ftrace_init_func *func, struct ftrace_hash *hash)
757942c269c8SSteven Rostedt (VMware) {
75808715b108SJoel Fernandes 	struct ftrace_func_entry *entry;
75818715b108SJoel Fernandes 
758208468754SChangbin Du 	entry = ftrace_lookup_ip(hash, func->ip);
75838715b108SJoel Fernandes 	/*
75848715b108SJoel Fernandes 	 * Do not allow this rec to match again.
75858715b108SJoel Fernandes 	 * Yeah, it may waste some memory, but will be removed
75868715b108SJoel Fernandes 	 * if/when the hash is modified again.
75878715b108SJoel Fernandes 	 */
75888715b108SJoel Fernandes 	if (entry)
75898715b108SJoel Fernandes 		entry->ip = 0;
75908715b108SJoel Fernandes }
75918715b108SJoel Fernandes 
75928715b108SJoel Fernandes static void
75938715b108SJoel Fernandes clear_func_from_hashes(struct ftrace_init_func *func)
75948715b108SJoel Fernandes {
75958715b108SJoel Fernandes 	struct trace_array *tr;
75968715b108SJoel Fernandes 
75978715b108SJoel Fernandes 	mutex_lock(&trace_types_lock);
75988715b108SJoel Fernandes 	list_for_each_entry(tr, &ftrace_trace_arrays, list) {
75998715b108SJoel Fernandes 		if (!tr->ops || !tr->ops->func_hash)
76008715b108SJoel Fernandes 			continue;
76018715b108SJoel Fernandes 		mutex_lock(&tr->ops->func_hash->regex_lock);
76028715b108SJoel Fernandes 		clear_func_from_hash(func, tr->ops->func_hash->filter_hash);
76038715b108SJoel Fernandes 		clear_func_from_hash(func, tr->ops->func_hash->notrace_hash);
76048715b108SJoel Fernandes 		mutex_unlock(&tr->ops->func_hash->regex_lock);
76058715b108SJoel Fernandes 	}
76068715b108SJoel Fernandes 	mutex_unlock(&trace_types_lock);
76078715b108SJoel Fernandes }
76088715b108SJoel Fernandes 
76098715b108SJoel Fernandes static void add_to_clear_hash_list(struct list_head *clear_list,
76108715b108SJoel Fernandes 				   struct dyn_ftrace *rec)
76118715b108SJoel Fernandes {
76128715b108SJoel Fernandes 	struct ftrace_init_func *func;
76138715b108SJoel Fernandes 
76148715b108SJoel Fernandes 	func = kmalloc(sizeof(*func), GFP_KERNEL);
76158715b108SJoel Fernandes 	if (!func) {
761624589e3aSSteven Rostedt (VMware) 		MEM_FAIL(1, "alloc failure, ftrace filter could be stale\n");
76178715b108SJoel Fernandes 		return;
76188715b108SJoel Fernandes 	}
76198715b108SJoel Fernandes 
76208715b108SJoel Fernandes 	func->ip = rec->ip;
76218715b108SJoel Fernandes 	list_add(&func->list, clear_list);
76228715b108SJoel Fernandes }
76238715b108SJoel Fernandes 
7624aba4b5c2SSteven Rostedt (VMware) void ftrace_free_mem(struct module *mod, void *start_ptr, void *end_ptr)
762542c269c8SSteven Rostedt (VMware) {
76266cafbe15SSteven Rostedt (VMware) 	unsigned long start = (unsigned long)(start_ptr);
76276cafbe15SSteven Rostedt (VMware) 	unsigned long end = (unsigned long)(end_ptr);
762842c269c8SSteven Rostedt (VMware) 	struct ftrace_page **last_pg = &ftrace_pages_start;
7629e60b613dSZheng Yejian 	struct ftrace_page *tmp_page = NULL;
763042c269c8SSteven Rostedt (VMware) 	struct ftrace_page *pg;
763142c269c8SSteven Rostedt (VMware) 	struct dyn_ftrace *rec;
763242c269c8SSteven Rostedt (VMware) 	struct dyn_ftrace key;
7633aba4b5c2SSteven Rostedt (VMware) 	struct ftrace_mod_map *mod_map = NULL;
76348715b108SJoel Fernandes 	struct ftrace_init_func *func, *func_next;
76352a30dbcbSRuan Jinjie 	LIST_HEAD(clear_hash);
76368715b108SJoel Fernandes 
763742c269c8SSteven Rostedt (VMware) 	key.ip = start;
763842c269c8SSteven Rostedt (VMware) 	key.flags = end;	/* overload flags, as it is unsigned long */
763942c269c8SSteven Rostedt (VMware) 
764042c269c8SSteven Rostedt (VMware) 	mutex_lock(&ftrace_lock);
764142c269c8SSteven Rostedt (VMware) 
7642aba4b5c2SSteven Rostedt (VMware) 	/*
7643aba4b5c2SSteven Rostedt (VMware) 	 * If we are freeing module init memory, then check if
7644aba4b5c2SSteven Rostedt (VMware) 	 * any tracer is active. If so, we need to save a mapping of
7645aba4b5c2SSteven Rostedt (VMware) 	 * the module functions being freed with the address.
7646aba4b5c2SSteven Rostedt (VMware) 	 */
7647aba4b5c2SSteven Rostedt (VMware) 	if (mod && ftrace_ops_list != &ftrace_list_end)
7648aba4b5c2SSteven Rostedt (VMware) 		mod_map = allocate_ftrace_mod_map(mod, start, end);
7649aba4b5c2SSteven Rostedt (VMware) 
765042c269c8SSteven Rostedt (VMware) 	for (pg = ftrace_pages_start; pg; last_pg = &pg->next, pg = *last_pg) {
765142c269c8SSteven Rostedt (VMware) 		if (end < pg->records[0].ip ||
765242c269c8SSteven Rostedt (VMware) 		    start >= (pg->records[pg->index - 1].ip + MCOUNT_INSN_SIZE))
765342c269c8SSteven Rostedt (VMware) 			continue;
765442c269c8SSteven Rostedt (VMware)  again:
765542c269c8SSteven Rostedt (VMware) 		rec = bsearch(&key, pg->records, pg->index,
765642c269c8SSteven Rostedt (VMware) 			      sizeof(struct dyn_ftrace),
765742c269c8SSteven Rostedt (VMware) 			      ftrace_cmp_recs);
765842c269c8SSteven Rostedt (VMware) 		if (!rec)
765942c269c8SSteven Rostedt (VMware) 			continue;
7660aba4b5c2SSteven Rostedt (VMware) 
76618715b108SJoel Fernandes 		/* rec will be cleared from hashes after ftrace_lock unlock */
76628715b108SJoel Fernandes 		add_to_clear_hash_list(&clear_hash, rec);
76638715b108SJoel Fernandes 
7664aba4b5c2SSteven Rostedt (VMware) 		if (mod_map)
7665aba4b5c2SSteven Rostedt (VMware) 			save_ftrace_mod_rec(mod_map, rec);
7666aba4b5c2SSteven Rostedt (VMware) 
766742c269c8SSteven Rostedt (VMware) 		pg->index--;
76684ec78467SSteven Rostedt (VMware) 		ftrace_update_tot_cnt--;
766942c269c8SSteven Rostedt (VMware) 		if (!pg->index) {
767042c269c8SSteven Rostedt (VMware) 			*last_pg = pg->next;
7671e60b613dSZheng Yejian 			pg->next = tmp_page;
7672e60b613dSZheng Yejian 			tmp_page = pg;
767342c269c8SSteven Rostedt (VMware) 			pg = container_of(last_pg, struct ftrace_page, next);
767442c269c8SSteven Rostedt (VMware) 			if (!(*last_pg))
767542c269c8SSteven Rostedt (VMware) 				ftrace_pages = pg;
767642c269c8SSteven Rostedt (VMware) 			continue;
767742c269c8SSteven Rostedt (VMware) 		}
767842c269c8SSteven Rostedt (VMware) 		memmove(rec, rec + 1,
767942c269c8SSteven Rostedt (VMware) 			(pg->index - (rec - pg->records)) * sizeof(*rec));
768042c269c8SSteven Rostedt (VMware) 		/* More than one function may be in this block */
768142c269c8SSteven Rostedt (VMware) 		goto again;
768242c269c8SSteven Rostedt (VMware) 	}
768342c269c8SSteven Rostedt (VMware) 	mutex_unlock(&ftrace_lock);
76848715b108SJoel Fernandes 
76858715b108SJoel Fernandes 	list_for_each_entry_safe(func, func_next, &clear_hash, list) {
76868715b108SJoel Fernandes 		clear_func_from_hashes(func);
76878715b108SJoel Fernandes 		kfree(func);
76888715b108SJoel Fernandes 	}
7689e60b613dSZheng Yejian 	/* Need to synchronize with ftrace_location_range() */
7690e60b613dSZheng Yejian 	if (tmp_page) {
7691e60b613dSZheng Yejian 		synchronize_rcu();
7692e60b613dSZheng Yejian 		ftrace_free_pages(tmp_page);
7693e60b613dSZheng Yejian 	}
769442c269c8SSteven Rostedt (VMware) }
769542c269c8SSteven Rostedt (VMware) 
76966cafbe15SSteven Rostedt (VMware) void __init ftrace_free_init_mem(void)
76976cafbe15SSteven Rostedt (VMware) {
76986cafbe15SSteven Rostedt (VMware) 	void *start = (void *)(&__init_begin);
76996cafbe15SSteven Rostedt (VMware) 	void *end = (void *)(&__init_end);
77006cafbe15SSteven Rostedt (VMware) 
7701380af29bSSteven Rostedt (Google) 	ftrace_boot_snapshot();
7702380af29bSSteven Rostedt (Google) 
7703aba4b5c2SSteven Rostedt (VMware) 	ftrace_free_mem(NULL, start, end);
770493eb677dSSteven Rostedt }
770593eb677dSSteven Rostedt 
77066644c654SWeizhao Ouyang int __init __weak ftrace_dyn_arch_init(void)
77076644c654SWeizhao Ouyang {
77086644c654SWeizhao Ouyang 	return 0;
77096644c654SWeizhao Ouyang }
77106644c654SWeizhao Ouyang 
771168bf21aaSSteven Rostedt void __init ftrace_init(void)
771268bf21aaSSteven Rostedt {
77131dc43cf0SJiri Slaby 	extern unsigned long __start_mcount_loc[];
77141dc43cf0SJiri Slaby 	extern unsigned long __stop_mcount_loc[];
77153a36cb11SJiri Slaby 	unsigned long count, flags;
771668bf21aaSSteven Rostedt 	int ret;
771768bf21aaSSteven Rostedt 
771868bf21aaSSteven Rostedt 	local_irq_save(flags);
77193a36cb11SJiri Slaby 	ret = ftrace_dyn_arch_init();
772068bf21aaSSteven Rostedt 	local_irq_restore(flags);
7721af64a7cbSJiri Slaby 	if (ret)
772268bf21aaSSteven Rostedt 		goto failed;
772368bf21aaSSteven Rostedt 
772468bf21aaSSteven Rostedt 	count = __stop_mcount_loc - __start_mcount_loc;
7725c867ccd8SJiri Slaby 	if (!count) {
7726c867ccd8SJiri Slaby 		pr_info("ftrace: No functions to be traced?\n");
772768bf21aaSSteven Rostedt 		goto failed;
7728c867ccd8SJiri Slaby 	}
7729c867ccd8SJiri Slaby 
7730c867ccd8SJiri Slaby 	pr_info("ftrace: allocating %ld entries in %ld pages\n",
773108948caeSWang Wensheng 		count, DIV_ROUND_UP(count, ENTRIES_PER_PAGE));
773268bf21aaSSteven Rostedt 
77335cb084bbSJiri Olsa 	ret = ftrace_process_locs(NULL,
773431e88909SSteven Rostedt 				  __start_mcount_loc,
773568bf21aaSSteven Rostedt 				  __stop_mcount_loc);
77362889c658SYuntao Wang 	if (ret) {
77372889c658SYuntao Wang 		pr_warn("ftrace: failed to allocate entries for functions\n");
77382889c658SYuntao Wang 		goto failed;
77392889c658SYuntao Wang 	}
774068bf21aaSSteven Rostedt 
7741da537f0aSSteven Rostedt (VMware) 	pr_info("ftrace: allocated %ld pages with %ld groups\n",
7742da537f0aSSteven Rostedt (VMware) 		ftrace_number_of_pages, ftrace_number_of_groups);
7743da537f0aSSteven Rostedt (VMware) 
77442889c658SYuntao Wang 	last_ftrace_enabled = ftrace_enabled = 1;
77452889c658SYuntao Wang 
77462af15d6aSSteven Rostedt 	set_ftrace_early_filters();
77472af15d6aSSteven Rostedt 
774868bf21aaSSteven Rostedt 	return;
774968bf21aaSSteven Rostedt  failed:
775068bf21aaSSteven Rostedt 	ftrace_disabled = 1;
775168bf21aaSSteven Rostedt }
775268bf21aaSSteven Rostedt 
7753f3bea491SSteven Rostedt (Red Hat) /* Do nothing if arch does not support this */
7754f3bea491SSteven Rostedt (Red Hat) void __weak arch_ftrace_update_trampoline(struct ftrace_ops *ops)
7755f3bea491SSteven Rostedt (Red Hat) {
7756f3bea491SSteven Rostedt (Red Hat) }
7757f3bea491SSteven Rostedt (Red Hat) 
7758f3bea491SSteven Rostedt (Red Hat) static void ftrace_update_trampoline(struct ftrace_ops *ops)
7759f3bea491SSteven Rostedt (Red Hat) {
7760fc0ea795SAdrian Hunter 	unsigned long trampoline = ops->trampoline;
7761fc0ea795SAdrian Hunter 
7762f3bea491SSteven Rostedt (Red Hat) 	arch_ftrace_update_trampoline(ops);
7763fc0ea795SAdrian Hunter 	if (ops->trampoline && ops->trampoline != trampoline &&
7764dd9ddf46SAdrian Hunter 	    (ops->flags & FTRACE_OPS_FL_ALLOC_TRAMP)) {
7765dd9ddf46SAdrian Hunter 		/* Add to kallsyms before the perf events */
7766fc0ea795SAdrian Hunter 		ftrace_add_trampoline_to_kallsyms(ops);
7767dd9ddf46SAdrian Hunter 		perf_event_ksymbol(PERF_RECORD_KSYMBOL_TYPE_OOL,
7768dd9ddf46SAdrian Hunter 				   ops->trampoline, ops->trampoline_size, false,
7769dd9ddf46SAdrian Hunter 				   FTRACE_TRAMPOLINE_SYM);
7770548e1f6cSAdrian Hunter 		/*
7771548e1f6cSAdrian Hunter 		 * Record the perf text poke event after the ksymbol register
7772548e1f6cSAdrian Hunter 		 * event.
7773548e1f6cSAdrian Hunter 		 */
7774548e1f6cSAdrian Hunter 		perf_event_text_poke((void *)ops->trampoline, NULL, 0,
7775548e1f6cSAdrian Hunter 				     (void *)ops->trampoline,
7776548e1f6cSAdrian Hunter 				     ops->trampoline_size);
7777dd9ddf46SAdrian Hunter 	}
7778f3bea491SSteven Rostedt (Red Hat) }
7779f3bea491SSteven Rostedt (Red Hat) 
778004ec7bb6SSteven Rostedt (VMware) void ftrace_init_trace_array(struct trace_array *tr)
778104ec7bb6SSteven Rostedt (VMware) {
778204ec7bb6SSteven Rostedt (VMware) 	INIT_LIST_HEAD(&tr->func_probes);
7783673feb9dSSteven Rostedt (VMware) 	INIT_LIST_HEAD(&tr->mod_trace);
7784673feb9dSSteven Rostedt (VMware) 	INIT_LIST_HEAD(&tr->mod_notrace);
778504ec7bb6SSteven Rostedt (VMware) }
77863d083395SSteven Rostedt #else
77870b6e4d56SFrederic Weisbecker 
77883306fc4aSSteven Rostedt (VMware) struct ftrace_ops global_ops = {
7789bd69c30bSSteven Rostedt 	.func			= ftrace_stub,
7790a25d036dSSteven Rostedt (VMware) 	.flags			= FTRACE_OPS_FL_INITIALIZED |
7791e3eea140SSteven Rostedt (Red Hat) 				  FTRACE_OPS_FL_PID,
7792bd69c30bSSteven Rostedt };
7793bd69c30bSSteven Rostedt 
77940b6e4d56SFrederic Weisbecker static int __init ftrace_nodyn_init(void)
77950b6e4d56SFrederic Weisbecker {
77960b6e4d56SFrederic Weisbecker 	ftrace_enabled = 1;
77970b6e4d56SFrederic Weisbecker 	return 0;
77980b6e4d56SFrederic Weisbecker }
77996f415672SSteven Rostedt core_initcall(ftrace_nodyn_init);
78000b6e4d56SFrederic Weisbecker 
78018434dc93SSteven Rostedt (Red Hat) static inline int ftrace_init_dyn_tracefs(struct dentry *d_tracer) { return 0; }
7802e1effa01SSteven Rostedt (Red Hat) static inline void ftrace_startup_all(int command) { }
78038a56d776SSteven Rostedt (Red Hat) 
7804f3bea491SSteven Rostedt (Red Hat) static void ftrace_update_trampoline(struct ftrace_ops *ops)
7805f3bea491SSteven Rostedt (Red Hat) {
7806f3bea491SSteven Rostedt (Red Hat) }
7807f3bea491SSteven Rostedt (Red Hat) 
78083d083395SSteven Rostedt #endif /* CONFIG_DYNAMIC_FTRACE */
78093d083395SSteven Rostedt 
78104104d326SSteven Rostedt (Red Hat) __init void ftrace_init_global_array_ops(struct trace_array *tr)
78114104d326SSteven Rostedt (Red Hat) {
78124104d326SSteven Rostedt (Red Hat) 	tr->ops = &global_ops;
78134104d326SSteven Rostedt (Red Hat) 	tr->ops->private = tr;
781404ec7bb6SSteven Rostedt (VMware) 	ftrace_init_trace_array(tr);
7815c132be2cSSteven Rostedt (VMware) 	init_array_fgraph_ops(tr, tr->ops);
78164104d326SSteven Rostedt (Red Hat) }
78174104d326SSteven Rostedt (Red Hat) 
78184104d326SSteven Rostedt (Red Hat) void ftrace_init_array_ops(struct trace_array *tr, ftrace_func_t func)
78194104d326SSteven Rostedt (Red Hat) {
78204104d326SSteven Rostedt (Red Hat) 	/* If we filter on pids, update to use the pid function */
78214104d326SSteven Rostedt (Red Hat) 	if (tr->flags & TRACE_ARRAY_FL_GLOBAL) {
78224104d326SSteven Rostedt (Red Hat) 		if (WARN_ON(tr->ops->func != ftrace_stub))
78234104d326SSteven Rostedt (Red Hat) 			printk("ftrace ops had %pS for function\n",
78244104d326SSteven Rostedt (Red Hat) 			       tr->ops->func);
78254104d326SSteven Rostedt (Red Hat) 	}
78264104d326SSteven Rostedt (Red Hat) 	tr->ops->func = func;
78274104d326SSteven Rostedt (Red Hat) 	tr->ops->private = tr;
78284104d326SSteven Rostedt (Red Hat) }
78294104d326SSteven Rostedt (Red Hat) 
78304104d326SSteven Rostedt (Red Hat) void ftrace_reset_array_ops(struct trace_array *tr)
78314104d326SSteven Rostedt (Red Hat) {
78324104d326SSteven Rostedt (Red Hat) 	tr->ops->func = ftrace_stub;
78334104d326SSteven Rostedt (Red Hat) }
78344104d326SSteven Rostedt (Red Hat) 
7835fabe38abSMasami Hiramatsu static nokprobe_inline void
78362f5f6ad9SSteven Rostedt __ftrace_ops_list_func(unsigned long ip, unsigned long parent_ip,
7837d19ad077SSteven Rostedt (VMware) 		       struct ftrace_ops *ignored, struct ftrace_regs *fregs)
7838b848914cSSteven Rostedt {
7839d19ad077SSteven Rostedt (VMware) 	struct pt_regs *regs = ftrace_get_regs(fregs);
7840cdbe61bfSSteven Rostedt 	struct ftrace_ops *op;
7841edc15cafSSteven Rostedt 	int bit;
7842b848914cSSteven Rostedt 
7843ce5e4803S王贇 	/*
7844ce5e4803S王贇 	 * The ftrace_test_and_set_recursion() will disable preemption,
7845ce5e4803S王贇 	 * which is required since some of the ops may be dynamically
7846ce5e4803S王贇 	 * allocated, they must be freed after a synchronize_rcu().
7847ce5e4803S王贇 	 */
7848ed65df63SSteven Rostedt (VMware) 	bit = trace_test_and_set_recursion(ip, parent_ip, TRACE_LIST_START);
7849edc15cafSSteven Rostedt 	if (bit < 0)
7850b1cff0adSSteven Rostedt 		return;
7851b1cff0adSSteven Rostedt 
78520a016409SSteven Rostedt 	do_for_each_ftrace_op(op, ftrace_ops_list) {
78532fa717a0SSteven Rostedt (VMware) 		/* Stub functions don't need to be called nor tested */
78542fa717a0SSteven Rostedt (VMware) 		if (op->flags & FTRACE_OPS_FL_STUB)
78552fa717a0SSteven Rostedt (VMware) 			continue;
7856ba27f2bcSSteven Rostedt (Red Hat) 		/*
7857ba27f2bcSSteven Rostedt (Red Hat) 		 * Check the following for each ops before calling their func:
7858ba27f2bcSSteven Rostedt (Red Hat) 		 *  if RCU flag is set, then rcu_is_watching() must be true
7859ba27f2bcSSteven Rostedt (Red Hat) 		 *  Otherwise test if the ip matches the ops filter
7860ba27f2bcSSteven Rostedt (Red Hat) 		 *
7861ba27f2bcSSteven Rostedt (Red Hat) 		 * If any of the above fails then the op->func() is not executed.
7862ba27f2bcSSteven Rostedt (Red Hat) 		 */
7863ba27f2bcSSteven Rostedt (Red Hat) 		if ((!(op->flags & FTRACE_OPS_FL_RCU) || rcu_is_watching()) &&
7864ba27f2bcSSteven Rostedt (Red Hat) 		    ftrace_ops_test(op, ip, regs)) {
78651d48d596SSteven Rostedt (Red Hat) 			if (FTRACE_WARN_ON(!op->func)) {
78661d48d596SSteven Rostedt (Red Hat) 				pr_warn("op=%p %pS\n", op, op);
78674104d326SSteven Rostedt (Red Hat) 				goto out;
78684104d326SSteven Rostedt (Red Hat) 			}
7869d19ad077SSteven Rostedt (VMware) 			op->func(ip, parent_ip, op, fregs);
78704104d326SSteven Rostedt (Red Hat) 		}
78710a016409SSteven Rostedt 	} while_for_each_ftrace_op(op);
78724104d326SSteven Rostedt (Red Hat) out:
7873edc15cafSSteven Rostedt 	trace_clear_recursion(bit);
7874b848914cSSteven Rostedt }
7875b848914cSSteven Rostedt 
78762f5f6ad9SSteven Rostedt /*
78772f5f6ad9SSteven Rostedt  * Some archs only support passing ip and parent_ip. Even though
78782f5f6ad9SSteven Rostedt  * the list function ignores the op parameter, we do not want any
78792f5f6ad9SSteven Rostedt  * C side effects, where a function is called without the caller
78802f5f6ad9SSteven Rostedt  * sending a third parameter.
7881a1e2e31dSSteven Rostedt  * Archs are to support both the regs and ftrace_ops at the same time.
7882a1e2e31dSSteven Rostedt  * If they support ftrace_ops, it is assumed they support regs.
7883a1e2e31dSSteven Rostedt  * If call backs want to use regs, they must either check for regs
788406aeaaeaSMasami Hiramatsu  * being NULL, or CONFIG_DYNAMIC_FTRACE_WITH_REGS.
788506aeaaeaSMasami Hiramatsu  * Note, CONFIG_DYNAMIC_FTRACE_WITH_REGS expects a full regs to be saved.
7886a1e2e31dSSteven Rostedt  * An architecture can pass partial regs with ftrace_ops and still
7887b8ec330aSLi Bin  * set the ARCH_SUPPORTS_FTRACE_OPS.
788834cdd18bSSteven Rostedt (VMware)  *
788934cdd18bSSteven Rostedt (VMware)  * In vmlinux.lds.h, ftrace_ops_list_func() is defined to be
789034cdd18bSSteven Rostedt (VMware)  * arch_ftrace_ops_list_func.
78912f5f6ad9SSteven Rostedt  */
78922f5f6ad9SSteven Rostedt #if ARCH_SUPPORTS_FTRACE_OPS
789334cdd18bSSteven Rostedt (VMware) void arch_ftrace_ops_list_func(unsigned long ip, unsigned long parent_ip,
7894d19ad077SSteven Rostedt (VMware) 			       struct ftrace_ops *op, struct ftrace_regs *fregs)
78952f5f6ad9SSteven Rostedt {
7896d19ad077SSteven Rostedt (VMware) 	__ftrace_ops_list_func(ip, parent_ip, NULL, fregs);
78972f5f6ad9SSteven Rostedt }
78982f5f6ad9SSteven Rostedt #else
789934cdd18bSSteven Rostedt (VMware) void arch_ftrace_ops_list_func(unsigned long ip, unsigned long parent_ip)
79002f5f6ad9SSteven Rostedt {
7901a1e2e31dSSteven Rostedt 	__ftrace_ops_list_func(ip, parent_ip, NULL, NULL);
79022f5f6ad9SSteven Rostedt }
79032f5f6ad9SSteven Rostedt #endif
790434cdd18bSSteven Rostedt (VMware) NOKPROBE_SYMBOL(arch_ftrace_ops_list_func);
79052f5f6ad9SSteven Rostedt 
7906f1ff6348SSteven Rostedt (Red Hat) /*
7907f1ff6348SSteven Rostedt (Red Hat)  * If there's only one function registered but it does not support
790878a01febSZheng Yejian  * recursion, needs RCU protection, then this function will be called
790978a01febSZheng Yejian  * by the mcount trampoline.
7910f1ff6348SSteven Rostedt (Red Hat)  */
7911c68c0fa2SSteven Rostedt (Red Hat) static void ftrace_ops_assist_func(unsigned long ip, unsigned long parent_ip,
7912d19ad077SSteven Rostedt (VMware) 				   struct ftrace_ops *op, struct ftrace_regs *fregs)
7913f1ff6348SSteven Rostedt (Red Hat) {
7914f1ff6348SSteven Rostedt (Red Hat) 	int bit;
7915f1ff6348SSteven Rostedt (Red Hat) 
7916ed65df63SSteven Rostedt (VMware) 	bit = trace_test_and_set_recursion(ip, parent_ip, TRACE_LIST_START);
7917f1ff6348SSteven Rostedt (Red Hat) 	if (bit < 0)
7918f1ff6348SSteven Rostedt (Red Hat) 		return;
7919f1ff6348SSteven Rostedt (Red Hat) 
7920b40341faSSteven Rostedt (VMware) 	if (!(op->flags & FTRACE_OPS_FL_RCU) || rcu_is_watching())
7921d19ad077SSteven Rostedt (VMware) 		op->func(ip, parent_ip, op, fregs);
7922c68c0fa2SSteven Rostedt (Red Hat) 
7923f1ff6348SSteven Rostedt (Red Hat) 	trace_clear_recursion(bit);
7924f1ff6348SSteven Rostedt (Red Hat) }
7925fabe38abSMasami Hiramatsu NOKPROBE_SYMBOL(ftrace_ops_assist_func);
7926f1ff6348SSteven Rostedt (Red Hat) 
792787354059SSteven Rostedt (Red Hat) /**
792887354059SSteven Rostedt (Red Hat)  * ftrace_ops_get_func - get the function a trampoline should call
792987354059SSteven Rostedt (Red Hat)  * @ops: the ops to get the function for
793087354059SSteven Rostedt (Red Hat)  *
793187354059SSteven Rostedt (Red Hat)  * Normally the mcount trampoline will call the ops->func, but there
793287354059SSteven Rostedt (Red Hat)  * are times that it should not. For example, if the ops does not
793387354059SSteven Rostedt (Red Hat)  * have its own recursion protection, then it should call the
79343a150df9SChunyu Hu  * ftrace_ops_assist_func() instead.
793587354059SSteven Rostedt (Red Hat)  *
7936d1530413SRandy Dunlap  * Returns: the function that the trampoline should call for @ops.
793787354059SSteven Rostedt (Red Hat)  */
793887354059SSteven Rostedt (Red Hat) ftrace_func_t ftrace_ops_get_func(struct ftrace_ops *ops)
793987354059SSteven Rostedt (Red Hat) {
794087354059SSteven Rostedt (Red Hat) 	/*
7941a25d036dSSteven Rostedt (VMware) 	 * If the function does not handle recursion or needs to be RCU safe,
7942a25d036dSSteven Rostedt (VMware) 	 * then we need to call the assist handler.
794387354059SSteven Rostedt (Red Hat) 	 */
7944a25d036dSSteven Rostedt (VMware) 	if (ops->flags & (FTRACE_OPS_FL_RECURSION |
7945a25d036dSSteven Rostedt (VMware) 			  FTRACE_OPS_FL_RCU))
7946c68c0fa2SSteven Rostedt (Red Hat) 		return ftrace_ops_assist_func;
794787354059SSteven Rostedt (Red Hat) 
794887354059SSteven Rostedt (Red Hat) 	return ops->func;
794987354059SSteven Rostedt (Red Hat) }
795087354059SSteven Rostedt (Red Hat) 
7951345ddcc8SSteven Rostedt (Red Hat) static void
7952345ddcc8SSteven Rostedt (Red Hat) ftrace_filter_pid_sched_switch_probe(void *data, bool preempt,
7953fa2c3254SValentin Schneider 				     struct task_struct *prev,
79549c2136beSDelyan Kratunov 				     struct task_struct *next,
79559c2136beSDelyan Kratunov 				     unsigned int prev_state)
7956e32d8956SSteven Rostedt {
7957345ddcc8SSteven Rostedt (Red Hat) 	struct trace_array *tr = data;
7958345ddcc8SSteven Rostedt (Red Hat) 	struct trace_pid_list *pid_list;
7959b3b1e6edSSteven Rostedt (VMware) 	struct trace_pid_list *no_pid_list;
7960345ddcc8SSteven Rostedt (Red Hat) 
7961345ddcc8SSteven Rostedt (Red Hat) 	pid_list = rcu_dereference_sched(tr->function_pids);
7962b3b1e6edSSteven Rostedt (VMware) 	no_pid_list = rcu_dereference_sched(tr->function_no_pids);
7963345ddcc8SSteven Rostedt (Red Hat) 
7964b3b1e6edSSteven Rostedt (VMware) 	if (trace_ignore_this_task(pid_list, no_pid_list, next))
79651c5eb448SSteven Rostedt (VMware) 		this_cpu_write(tr->array_buffer.data->ftrace_ignore_pid,
7966717e3f5eSSteven Rostedt (VMware) 			       FTRACE_PID_IGNORE);
7967717e3f5eSSteven Rostedt (VMware) 	else
7968717e3f5eSSteven Rostedt (VMware) 		this_cpu_write(tr->array_buffer.data->ftrace_ignore_pid,
7969717e3f5eSSteven Rostedt (VMware) 			       next->pid);
7970345ddcc8SSteven Rostedt (Red Hat) }
7971345ddcc8SSteven Rostedt (Red Hat) 
79721e10486fSNamhyung Kim static void
79731e10486fSNamhyung Kim ftrace_pid_follow_sched_process_fork(void *data,
79741e10486fSNamhyung Kim 				     struct task_struct *self,
79751e10486fSNamhyung Kim 				     struct task_struct *task)
79761e10486fSNamhyung Kim {
79771e10486fSNamhyung Kim 	struct trace_pid_list *pid_list;
79781e10486fSNamhyung Kim 	struct trace_array *tr = data;
79791e10486fSNamhyung Kim 
79801e10486fSNamhyung Kim 	pid_list = rcu_dereference_sched(tr->function_pids);
79811e10486fSNamhyung Kim 	trace_filter_add_remove_task(pid_list, self, task);
7982b3b1e6edSSteven Rostedt (VMware) 
7983b3b1e6edSSteven Rostedt (VMware) 	pid_list = rcu_dereference_sched(tr->function_no_pids);
7984b3b1e6edSSteven Rostedt (VMware) 	trace_filter_add_remove_task(pid_list, self, task);
79851e10486fSNamhyung Kim }
79861e10486fSNamhyung Kim 
79871e10486fSNamhyung Kim static void
79881e10486fSNamhyung Kim ftrace_pid_follow_sched_process_exit(void *data, struct task_struct *task)
79891e10486fSNamhyung Kim {
79901e10486fSNamhyung Kim 	struct trace_pid_list *pid_list;
79911e10486fSNamhyung Kim 	struct trace_array *tr = data;
79921e10486fSNamhyung Kim 
79931e10486fSNamhyung Kim 	pid_list = rcu_dereference_sched(tr->function_pids);
79941e10486fSNamhyung Kim 	trace_filter_add_remove_task(pid_list, NULL, task);
7995b3b1e6edSSteven Rostedt (VMware) 
7996b3b1e6edSSteven Rostedt (VMware) 	pid_list = rcu_dereference_sched(tr->function_no_pids);
7997b3b1e6edSSteven Rostedt (VMware) 	trace_filter_add_remove_task(pid_list, NULL, task);
79981e10486fSNamhyung Kim }
79991e10486fSNamhyung Kim 
80001e10486fSNamhyung Kim void ftrace_pid_follow_fork(struct trace_array *tr, bool enable)
80011e10486fSNamhyung Kim {
80021e10486fSNamhyung Kim 	if (enable) {
80031e10486fSNamhyung Kim 		register_trace_sched_process_fork(ftrace_pid_follow_sched_process_fork,
80041e10486fSNamhyung Kim 						  tr);
8005afcab636SSteven Rostedt (VMware) 		register_trace_sched_process_free(ftrace_pid_follow_sched_process_exit,
80061e10486fSNamhyung Kim 						  tr);
80071e10486fSNamhyung Kim 	} else {
80081e10486fSNamhyung Kim 		unregister_trace_sched_process_fork(ftrace_pid_follow_sched_process_fork,
80091e10486fSNamhyung Kim 						    tr);
8010afcab636SSteven Rostedt (VMware) 		unregister_trace_sched_process_free(ftrace_pid_follow_sched_process_exit,
80111e10486fSNamhyung Kim 						    tr);
80121e10486fSNamhyung Kim 	}
80131e10486fSNamhyung Kim }
80141e10486fSNamhyung Kim 
8015b3b1e6edSSteven Rostedt (VMware) static void clear_ftrace_pids(struct trace_array *tr, int type)
8016345ddcc8SSteven Rostedt (Red Hat) {
8017345ddcc8SSteven Rostedt (Red Hat) 	struct trace_pid_list *pid_list;
8018b3b1e6edSSteven Rostedt (VMware) 	struct trace_pid_list *no_pid_list;
8019e32d8956SSteven Rostedt 	int cpu;
8020e32d8956SSteven Rostedt 
8021345ddcc8SSteven Rostedt (Red Hat) 	pid_list = rcu_dereference_protected(tr->function_pids,
8022345ddcc8SSteven Rostedt (Red Hat) 					     lockdep_is_held(&ftrace_lock));
8023b3b1e6edSSteven Rostedt (VMware) 	no_pid_list = rcu_dereference_protected(tr->function_no_pids,
8024b3b1e6edSSteven Rostedt (VMware) 						lockdep_is_held(&ftrace_lock));
8025b3b1e6edSSteven Rostedt (VMware) 
8026b3b1e6edSSteven Rostedt (VMware) 	/* Make sure there's something to do */
802727683626SSteven Rostedt (VMware) 	if (!pid_type_enabled(type, pid_list, no_pid_list))
8028345ddcc8SSteven Rostedt (Red Hat) 		return;
8029345ddcc8SSteven Rostedt (Red Hat) 
8030b3b1e6edSSteven Rostedt (VMware) 	/* See if the pids still need to be checked after this */
803127683626SSteven Rostedt (VMware) 	if (!still_need_pid_events(type, pid_list, no_pid_list)) {
8032345ddcc8SSteven Rostedt (Red Hat) 		unregister_trace_sched_switch(ftrace_filter_pid_sched_switch_probe, tr);
8033345ddcc8SSteven Rostedt (Red Hat) 		for_each_possible_cpu(cpu)
8034717e3f5eSSteven Rostedt (VMware) 			per_cpu_ptr(tr->array_buffer.data, cpu)->ftrace_ignore_pid = FTRACE_PID_TRACE;
8035b3b1e6edSSteven Rostedt (VMware) 	}
8036345ddcc8SSteven Rostedt (Red Hat) 
8037b3b1e6edSSteven Rostedt (VMware) 	if (type & TRACE_PIDS)
8038345ddcc8SSteven Rostedt (Red Hat) 		rcu_assign_pointer(tr->function_pids, NULL);
8039345ddcc8SSteven Rostedt (Red Hat) 
8040b3b1e6edSSteven Rostedt (VMware) 	if (type & TRACE_NO_PIDS)
8041b3b1e6edSSteven Rostedt (VMware) 		rcu_assign_pointer(tr->function_no_pids, NULL);
8042b3b1e6edSSteven Rostedt (VMware) 
8043345ddcc8SSteven Rostedt (Red Hat) 	/* Wait till all users are no longer using pid filtering */
804474401729SPaul E. McKenney 	synchronize_rcu();
8045345ddcc8SSteven Rostedt (Red Hat) 
8046b3b1e6edSSteven Rostedt (VMware) 	if ((type & TRACE_PIDS) && pid_list)
80476954e415SSteven Rostedt (VMware) 		trace_pid_list_free(pid_list);
8048b3b1e6edSSteven Rostedt (VMware) 
8049b3b1e6edSSteven Rostedt (VMware) 	if ((type & TRACE_NO_PIDS) && no_pid_list)
80506954e415SSteven Rostedt (VMware) 		trace_pid_list_free(no_pid_list);
8051e32d8956SSteven Rostedt }
8052e32d8956SSteven Rostedt 
8053d879d0b8SNamhyung Kim void ftrace_clear_pids(struct trace_array *tr)
8054d879d0b8SNamhyung Kim {
8055d879d0b8SNamhyung Kim 	mutex_lock(&ftrace_lock);
8056d879d0b8SNamhyung Kim 
8057b3b1e6edSSteven Rostedt (VMware) 	clear_ftrace_pids(tr, TRACE_PIDS | TRACE_NO_PIDS);
8058d879d0b8SNamhyung Kim 
8059d879d0b8SNamhyung Kim 	mutex_unlock(&ftrace_lock);
8060d879d0b8SNamhyung Kim }
8061d879d0b8SNamhyung Kim 
8062b3b1e6edSSteven Rostedt (VMware) static void ftrace_pid_reset(struct trace_array *tr, int type)
8063e32d8956SSteven Rostedt {
8064756d17eeS[email protected] 	mutex_lock(&ftrace_lock);
8065b3b1e6edSSteven Rostedt (VMware) 	clear_ftrace_pids(tr, type);
8066756d17eeS[email protected] 
8067756d17eeS[email protected] 	ftrace_update_pid_func();
8068e1effa01SSteven Rostedt (Red Hat) 	ftrace_startup_all(0);
8069756d17eeS[email protected] 
8070756d17eeS[email protected] 	mutex_unlock(&ftrace_lock);
8071756d17eeS[email protected] }
8072756d17eeS[email protected] 
8073345ddcc8SSteven Rostedt (Red Hat) /* Greater than any max PID */
8074345ddcc8SSteven Rostedt (Red Hat) #define FTRACE_NO_PIDS		(void *)(PID_MAX_LIMIT + 1)
8075345ddcc8SSteven Rostedt (Red Hat) 
8076756d17eeS[email protected] static void *fpid_start(struct seq_file *m, loff_t *pos)
8077345ddcc8SSteven Rostedt (Red Hat) 	__acquires(RCU)
8078756d17eeS[email protected] {
8079345ddcc8SSteven Rostedt (Red Hat) 	struct trace_pid_list *pid_list;
8080345ddcc8SSteven Rostedt (Red Hat) 	struct trace_array *tr = m->private;
8081345ddcc8SSteven Rostedt (Red Hat) 
8082756d17eeS[email protected] 	mutex_lock(&ftrace_lock);
8083345ddcc8SSteven Rostedt (Red Hat) 	rcu_read_lock_sched();
8084756d17eeS[email protected] 
8085345ddcc8SSteven Rostedt (Red Hat) 	pid_list = rcu_dereference_sched(tr->function_pids);
8086756d17eeS[email protected] 
8087345ddcc8SSteven Rostedt (Red Hat) 	if (!pid_list)
8088345ddcc8SSteven Rostedt (Red Hat) 		return !(*pos) ? FTRACE_NO_PIDS : NULL;
8089345ddcc8SSteven Rostedt (Red Hat) 
8090345ddcc8SSteven Rostedt (Red Hat) 	return trace_pid_start(pid_list, pos);
8091756d17eeS[email protected] }
8092756d17eeS[email protected] 
8093756d17eeS[email protected] static void *fpid_next(struct seq_file *m, void *v, loff_t *pos)
8094756d17eeS[email protected] {
8095345ddcc8SSteven Rostedt (Red Hat) 	struct trace_array *tr = m->private;
8096345ddcc8SSteven Rostedt (Red Hat) 	struct trace_pid_list *pid_list = rcu_dereference_sched(tr->function_pids);
8097345ddcc8SSteven Rostedt (Red Hat) 
8098e4075e8bSVasily Averin 	if (v == FTRACE_NO_PIDS) {
8099e4075e8bSVasily Averin 		(*pos)++;
8100756d17eeS[email protected] 		return NULL;
8101e4075e8bSVasily Averin 	}
8102345ddcc8SSteven Rostedt (Red Hat) 	return trace_pid_next(pid_list, v, pos);
8103756d17eeS[email protected] }
8104756d17eeS[email protected] 
8105756d17eeS[email protected] static void fpid_stop(struct seq_file *m, void *p)
8106345ddcc8SSteven Rostedt (Red Hat) 	__releases(RCU)
8107756d17eeS[email protected] {
8108345ddcc8SSteven Rostedt (Red Hat) 	rcu_read_unlock_sched();
8109756d17eeS[email protected] 	mutex_unlock(&ftrace_lock);
8110756d17eeS[email protected] }
8111756d17eeS[email protected] 
8112756d17eeS[email protected] static int fpid_show(struct seq_file *m, void *v)
8113756d17eeS[email protected] {
8114345ddcc8SSteven Rostedt (Red Hat) 	if (v == FTRACE_NO_PIDS) {
8115fa6f0cc7SRasmus Villemoes 		seq_puts(m, "no pid\n");
8116756d17eeS[email protected] 		return 0;
8117756d17eeS[email protected] 	}
8118756d17eeS[email protected] 
8119345ddcc8SSteven Rostedt (Red Hat) 	return trace_pid_show(m, v);
8120756d17eeS[email protected] }
8121756d17eeS[email protected] 
8122756d17eeS[email protected] static const struct seq_operations ftrace_pid_sops = {
8123756d17eeS[email protected] 	.start = fpid_start,
8124756d17eeS[email protected] 	.next = fpid_next,
8125756d17eeS[email protected] 	.stop = fpid_stop,
8126756d17eeS[email protected] 	.show = fpid_show,
8127756d17eeS[email protected] };
8128756d17eeS[email protected] 
8129b3b1e6edSSteven Rostedt (VMware) static void *fnpid_start(struct seq_file *m, loff_t *pos)
8130b3b1e6edSSteven Rostedt (VMware) 	__acquires(RCU)
8131756d17eeS[email protected] {
8132b3b1e6edSSteven Rostedt (VMware) 	struct trace_pid_list *pid_list;
8133b3b1e6edSSteven Rostedt (VMware) 	struct trace_array *tr = m->private;
8134b3b1e6edSSteven Rostedt (VMware) 
8135b3b1e6edSSteven Rostedt (VMware) 	mutex_lock(&ftrace_lock);
8136b3b1e6edSSteven Rostedt (VMware) 	rcu_read_lock_sched();
8137b3b1e6edSSteven Rostedt (VMware) 
8138b3b1e6edSSteven Rostedt (VMware) 	pid_list = rcu_dereference_sched(tr->function_no_pids);
8139b3b1e6edSSteven Rostedt (VMware) 
8140b3b1e6edSSteven Rostedt (VMware) 	if (!pid_list)
8141b3b1e6edSSteven Rostedt (VMware) 		return !(*pos) ? FTRACE_NO_PIDS : NULL;
8142b3b1e6edSSteven Rostedt (VMware) 
8143b3b1e6edSSteven Rostedt (VMware) 	return trace_pid_start(pid_list, pos);
8144b3b1e6edSSteven Rostedt (VMware) }
8145b3b1e6edSSteven Rostedt (VMware) 
8146b3b1e6edSSteven Rostedt (VMware) static void *fnpid_next(struct seq_file *m, void *v, loff_t *pos)
8147b3b1e6edSSteven Rostedt (VMware) {
8148b3b1e6edSSteven Rostedt (VMware) 	struct trace_array *tr = m->private;
8149b3b1e6edSSteven Rostedt (VMware) 	struct trace_pid_list *pid_list = rcu_dereference_sched(tr->function_no_pids);
8150b3b1e6edSSteven Rostedt (VMware) 
8151b3b1e6edSSteven Rostedt (VMware) 	if (v == FTRACE_NO_PIDS) {
8152b3b1e6edSSteven Rostedt (VMware) 		(*pos)++;
8153b3b1e6edSSteven Rostedt (VMware) 		return NULL;
8154b3b1e6edSSteven Rostedt (VMware) 	}
8155b3b1e6edSSteven Rostedt (VMware) 	return trace_pid_next(pid_list, v, pos);
8156b3b1e6edSSteven Rostedt (VMware) }
8157b3b1e6edSSteven Rostedt (VMware) 
8158b3b1e6edSSteven Rostedt (VMware) static const struct seq_operations ftrace_no_pid_sops = {
8159b3b1e6edSSteven Rostedt (VMware) 	.start = fnpid_start,
8160b3b1e6edSSteven Rostedt (VMware) 	.next = fnpid_next,
8161b3b1e6edSSteven Rostedt (VMware) 	.stop = fpid_stop,
8162b3b1e6edSSteven Rostedt (VMware) 	.show = fpid_show,
8163b3b1e6edSSteven Rostedt (VMware) };
8164b3b1e6edSSteven Rostedt (VMware) 
8165b3b1e6edSSteven Rostedt (VMware) static int pid_open(struct inode *inode, struct file *file, int type)
8166b3b1e6edSSteven Rostedt (VMware) {
8167b3b1e6edSSteven Rostedt (VMware) 	const struct seq_operations *seq_ops;
8168345ddcc8SSteven Rostedt (Red Hat) 	struct trace_array *tr = inode->i_private;
8169345ddcc8SSteven Rostedt (Red Hat) 	struct seq_file *m;
8170756d17eeS[email protected] 	int ret = 0;
8171756d17eeS[email protected] 
81728530dec6SSteven Rostedt (VMware) 	ret = tracing_check_open_get_tr(tr);
81738530dec6SSteven Rostedt (VMware) 	if (ret)
81748530dec6SSteven Rostedt (VMware) 		return ret;
8175345ddcc8SSteven Rostedt (Red Hat) 
8176756d17eeS[email protected] 	if ((file->f_mode & FMODE_WRITE) &&
8177756d17eeS[email protected] 	    (file->f_flags & O_TRUNC))
8178b3b1e6edSSteven Rostedt (VMware) 		ftrace_pid_reset(tr, type);
8179756d17eeS[email protected] 
8180b3b1e6edSSteven Rostedt (VMware) 	switch (type) {
8181b3b1e6edSSteven Rostedt (VMware) 	case TRACE_PIDS:
8182b3b1e6edSSteven Rostedt (VMware) 		seq_ops = &ftrace_pid_sops;
8183b3b1e6edSSteven Rostedt (VMware) 		break;
8184b3b1e6edSSteven Rostedt (VMware) 	case TRACE_NO_PIDS:
8185b3b1e6edSSteven Rostedt (VMware) 		seq_ops = &ftrace_no_pid_sops;
8186b3b1e6edSSteven Rostedt (VMware) 		break;
8187026bb845SKaitao Cheng 	default:
8188026bb845SKaitao Cheng 		trace_array_put(tr);
8189026bb845SKaitao Cheng 		WARN_ON_ONCE(1);
8190026bb845SKaitao Cheng 		return -EINVAL;
8191b3b1e6edSSteven Rostedt (VMware) 	}
8192b3b1e6edSSteven Rostedt (VMware) 
8193b3b1e6edSSteven Rostedt (VMware) 	ret = seq_open(file, seq_ops);
8194345ddcc8SSteven Rostedt (Red Hat) 	if (ret < 0) {
8195345ddcc8SSteven Rostedt (Red Hat) 		trace_array_put(tr);
8196345ddcc8SSteven Rostedt (Red Hat) 	} else {
8197345ddcc8SSteven Rostedt (Red Hat) 		m = file->private_data;
8198345ddcc8SSteven Rostedt (Red Hat) 		/* copy tr over to seq ops */
8199345ddcc8SSteven Rostedt (Red Hat) 		m->private = tr;
8200345ddcc8SSteven Rostedt (Red Hat) 	}
8201756d17eeS[email protected] 
8202756d17eeS[email protected] 	return ret;
8203756d17eeS[email protected] }
8204756d17eeS[email protected] 
8205b3b1e6edSSteven Rostedt (VMware) static int
8206b3b1e6edSSteven Rostedt (VMware) ftrace_pid_open(struct inode *inode, struct file *file)
8207b3b1e6edSSteven Rostedt (VMware) {
8208b3b1e6edSSteven Rostedt (VMware) 	return pid_open(inode, file, TRACE_PIDS);
8209b3b1e6edSSteven Rostedt (VMware) }
8210b3b1e6edSSteven Rostedt (VMware) 
8211b3b1e6edSSteven Rostedt (VMware) static int
8212b3b1e6edSSteven Rostedt (VMware) ftrace_no_pid_open(struct inode *inode, struct file *file)
8213b3b1e6edSSteven Rostedt (VMware) {
8214b3b1e6edSSteven Rostedt (VMware) 	return pid_open(inode, file, TRACE_NO_PIDS);
8215b3b1e6edSSteven Rostedt (VMware) }
8216b3b1e6edSSteven Rostedt (VMware) 
8217345ddcc8SSteven Rostedt (Red Hat) static void ignore_task_cpu(void *data)
8218345ddcc8SSteven Rostedt (Red Hat) {
8219345ddcc8SSteven Rostedt (Red Hat) 	struct trace_array *tr = data;
8220345ddcc8SSteven Rostedt (Red Hat) 	struct trace_pid_list *pid_list;
8221b3b1e6edSSteven Rostedt (VMware) 	struct trace_pid_list *no_pid_list;
8222345ddcc8SSteven Rostedt (Red Hat) 
8223345ddcc8SSteven Rostedt (Red Hat) 	/*
8224345ddcc8SSteven Rostedt (Red Hat) 	 * This function is called by on_each_cpu() while the
8225345ddcc8SSteven Rostedt (Red Hat) 	 * event_mutex is held.
8226345ddcc8SSteven Rostedt (Red Hat) 	 */
8227345ddcc8SSteven Rostedt (Red Hat) 	pid_list = rcu_dereference_protected(tr->function_pids,
8228345ddcc8SSteven Rostedt (Red Hat) 					     mutex_is_locked(&ftrace_lock));
8229b3b1e6edSSteven Rostedt (VMware) 	no_pid_list = rcu_dereference_protected(tr->function_no_pids,
8230b3b1e6edSSteven Rostedt (VMware) 						mutex_is_locked(&ftrace_lock));
8231345ddcc8SSteven Rostedt (Red Hat) 
8232b3b1e6edSSteven Rostedt (VMware) 	if (trace_ignore_this_task(pid_list, no_pid_list, current))
82331c5eb448SSteven Rostedt (VMware) 		this_cpu_write(tr->array_buffer.data->ftrace_ignore_pid,
8234717e3f5eSSteven Rostedt (VMware) 			       FTRACE_PID_IGNORE);
8235717e3f5eSSteven Rostedt (VMware) 	else
8236717e3f5eSSteven Rostedt (VMware) 		this_cpu_write(tr->array_buffer.data->ftrace_ignore_pid,
8237717e3f5eSSteven Rostedt (VMware) 			       current->pid);
8238345ddcc8SSteven Rostedt (Red Hat) }
8239345ddcc8SSteven Rostedt (Red Hat) 
8240df4fc315SSteven Rostedt static ssize_t
8241b3b1e6edSSteven Rostedt (VMware) pid_write(struct file *filp, const char __user *ubuf,
8242b3b1e6edSSteven Rostedt (VMware) 	  size_t cnt, loff_t *ppos, int type)
8243df4fc315SSteven Rostedt {
8244345ddcc8SSteven Rostedt (Red Hat) 	struct seq_file *m = filp->private_data;
8245345ddcc8SSteven Rostedt (Red Hat) 	struct trace_array *tr = m->private;
8246b3b1e6edSSteven Rostedt (VMware) 	struct trace_pid_list *filtered_pids;
8247b3b1e6edSSteven Rostedt (VMware) 	struct trace_pid_list *other_pids;
8248345ddcc8SSteven Rostedt (Red Hat) 	struct trace_pid_list *pid_list;
8249345ddcc8SSteven Rostedt (Red Hat) 	ssize_t ret;
8250df4fc315SSteven Rostedt 
8251345ddcc8SSteven Rostedt (Red Hat) 	if (!cnt)
8252345ddcc8SSteven Rostedt (Red Hat) 		return 0;
8253df4fc315SSteven Rostedt 
8254345ddcc8SSteven Rostedt (Red Hat) 	mutex_lock(&ftrace_lock);
8255df4fc315SSteven Rostedt 
8256b3b1e6edSSteven Rostedt (VMware) 	switch (type) {
8257b3b1e6edSSteven Rostedt (VMware) 	case TRACE_PIDS:
8258345ddcc8SSteven Rostedt (Red Hat) 		filtered_pids = rcu_dereference_protected(tr->function_pids,
8259345ddcc8SSteven Rostedt (Red Hat) 					     lockdep_is_held(&ftrace_lock));
8260b3b1e6edSSteven Rostedt (VMware) 		other_pids = rcu_dereference_protected(tr->function_no_pids,
8261b3b1e6edSSteven Rostedt (VMware) 					     lockdep_is_held(&ftrace_lock));
8262b3b1e6edSSteven Rostedt (VMware) 		break;
8263b3b1e6edSSteven Rostedt (VMware) 	case TRACE_NO_PIDS:
8264b3b1e6edSSteven Rostedt (VMware) 		filtered_pids = rcu_dereference_protected(tr->function_no_pids,
8265b3b1e6edSSteven Rostedt (VMware) 					     lockdep_is_held(&ftrace_lock));
8266b3b1e6edSSteven Rostedt (VMware) 		other_pids = rcu_dereference_protected(tr->function_pids,
8267b3b1e6edSSteven Rostedt (VMware) 					     lockdep_is_held(&ftrace_lock));
8268b3b1e6edSSteven Rostedt (VMware) 		break;
8269026bb845SKaitao Cheng 	default:
8270026bb845SKaitao Cheng 		ret = -EINVAL;
8271026bb845SKaitao Cheng 		WARN_ON_ONCE(1);
8272026bb845SKaitao Cheng 		goto out;
8273b3b1e6edSSteven Rostedt (VMware) 	}
8274345ddcc8SSteven Rostedt (Red Hat) 
8275345ddcc8SSteven Rostedt (Red Hat) 	ret = trace_pid_write(filtered_pids, &pid_list, ubuf, cnt);
8276345ddcc8SSteven Rostedt (Red Hat) 	if (ret < 0)
8277345ddcc8SSteven Rostedt (Red Hat) 		goto out;
8278345ddcc8SSteven Rostedt (Red Hat) 
8279b3b1e6edSSteven Rostedt (VMware) 	switch (type) {
8280b3b1e6edSSteven Rostedt (VMware) 	case TRACE_PIDS:
8281345ddcc8SSteven Rostedt (Red Hat) 		rcu_assign_pointer(tr->function_pids, pid_list);
8282b3b1e6edSSteven Rostedt (VMware) 		break;
8283b3b1e6edSSteven Rostedt (VMware) 	case TRACE_NO_PIDS:
8284b3b1e6edSSteven Rostedt (VMware) 		rcu_assign_pointer(tr->function_no_pids, pid_list);
8285b3b1e6edSSteven Rostedt (VMware) 		break;
8286b3b1e6edSSteven Rostedt (VMware) 	}
8287b3b1e6edSSteven Rostedt (VMware) 
8288345ddcc8SSteven Rostedt (Red Hat) 
8289345ddcc8SSteven Rostedt (Red Hat) 	if (filtered_pids) {
829074401729SPaul E. McKenney 		synchronize_rcu();
82916954e415SSteven Rostedt (VMware) 		trace_pid_list_free(filtered_pids);
8292b3b1e6edSSteven Rostedt (VMware) 	} else if (pid_list && !other_pids) {
8293345ddcc8SSteven Rostedt (Red Hat) 		/* Register a probe to set whether to ignore the tracing of a task */
8294345ddcc8SSteven Rostedt (Red Hat) 		register_trace_sched_switch(ftrace_filter_pid_sched_switch_probe, tr);
8295345ddcc8SSteven Rostedt (Red Hat) 	}
8296df4fc315SSteven Rostedt 
8297756d17eeS[email protected] 	/*
8298345ddcc8SSteven Rostedt (Red Hat) 	 * Ignoring of pids is done at task switch. But we have to
8299345ddcc8SSteven Rostedt (Red Hat) 	 * check for those tasks that are currently running.
8300345ddcc8SSteven Rostedt (Red Hat) 	 * Always do this in case a pid was appended or removed.
8301756d17eeS[email protected] 	 */
8302345ddcc8SSteven Rostedt (Red Hat) 	on_each_cpu(ignore_task_cpu, tr, 1);
8303756d17eeS[email protected] 
8304345ddcc8SSteven Rostedt (Red Hat) 	ftrace_update_pid_func();
8305345ddcc8SSteven Rostedt (Red Hat) 	ftrace_startup_all(0);
8306345ddcc8SSteven Rostedt (Red Hat)  out:
8307345ddcc8SSteven Rostedt (Red Hat) 	mutex_unlock(&ftrace_lock);
8308345ddcc8SSteven Rostedt (Red Hat) 
8309345ddcc8SSteven Rostedt (Red Hat) 	if (ret > 0)
8310345ddcc8SSteven Rostedt (Red Hat) 		*ppos += ret;
8311345ddcc8SSteven Rostedt (Red Hat) 
8312df4fc315SSteven Rostedt 	return ret;
8313e32d8956SSteven Rostedt }
8314978f3a45SSteven Rostedt 
8315b3b1e6edSSteven Rostedt (VMware) static ssize_t
8316b3b1e6edSSteven Rostedt (VMware) ftrace_pid_write(struct file *filp, const char __user *ubuf,
8317b3b1e6edSSteven Rostedt (VMware) 		 size_t cnt, loff_t *ppos)
8318b3b1e6edSSteven Rostedt (VMware) {
8319b3b1e6edSSteven Rostedt (VMware) 	return pid_write(filp, ubuf, cnt, ppos, TRACE_PIDS);
8320b3b1e6edSSteven Rostedt (VMware) }
8321b3b1e6edSSteven Rostedt (VMware) 
8322b3b1e6edSSteven Rostedt (VMware) static ssize_t
8323b3b1e6edSSteven Rostedt (VMware) ftrace_no_pid_write(struct file *filp, const char __user *ubuf,
8324b3b1e6edSSteven Rostedt (VMware) 		    size_t cnt, loff_t *ppos)
8325b3b1e6edSSteven Rostedt (VMware) {
8326b3b1e6edSSteven Rostedt (VMware) 	return pid_write(filp, ubuf, cnt, ppos, TRACE_NO_PIDS);
8327b3b1e6edSSteven Rostedt (VMware) }
8328b3b1e6edSSteven Rostedt (VMware) 
8329756d17eeS[email protected] static int
8330756d17eeS[email protected] ftrace_pid_release(struct inode *inode, struct file *file)
8331756d17eeS[email protected] {
8332345ddcc8SSteven Rostedt (Red Hat) 	struct trace_array *tr = inode->i_private;
8333978f3a45SSteven Rostedt 
8334345ddcc8SSteven Rostedt (Red Hat) 	trace_array_put(tr);
8335345ddcc8SSteven Rostedt (Red Hat) 
8336345ddcc8SSteven Rostedt (Red Hat) 	return seq_release(inode, file);
8337df4fc315SSteven Rostedt }
8338df4fc315SSteven Rostedt 
83395e2336a0SSteven Rostedt static const struct file_operations ftrace_pid_fops = {
8340756d17eeS[email protected] 	.open		= ftrace_pid_open,
8341df4fc315SSteven Rostedt 	.write		= ftrace_pid_write,
8342756d17eeS[email protected] 	.read		= seq_read,
8343098c879eSSteven Rostedt (Red Hat) 	.llseek		= tracing_lseek,
8344756d17eeS[email protected] 	.release	= ftrace_pid_release,
8345df4fc315SSteven Rostedt };
8346df4fc315SSteven Rostedt 
8347b3b1e6edSSteven Rostedt (VMware) static const struct file_operations ftrace_no_pid_fops = {
8348b3b1e6edSSteven Rostedt (VMware) 	.open		= ftrace_no_pid_open,
8349b3b1e6edSSteven Rostedt (VMware) 	.write		= ftrace_no_pid_write,
8350b3b1e6edSSteven Rostedt (VMware) 	.read		= seq_read,
8351b3b1e6edSSteven Rostedt (VMware) 	.llseek		= tracing_lseek,
8352b3b1e6edSSteven Rostedt (VMware) 	.release	= ftrace_pid_release,
8353b3b1e6edSSteven Rostedt (VMware) };
8354b3b1e6edSSteven Rostedt (VMware) 
8355345ddcc8SSteven Rostedt (Red Hat) void ftrace_init_tracefs(struct trace_array *tr, struct dentry *d_tracer)
8356df4fc315SSteven Rostedt {
835721ccc9cdSSteven Rostedt (VMware) 	trace_create_file("set_ftrace_pid", TRACE_MODE_WRITE, d_tracer,
8358345ddcc8SSteven Rostedt (Red Hat) 			    tr, &ftrace_pid_fops);
835921ccc9cdSSteven Rostedt (VMware) 	trace_create_file("set_ftrace_notrace_pid", TRACE_MODE_WRITE,
836021ccc9cdSSteven Rostedt (VMware) 			  d_tracer, tr, &ftrace_no_pid_fops);
8361df4fc315SSteven Rostedt }
8362df4fc315SSteven Rostedt 
8363501c2375SSteven Rostedt (Red Hat) void __init ftrace_init_tracefs_toplevel(struct trace_array *tr,
8364501c2375SSteven Rostedt (Red Hat) 					 struct dentry *d_tracer)
8365501c2375SSteven Rostedt (Red Hat) {
8366501c2375SSteven Rostedt (Red Hat) 	/* Only the top level directory has the dyn_tracefs and profile */
8367501c2375SSteven Rostedt (Red Hat) 	WARN_ON(!(tr->flags & TRACE_ARRAY_FL_GLOBAL));
8368501c2375SSteven Rostedt (Red Hat) 
8369501c2375SSteven Rostedt (Red Hat) 	ftrace_init_dyn_tracefs(d_tracer);
8370501c2375SSteven Rostedt (Red Hat) 	ftrace_profile_tracefs(d_tracer);
8371501c2375SSteven Rostedt (Red Hat) }
8372501c2375SSteven Rostedt (Red Hat) 
83733d083395SSteven Rostedt /**
837481adbdc0SSteven Rostedt  * ftrace_kill - kill ftrace
8375a2bb6a3dSSteven Rostedt  *
8376a2bb6a3dSSteven Rostedt  * This function should be used by panic code. It stops ftrace
8377a2bb6a3dSSteven Rostedt  * but in a not so nice way. If you need to simply kill ftrace
8378a2bb6a3dSSteven Rostedt  * from a non-atomic section, use ftrace_kill.
8379a2bb6a3dSSteven Rostedt  */
838081adbdc0SSteven Rostedt void ftrace_kill(void)
8381a2bb6a3dSSteven Rostedt {
8382a2bb6a3dSSteven Rostedt 	ftrace_disabled = 1;
8383a2bb6a3dSSteven Rostedt 	ftrace_enabled = 0;
83845ccba64aSYisheng Xie 	ftrace_trace_function = ftrace_stub;
83851a7d0890SStephen Brennan 	kprobe_ftrace_kill();
8386a2bb6a3dSSteven Rostedt }
8387a2bb6a3dSSteven Rostedt 
8388a2bb6a3dSSteven Rostedt /**
83896130722fSSteven Rostedt (VMware)  * ftrace_is_dead - Test if ftrace is dead or not.
83906130722fSSteven Rostedt (VMware)  *
8391d1530413SRandy Dunlap  * Returns: 1 if ftrace is "dead", zero otherwise.
8392e0a413f6SSteven Rostedt  */
8393e0a413f6SSteven Rostedt int ftrace_is_dead(void)
8394e0a413f6SSteven Rostedt {
8395e0a413f6SSteven Rostedt 	return ftrace_disabled;
8396e0a413f6SSteven Rostedt }
8397e0a413f6SSteven Rostedt 
839853cd885bSSong Liu #ifdef CONFIG_DYNAMIC_FTRACE_WITH_DIRECT_CALLS
839953cd885bSSong Liu /*
840053cd885bSSong Liu  * When registering ftrace_ops with IPMODIFY, it is necessary to make sure
840153cd885bSSong Liu  * it doesn't conflict with any direct ftrace_ops. If there is existing
840253cd885bSSong Liu  * direct ftrace_ops on a kernel function being patched, call
840353cd885bSSong Liu  * FTRACE_OPS_CMD_ENABLE_SHARE_IPMODIFY_PEER on it to enable sharing.
840453cd885bSSong Liu  *
840553cd885bSSong Liu  * @ops:     ftrace_ops being registered.
840653cd885bSSong Liu  *
840753cd885bSSong Liu  * Returns:
840853cd885bSSong Liu  *         0 on success;
840953cd885bSSong Liu  *         Negative on failure.
841053cd885bSSong Liu  */
841153cd885bSSong Liu static int prepare_direct_functions_for_ipmodify(struct ftrace_ops *ops)
841253cd885bSSong Liu {
841353cd885bSSong Liu 	struct ftrace_func_entry *entry;
841453cd885bSSong Liu 	struct ftrace_hash *hash;
841553cd885bSSong Liu 	struct ftrace_ops *op;
841653cd885bSSong Liu 	int size, i, ret;
841753cd885bSSong Liu 
841853cd885bSSong Liu 	lockdep_assert_held_once(&direct_mutex);
841953cd885bSSong Liu 
842053cd885bSSong Liu 	if (!(ops->flags & FTRACE_OPS_FL_IPMODIFY))
842153cd885bSSong Liu 		return 0;
842253cd885bSSong Liu 
842353cd885bSSong Liu 	hash = ops->func_hash->filter_hash;
842453cd885bSSong Liu 	size = 1 << hash->size_bits;
842553cd885bSSong Liu 	for (i = 0; i < size; i++) {
842653cd885bSSong Liu 		hlist_for_each_entry(entry, &hash->buckets[i], hlist) {
842753cd885bSSong Liu 			unsigned long ip = entry->ip;
842853cd885bSSong Liu 			bool found_op = false;
842953cd885bSSong Liu 
843053cd885bSSong Liu 			mutex_lock(&ftrace_lock);
843153cd885bSSong Liu 			do_for_each_ftrace_op(op, ftrace_ops_list) {
843253cd885bSSong Liu 				if (!(op->flags & FTRACE_OPS_FL_DIRECT))
843353cd885bSSong Liu 					continue;
843453cd885bSSong Liu 				if (ops_references_ip(op, ip)) {
843553cd885bSSong Liu 					found_op = true;
843653cd885bSSong Liu 					break;
843753cd885bSSong Liu 				}
843853cd885bSSong Liu 			} while_for_each_ftrace_op(op);
843953cd885bSSong Liu 			mutex_unlock(&ftrace_lock);
844053cd885bSSong Liu 
844153cd885bSSong Liu 			if (found_op) {
844253cd885bSSong Liu 				if (!op->ops_func)
844353cd885bSSong Liu 					return -EBUSY;
844453cd885bSSong Liu 
844553cd885bSSong Liu 				ret = op->ops_func(op, FTRACE_OPS_CMD_ENABLE_SHARE_IPMODIFY_PEER);
844653cd885bSSong Liu 				if (ret)
844753cd885bSSong Liu 					return ret;
844853cd885bSSong Liu 			}
844953cd885bSSong Liu 		}
845053cd885bSSong Liu 	}
845153cd885bSSong Liu 
845253cd885bSSong Liu 	return 0;
845353cd885bSSong Liu }
845453cd885bSSong Liu 
845553cd885bSSong Liu /*
845653cd885bSSong Liu  * Similar to prepare_direct_functions_for_ipmodify, clean up after ops
845753cd885bSSong Liu  * with IPMODIFY is unregistered. The cleanup is optional for most DIRECT
845853cd885bSSong Liu  * ops.
845953cd885bSSong Liu  */
846053cd885bSSong Liu static void cleanup_direct_functions_after_ipmodify(struct ftrace_ops *ops)
846153cd885bSSong Liu {
846253cd885bSSong Liu 	struct ftrace_func_entry *entry;
846353cd885bSSong Liu 	struct ftrace_hash *hash;
846453cd885bSSong Liu 	struct ftrace_ops *op;
846553cd885bSSong Liu 	int size, i;
846653cd885bSSong Liu 
846753cd885bSSong Liu 	if (!(ops->flags & FTRACE_OPS_FL_IPMODIFY))
846853cd885bSSong Liu 		return;
846953cd885bSSong Liu 
847053cd885bSSong Liu 	mutex_lock(&direct_mutex);
847153cd885bSSong Liu 
847253cd885bSSong Liu 	hash = ops->func_hash->filter_hash;
847353cd885bSSong Liu 	size = 1 << hash->size_bits;
847453cd885bSSong Liu 	for (i = 0; i < size; i++) {
847553cd885bSSong Liu 		hlist_for_each_entry(entry, &hash->buckets[i], hlist) {
847653cd885bSSong Liu 			unsigned long ip = entry->ip;
847753cd885bSSong Liu 			bool found_op = false;
847853cd885bSSong Liu 
847953cd885bSSong Liu 			mutex_lock(&ftrace_lock);
848053cd885bSSong Liu 			do_for_each_ftrace_op(op, ftrace_ops_list) {
848153cd885bSSong Liu 				if (!(op->flags & FTRACE_OPS_FL_DIRECT))
848253cd885bSSong Liu 					continue;
848353cd885bSSong Liu 				if (ops_references_ip(op, ip)) {
848453cd885bSSong Liu 					found_op = true;
848553cd885bSSong Liu 					break;
848653cd885bSSong Liu 				}
848753cd885bSSong Liu 			} while_for_each_ftrace_op(op);
848853cd885bSSong Liu 			mutex_unlock(&ftrace_lock);
848953cd885bSSong Liu 
849053cd885bSSong Liu 			/* The cleanup is optional, ignore any errors */
849153cd885bSSong Liu 			if (found_op && op->ops_func)
849253cd885bSSong Liu 				op->ops_func(op, FTRACE_OPS_CMD_DISABLE_SHARE_IPMODIFY_PEER);
849353cd885bSSong Liu 		}
849453cd885bSSong Liu 	}
849553cd885bSSong Liu 	mutex_unlock(&direct_mutex);
849653cd885bSSong Liu }
849753cd885bSSong Liu 
849853cd885bSSong Liu #define lock_direct_mutex()	mutex_lock(&direct_mutex)
849953cd885bSSong Liu #define unlock_direct_mutex()	mutex_unlock(&direct_mutex)
850053cd885bSSong Liu 
850153cd885bSSong Liu #else  /* CONFIG_DYNAMIC_FTRACE_WITH_DIRECT_CALLS */
850253cd885bSSong Liu 
850353cd885bSSong Liu static int prepare_direct_functions_for_ipmodify(struct ftrace_ops *ops)
850453cd885bSSong Liu {
850553cd885bSSong Liu 	return 0;
850653cd885bSSong Liu }
850753cd885bSSong Liu 
850853cd885bSSong Liu static void cleanup_direct_functions_after_ipmodify(struct ftrace_ops *ops)
850953cd885bSSong Liu {
851053cd885bSSong Liu }
851153cd885bSSong Liu 
851253cd885bSSong Liu #define lock_direct_mutex()	do { } while (0)
851353cd885bSSong Liu #define unlock_direct_mutex()	do { } while (0)
851453cd885bSSong Liu 
851553cd885bSSong Liu #endif  /* CONFIG_DYNAMIC_FTRACE_WITH_DIRECT_CALLS */
851653cd885bSSong Liu 
851753cd885bSSong Liu /*
851853cd885bSSong Liu  * Similar to register_ftrace_function, except we don't lock direct_mutex.
851953cd885bSSong Liu  */
852053cd885bSSong Liu static int register_ftrace_function_nolock(struct ftrace_ops *ops)
852153cd885bSSong Liu {
852253cd885bSSong Liu 	int ret;
852353cd885bSSong Liu 
852453cd885bSSong Liu 	ftrace_ops_init(ops);
852553cd885bSSong Liu 
852653cd885bSSong Liu 	mutex_lock(&ftrace_lock);
852753cd885bSSong Liu 
852853cd885bSSong Liu 	ret = ftrace_startup(ops, 0);
852953cd885bSSong Liu 
853053cd885bSSong Liu 	mutex_unlock(&ftrace_lock);
853153cd885bSSong Liu 
853253cd885bSSong Liu 	return ret;
853353cd885bSSong Liu }
853453cd885bSSong Liu 
8535e0a413f6SSteven Rostedt /**
85363d083395SSteven Rostedt  * register_ftrace_function - register a function for profiling
853778cbc651SJiapeng Chong  * @ops:	ops structure that holds the function for profiling.
85383d083395SSteven Rostedt  *
85393d083395SSteven Rostedt  * Register a function to be called by all functions in the
85403d083395SSteven Rostedt  * kernel.
85413d083395SSteven Rostedt  *
85423d083395SSteven Rostedt  * Note: @ops->func and all the functions it calls must be labeled
85433d083395SSteven Rostedt  *       with "notrace", otherwise it will go into a
85443d083395SSteven Rostedt  *       recursive loop.
85453d083395SSteven Rostedt  */
85463d083395SSteven Rostedt int register_ftrace_function(struct ftrace_ops *ops)
85473d083395SSteven Rostedt {
85483b1a8f45SColin Ian King 	int ret;
85494eebcc81SSteven Rostedt 
855053cd885bSSong Liu 	lock_direct_mutex();
855153cd885bSSong Liu 	ret = prepare_direct_functions_for_ipmodify(ops);
855253cd885bSSong Liu 	if (ret < 0)
855353cd885bSSong Liu 		goto out_unlock;
8554f04f24fbSMasami Hiramatsu 
855553cd885bSSong Liu 	ret = register_ftrace_function_nolock(ops);
8556e7d3737eSFrederic Weisbecker 
855753cd885bSSong Liu out_unlock:
855853cd885bSSong Liu 	unlock_direct_mutex();
8559b0fc494fSSteven Rostedt 	return ret;
85603d083395SSteven Rostedt }
8561cdbe61bfSSteven Rostedt EXPORT_SYMBOL_GPL(register_ftrace_function);
85623d083395SSteven Rostedt 
85633d083395SSteven Rostedt /**
856432632920SUwe Kleine-Koenig  * unregister_ftrace_function - unregister a function for profiling.
856578cbc651SJiapeng Chong  * @ops:	ops structure that holds the function to unregister
85663d083395SSteven Rostedt  *
85673d083395SSteven Rostedt  * Unregister a function that was added to be called by ftrace profiling.
85683d083395SSteven Rostedt  */
85693d083395SSteven Rostedt int unregister_ftrace_function(struct ftrace_ops *ops)
85703d083395SSteven Rostedt {
85713d083395SSteven Rostedt 	int ret;
85723d083395SSteven Rostedt 
8573e6ea44e9SSteven Rostedt 	mutex_lock(&ftrace_lock);
85748a56d776SSteven Rostedt (Red Hat) 	ret = ftrace_shutdown(ops, 0);
8575e6ea44e9SSteven Rostedt 	mutex_unlock(&ftrace_lock);
8576b0fc494fSSteven Rostedt 
857753cd885bSSong Liu 	cleanup_direct_functions_after_ipmodify(ops);
8578b0fc494fSSteven Rostedt 	return ret;
8579b0fc494fSSteven Rostedt }
8580cdbe61bfSSteven Rostedt EXPORT_SYMBOL_GPL(unregister_ftrace_function);
8581b0fc494fSSteven Rostedt 
8582bed0d9a5SJiri Olsa static int symbols_cmp(const void *a, const void *b)
8583bed0d9a5SJiri Olsa {
8584bed0d9a5SJiri Olsa 	const char **str_a = (const char **) a;
8585bed0d9a5SJiri Olsa 	const char **str_b = (const char **) b;
8586bed0d9a5SJiri Olsa 
8587bed0d9a5SJiri Olsa 	return strcmp(*str_a, *str_b);
8588bed0d9a5SJiri Olsa }
8589bed0d9a5SJiri Olsa 
8590bed0d9a5SJiri Olsa struct kallsyms_data {
8591bed0d9a5SJiri Olsa 	unsigned long *addrs;
8592bed0d9a5SJiri Olsa 	const char **syms;
8593bed0d9a5SJiri Olsa 	size_t cnt;
8594bed0d9a5SJiri Olsa 	size_t found;
8595bed0d9a5SJiri Olsa };
8596bed0d9a5SJiri Olsa 
85973640bf85SJiri Olsa /* This function gets called for all kernel and module symbols
85983640bf85SJiri Olsa  * and returns 1 in case we resolved all the requested symbols,
85993640bf85SJiri Olsa  * 0 otherwise.
86003640bf85SJiri Olsa  */
86013703bd54SZhen Lei static int kallsyms_callback(void *data, const char *name, unsigned long addr)
8602bed0d9a5SJiri Olsa {
8603bed0d9a5SJiri Olsa 	struct kallsyms_data *args = data;
8604eb1b2985SJiri Olsa 	const char **sym;
8605eb1b2985SJiri Olsa 	int idx;
8606bed0d9a5SJiri Olsa 
8607eb1b2985SJiri Olsa 	sym = bsearch(&name, args->syms, args->cnt, sizeof(*args->syms), symbols_cmp);
8608eb1b2985SJiri Olsa 	if (!sym)
8609eb1b2985SJiri Olsa 		return 0;
8610eb1b2985SJiri Olsa 
8611eb1b2985SJiri Olsa 	idx = sym - args->syms;
8612eb1b2985SJiri Olsa 	if (args->addrs[idx])
8613bed0d9a5SJiri Olsa 		return 0;
8614bed0d9a5SJiri Olsa 
86159d68c19cSJiri Olsa 	if (!ftrace_location(addr))
8616bed0d9a5SJiri Olsa 		return 0;
8617bed0d9a5SJiri Olsa 
8618eb1b2985SJiri Olsa 	args->addrs[idx] = addr;
8619eb1b2985SJiri Olsa 	args->found++;
8620bed0d9a5SJiri Olsa 	return args->found == args->cnt ? 1 : 0;
8621bed0d9a5SJiri Olsa }
8622bed0d9a5SJiri Olsa 
8623bed0d9a5SJiri Olsa /**
8624bed0d9a5SJiri Olsa  * ftrace_lookup_symbols - Lookup addresses for array of symbols
8625bed0d9a5SJiri Olsa  *
8626bed0d9a5SJiri Olsa  * @sorted_syms: array of symbols pointers symbols to resolve,
8627bed0d9a5SJiri Olsa  * must be alphabetically sorted
8628bed0d9a5SJiri Olsa  * @cnt: number of symbols/addresses in @syms/@addrs arrays
8629bed0d9a5SJiri Olsa  * @addrs: array for storing resulting addresses
8630bed0d9a5SJiri Olsa  *
8631bed0d9a5SJiri Olsa  * This function looks up addresses for array of symbols provided in
8632bed0d9a5SJiri Olsa  * @syms array (must be alphabetically sorted) and stores them in
8633bed0d9a5SJiri Olsa  * @addrs array, which needs to be big enough to store at least @cnt
8634bed0d9a5SJiri Olsa  * addresses.
8635bed0d9a5SJiri Olsa  *
8636d1530413SRandy Dunlap  * Returns: 0 if all provided symbols are found, -ESRCH otherwise.
8637bed0d9a5SJiri Olsa  */
8638bed0d9a5SJiri Olsa int ftrace_lookup_symbols(const char **sorted_syms, size_t cnt, unsigned long *addrs)
8639bed0d9a5SJiri Olsa {
8640bed0d9a5SJiri Olsa 	struct kallsyms_data args;
86413640bf85SJiri Olsa 	int found_all;
8642bed0d9a5SJiri Olsa 
8643eb1b2985SJiri Olsa 	memset(addrs, 0, sizeof(*addrs) * cnt);
8644bed0d9a5SJiri Olsa 	args.addrs = addrs;
8645bed0d9a5SJiri Olsa 	args.syms = sorted_syms;
8646bed0d9a5SJiri Olsa 	args.cnt = cnt;
8647bed0d9a5SJiri Olsa 	args.found = 0;
86483640bf85SJiri Olsa 
86493640bf85SJiri Olsa 	found_all = kallsyms_on_each_symbol(kallsyms_callback, &args);
86503640bf85SJiri Olsa 	if (found_all)
86513640bf85SJiri Olsa 		return 0;
865207cc2c93SZhen Lei 	found_all = module_kallsyms_on_each_symbol(NULL, kallsyms_callback, &args);
86533640bf85SJiri Olsa 	return found_all ? 0 : -ESRCH;
8654bed0d9a5SJiri Olsa }
865544d35720SLinus Torvalds 
86565d79fa0dSYueHaibing #ifdef CONFIG_SYSCTL
86578fd7c214SLuis Chamberlain 
86588fd7c214SLuis Chamberlain #ifdef CONFIG_DYNAMIC_FTRACE
8659f8b7d2b4SLuis Chamberlain static void ftrace_startup_sysctl(void)
8660f8b7d2b4SLuis Chamberlain {
8661f8b7d2b4SLuis Chamberlain 	int command;
8662f8b7d2b4SLuis Chamberlain 
8663f8b7d2b4SLuis Chamberlain 	if (unlikely(ftrace_disabled))
8664f8b7d2b4SLuis Chamberlain 		return;
8665f8b7d2b4SLuis Chamberlain 
8666f8b7d2b4SLuis Chamberlain 	/* Force update next time */
8667f8b7d2b4SLuis Chamberlain 	saved_ftrace_func = NULL;
8668f8b7d2b4SLuis Chamberlain 	/* ftrace_start_up is true if we want ftrace running */
8669f8b7d2b4SLuis Chamberlain 	if (ftrace_start_up) {
8670f8b7d2b4SLuis Chamberlain 		command = FTRACE_UPDATE_CALLS;
8671f8b7d2b4SLuis Chamberlain 		if (ftrace_graph_active)
8672f8b7d2b4SLuis Chamberlain 			command |= FTRACE_START_FUNC_RET;
8673f8b7d2b4SLuis Chamberlain 		ftrace_startup_enable(command);
8674f8b7d2b4SLuis Chamberlain 	}
8675f8b7d2b4SLuis Chamberlain }
8676f8b7d2b4SLuis Chamberlain 
8677f8b7d2b4SLuis Chamberlain static void ftrace_shutdown_sysctl(void)
8678f8b7d2b4SLuis Chamberlain {
8679f8b7d2b4SLuis Chamberlain 	int command;
8680f8b7d2b4SLuis Chamberlain 
8681f8b7d2b4SLuis Chamberlain 	if (unlikely(ftrace_disabled))
8682f8b7d2b4SLuis Chamberlain 		return;
8683f8b7d2b4SLuis Chamberlain 
8684f8b7d2b4SLuis Chamberlain 	/* ftrace_start_up is true if ftrace is running */
8685f8b7d2b4SLuis Chamberlain 	if (ftrace_start_up) {
8686f8b7d2b4SLuis Chamberlain 		command = FTRACE_DISABLE_CALLS;
8687f8b7d2b4SLuis Chamberlain 		if (ftrace_graph_active)
8688f8b7d2b4SLuis Chamberlain 			command |= FTRACE_STOP_FUNC_RET;
8689f8b7d2b4SLuis Chamberlain 		ftrace_run_update_code(command);
8690f8b7d2b4SLuis Chamberlain 	}
8691f8b7d2b4SLuis Chamberlain }
86928fd7c214SLuis Chamberlain #else
86938fd7c214SLuis Chamberlain # define ftrace_startup_sysctl()       do { } while (0)
86948fd7c214SLuis Chamberlain # define ftrace_shutdown_sysctl()      do { } while (0)
86958fd7c214SLuis Chamberlain #endif /* CONFIG_DYNAMIC_FTRACE */
8696f8b7d2b4SLuis Chamberlain 
86977162431dSMiroslav Benes static bool is_permanent_ops_registered(void)
86987162431dSMiroslav Benes {
86997162431dSMiroslav Benes 	struct ftrace_ops *op;
87007162431dSMiroslav Benes 
87017162431dSMiroslav Benes 	do_for_each_ftrace_op(op, ftrace_ops_list) {
87027162431dSMiroslav Benes 		if (op->flags & FTRACE_OPS_FL_PERMANENT)
87037162431dSMiroslav Benes 			return true;
87047162431dSMiroslav Benes 	} while_for_each_ftrace_op(op);
87057162431dSMiroslav Benes 
87067162431dSMiroslav Benes 	return false;
87077162431dSMiroslav Benes }
87087162431dSMiroslav Benes 
87098e4e83b2SWei Xiao static int
8710b0fc494fSSteven Rostedt ftrace_enable_sysctl(struct ctl_table *table, int write,
871154fa9ba5STobias Klauser 		     void *buffer, size_t *lenp, loff_t *ppos)
8712b0fc494fSSteven Rostedt {
871345a4a237SSteven Rostedt 	int ret = -ENODEV;
87144eebcc81SSteven Rostedt 
8715e6ea44e9SSteven Rostedt 	mutex_lock(&ftrace_lock);
8716b0fc494fSSteven Rostedt 
871745a4a237SSteven Rostedt 	if (unlikely(ftrace_disabled))
871845a4a237SSteven Rostedt 		goto out;
871945a4a237SSteven Rostedt 
87208d65af78SAlexey Dobriyan 	ret = proc_dointvec(table, write, buffer, lenp, ppos);
8721b0fc494fSSteven Rostedt 
8722a32c7765SLi Zefan 	if (ret || !write || (last_ftrace_enabled == !!ftrace_enabled))
8723b0fc494fSSteven Rostedt 		goto out;
8724b0fc494fSSteven Rostedt 
8725b0fc494fSSteven Rostedt 	if (ftrace_enabled) {
8726b0fc494fSSteven Rostedt 
8727b0fc494fSSteven Rostedt 		/* we are starting ftrace again */
8728f86f4180SChunyan Zhang 		if (rcu_dereference_protected(ftrace_ops_list,
8729f86f4180SChunyan Zhang 			lockdep_is_held(&ftrace_lock)) != &ftrace_list_end)
87305000c418SJan Kiszka 			update_ftrace_function();
8731b0fc494fSSteven Rostedt 
8732524a3868SSteven Rostedt (Red Hat) 		ftrace_startup_sysctl();
8733524a3868SSteven Rostedt (Red Hat) 
8734b0fc494fSSteven Rostedt 	} else {
87357162431dSMiroslav Benes 		if (is_permanent_ops_registered()) {
87367162431dSMiroslav Benes 			ftrace_enabled = true;
87377162431dSMiroslav Benes 			ret = -EBUSY;
87387162431dSMiroslav Benes 			goto out;
87397162431dSMiroslav Benes 		}
87407162431dSMiroslav Benes 
8741b0fc494fSSteven Rostedt 		/* stopping ftrace calls (just send to ftrace_stub) */
8742b0fc494fSSteven Rostedt 		ftrace_trace_function = ftrace_stub;
8743b0fc494fSSteven Rostedt 
8744b0fc494fSSteven Rostedt 		ftrace_shutdown_sysctl();
8745b0fc494fSSteven Rostedt 	}
8746b0fc494fSSteven Rostedt 
87477162431dSMiroslav Benes 	last_ftrace_enabled = !!ftrace_enabled;
8748b0fc494fSSteven Rostedt  out:
8749e6ea44e9SSteven Rostedt 	mutex_unlock(&ftrace_lock);
87503d083395SSteven Rostedt 	return ret;
875116444a8aSArnaldo Carvalho de Melo }
87528e4e83b2SWei Xiao 
87538e4e83b2SWei Xiao static struct ctl_table ftrace_sysctls[] = {
87548e4e83b2SWei Xiao 	{
87558e4e83b2SWei Xiao 		.procname       = "ftrace_enabled",
87568e4e83b2SWei Xiao 		.data           = &ftrace_enabled,
87578e4e83b2SWei Xiao 		.maxlen         = sizeof(int),
87588e4e83b2SWei Xiao 		.mode           = 0644,
87598e4e83b2SWei Xiao 		.proc_handler   = ftrace_enable_sysctl,
87608e4e83b2SWei Xiao 	},
87618e4e83b2SWei Xiao };
87628e4e83b2SWei Xiao 
87638e4e83b2SWei Xiao static int __init ftrace_sysctl_init(void)
87648e4e83b2SWei Xiao {
87658e4e83b2SWei Xiao 	register_sysctl_init("kernel", ftrace_sysctls);
87668e4e83b2SWei Xiao 	return 0;
87678e4e83b2SWei Xiao }
87688e4e83b2SWei Xiao late_initcall(ftrace_sysctl_init);
87698e4e83b2SWei Xiao #endif
8770