xref: /linux-6.15/kernel/trace/ftrace.c (revision da8bdfbd)
1bcea3f96SSteven Rostedt (VMware) // SPDX-License-Identifier: GPL-2.0
216444a8aSArnaldo Carvalho de Melo /*
316444a8aSArnaldo Carvalho de Melo  * Infrastructure for profiling code inserted by 'gcc -pg'.
416444a8aSArnaldo Carvalho de Melo  *
516444a8aSArnaldo Carvalho de Melo  * Copyright (C) 2007-2008 Steven Rostedt <[email protected]>
616444a8aSArnaldo Carvalho de Melo  * Copyright (C) 2004-2008 Ingo Molnar <[email protected]>
716444a8aSArnaldo Carvalho de Melo  *
816444a8aSArnaldo Carvalho de Melo  * Originally ported from the -rt patch by:
916444a8aSArnaldo Carvalho de Melo  *   Copyright (C) 2007 Arnaldo Carvalho de Melo <[email protected]>
1016444a8aSArnaldo Carvalho de Melo  *
1116444a8aSArnaldo Carvalho de Melo  * Based on code in the latency_tracer, that is:
1216444a8aSArnaldo Carvalho de Melo  *
1316444a8aSArnaldo Carvalho de Melo  *  Copyright (C) 2004-2006 Ingo Molnar
146d49e352SNadia Yvette Chambers  *  Copyright (C) 2004 Nadia Yvette Chambers
1516444a8aSArnaldo Carvalho de Melo  */
1616444a8aSArnaldo Carvalho de Melo 
173d083395SSteven Rostedt #include <linux/stop_machine.h>
183d083395SSteven Rostedt #include <linux/clocksource.h>
1929930025SIngo Molnar #include <linux/sched/task.h>
203d083395SSteven Rostedt #include <linux/kallsyms.h>
2117911ff3SSteven Rostedt (VMware) #include <linux/security.h>
225072c59fSSteven Rostedt #include <linux/seq_file.h>
238434dc93SSteven Rostedt (Red Hat) #include <linux/tracefs.h>
243d083395SSteven Rostedt #include <linux/hardirq.h>
252d8b820bSIngo Molnar #include <linux/kthread.h>
265072c59fSSteven Rostedt #include <linux/uaccess.h>
275855feadSSteven Rostedt #include <linux/bsearch.h>
2856d82e00SPaul Gortmaker #include <linux/module.h>
292d8b820bSIngo Molnar #include <linux/ftrace.h>
30b0fc494fSSteven Rostedt #include <linux/sysctl.h>
315a0e3ad6STejun Heo #include <linux/slab.h>
325072c59fSSteven Rostedt #include <linux/ctype.h>
3368950619SSteven Rostedt #include <linux/sort.h>
343d083395SSteven Rostedt #include <linux/list.h>
3559df055fSSteven Rostedt #include <linux/hash.h>
363f379b03SPaul E. McKenney #include <linux/rcupdate.h>
37fabe38abSMasami Hiramatsu #include <linux/kprobes.h>
3816444a8aSArnaldo Carvalho de Melo 
39ad8d75ffSSteven Rostedt #include <trace/events/sched.h>
408aef2d28SSteven Rostedt 
41b80f0f6cSSteven Rostedt (VMware) #include <asm/sections.h>
422af15d6aSSteven Rostedt #include <asm/setup.h>
43395a59d0SAbhishek Sagar 
443306fc4aSSteven Rostedt (VMware) #include "ftrace_internal.h"
450706f1c4SSteven Rostedt #include "trace_output.h"
46bac429f0SSteven Rostedt #include "trace_stat.h"
473d083395SSteven Rostedt 
48b39181f7SSteven Rostedt (Google) #define FTRACE_INVALID_FUNCTION		"__ftrace_invalid_address__"
49b39181f7SSteven Rostedt (Google) 
506912896eSSteven Rostedt #define FTRACE_WARN_ON(cond)			\
510778d9adSSteven Rostedt 	({					\
520778d9adSSteven Rostedt 		int ___r = cond;		\
530778d9adSSteven Rostedt 		if (WARN_ON(___r))		\
546912896eSSteven Rostedt 			ftrace_kill();		\
550778d9adSSteven Rostedt 		___r;				\
560778d9adSSteven Rostedt 	})
576912896eSSteven Rostedt 
586912896eSSteven Rostedt #define FTRACE_WARN_ON_ONCE(cond)		\
590778d9adSSteven Rostedt 	({					\
600778d9adSSteven Rostedt 		int ___r = cond;		\
610778d9adSSteven Rostedt 		if (WARN_ON_ONCE(___r))		\
626912896eSSteven Rostedt 			ftrace_kill();		\
630778d9adSSteven Rostedt 		___r;				\
640778d9adSSteven Rostedt 	})
656912896eSSteven Rostedt 
668fc0c701SSteven Rostedt /* hash bits for specific function selection */
6733dc9b12SSteven Rostedt #define FTRACE_HASH_DEFAULT_BITS 10
6833dc9b12SSteven Rostedt #define FTRACE_HASH_MAX_BITS 12
698fc0c701SSteven Rostedt 
70f04f24fbSMasami Hiramatsu #ifdef CONFIG_DYNAMIC_FTRACE
7133b7f99cSSteven Rostedt (Red Hat) #define INIT_OPS_HASH(opsname)	\
7233b7f99cSSteven Rostedt (Red Hat) 	.func_hash		= &opsname.local_hash,			\
7333b7f99cSSteven Rostedt (Red Hat) 	.local_hash.regex_lock	= __MUTEX_INITIALIZER(opsname.local_hash.regex_lock),
74f04f24fbSMasami Hiramatsu #else
7533b7f99cSSteven Rostedt (Red Hat) #define INIT_OPS_HASH(opsname)
76f04f24fbSMasami Hiramatsu #endif
77f04f24fbSMasami Hiramatsu 
78a0572f68SSteven Rostedt (VMware) enum {
79a0572f68SSteven Rostedt (VMware) 	FTRACE_MODIFY_ENABLE_FL		= (1 << 0),
80a0572f68SSteven Rostedt (VMware) 	FTRACE_MODIFY_MAY_SLEEP_FL	= (1 << 1),
81a0572f68SSteven Rostedt (VMware) };
82a0572f68SSteven Rostedt (VMware) 
833306fc4aSSteven Rostedt (VMware) struct ftrace_ops ftrace_list_end __read_mostly = {
842f5f6ad9SSteven Rostedt 	.func		= ftrace_stub,
85a25d036dSSteven Rostedt (VMware) 	.flags		= FTRACE_OPS_FL_STUB,
8633b7f99cSSteven Rostedt (Red Hat) 	INIT_OPS_HASH(ftrace_list_end)
872f5f6ad9SSteven Rostedt };
882f5f6ad9SSteven Rostedt 
894eebcc81SSteven Rostedt /* ftrace_enabled is a method to turn ftrace on or off */
904eebcc81SSteven Rostedt int ftrace_enabled __read_mostly;
915d79fa0dSYueHaibing static int __maybe_unused last_ftrace_enabled;
92b0fc494fSSteven Rostedt 
932f5f6ad9SSteven Rostedt /* Current function tracing op */
942f5f6ad9SSteven Rostedt struct ftrace_ops *function_trace_op __read_mostly = &ftrace_list_end;
95405e1d83SSteven Rostedt (Red Hat) /* What to set function_trace_op to */
96405e1d83SSteven Rostedt (Red Hat) static struct ftrace_ops *set_function_trace_op;
9760a7ecf4SSteven Rostedt 
98345ddcc8SSteven Rostedt (Red Hat) static bool ftrace_pids_enabled(struct ftrace_ops *ops)
99e3eea140SSteven Rostedt (Red Hat) {
100345ddcc8SSteven Rostedt (Red Hat) 	struct trace_array *tr;
101345ddcc8SSteven Rostedt (Red Hat) 
102345ddcc8SSteven Rostedt (Red Hat) 	if (!(ops->flags & FTRACE_OPS_FL_PID) || !ops->private)
103345ddcc8SSteven Rostedt (Red Hat) 		return false;
104345ddcc8SSteven Rostedt (Red Hat) 
105345ddcc8SSteven Rostedt (Red Hat) 	tr = ops->private;
106345ddcc8SSteven Rostedt (Red Hat) 
107b3b1e6edSSteven Rostedt (VMware) 	return tr->function_pids != NULL || tr->function_no_pids != NULL;
108e3eea140SSteven Rostedt (Red Hat) }
109e3eea140SSteven Rostedt (Red Hat) 
110e3eea140SSteven Rostedt (Red Hat) static void ftrace_update_trampoline(struct ftrace_ops *ops);
111e3eea140SSteven Rostedt (Red Hat) 
1124eebcc81SSteven Rostedt /*
1134eebcc81SSteven Rostedt  * ftrace_disabled is set when an anomaly is discovered.
1144eebcc81SSteven Rostedt  * ftrace_disabled is much stronger than ftrace_enabled.
1154eebcc81SSteven Rostedt  */
1164eebcc81SSteven Rostedt static int ftrace_disabled __read_mostly;
1174eebcc81SSteven Rostedt 
1183306fc4aSSteven Rostedt (VMware) DEFINE_MUTEX(ftrace_lock);
119b0fc494fSSteven Rostedt 
1203306fc4aSSteven Rostedt (VMware) struct ftrace_ops __rcu *ftrace_ops_list __read_mostly = &ftrace_list_end;
12116444a8aSArnaldo Carvalho de Melo ftrace_func_t ftrace_trace_function __read_mostly = ftrace_stub;
1223306fc4aSSteven Rostedt (VMware) struct ftrace_ops global_ops;
12316444a8aSArnaldo Carvalho de Melo 
12450c69781SJulia Lawall /* Defined by vmlinux.lds.h see the comment above arch_ftrace_ops_list_func for details */
12534cdd18bSSteven Rostedt (VMware) void ftrace_ops_list_func(unsigned long ip, unsigned long parent_ip,
126d19ad077SSteven Rostedt (VMware) 			  struct ftrace_ops *op, struct ftrace_regs *fregs);
127b848914cSSteven Rostedt 
128cbad0fb2SMark Rutland #ifdef CONFIG_DYNAMIC_FTRACE_WITH_CALL_OPS
129cbad0fb2SMark Rutland /*
130cbad0fb2SMark Rutland  * Stub used to invoke the list ops without requiring a separate trampoline.
131cbad0fb2SMark Rutland  */
132cbad0fb2SMark Rutland const struct ftrace_ops ftrace_list_ops = {
133cbad0fb2SMark Rutland 	.func	= ftrace_ops_list_func,
134cbad0fb2SMark Rutland 	.flags	= FTRACE_OPS_FL_STUB,
135cbad0fb2SMark Rutland };
136cbad0fb2SMark Rutland 
137cbad0fb2SMark Rutland static void ftrace_ops_nop_func(unsigned long ip, unsigned long parent_ip,
138cbad0fb2SMark Rutland 				struct ftrace_ops *op,
139cbad0fb2SMark Rutland 				struct ftrace_regs *fregs)
140cbad0fb2SMark Rutland {
141cbad0fb2SMark Rutland 	/* do nothing */
142cbad0fb2SMark Rutland }
143cbad0fb2SMark Rutland 
144cbad0fb2SMark Rutland /*
145cbad0fb2SMark Rutland  * Stub used when a call site is disabled. May be called transiently by threads
146cbad0fb2SMark Rutland  * which have made it into ftrace_caller but haven't yet recovered the ops at
147cbad0fb2SMark Rutland  * the point the call site is disabled.
148cbad0fb2SMark Rutland  */
149cbad0fb2SMark Rutland const struct ftrace_ops ftrace_nop_ops = {
150cbad0fb2SMark Rutland 	.func	= ftrace_ops_nop_func,
151cbad0fb2SMark Rutland 	.flags  = FTRACE_OPS_FL_STUB,
152cbad0fb2SMark Rutland };
153cbad0fb2SMark Rutland #endif
154cbad0fb2SMark Rutland 
155f04f24fbSMasami Hiramatsu static inline void ftrace_ops_init(struct ftrace_ops *ops)
156f04f24fbSMasami Hiramatsu {
157f04f24fbSMasami Hiramatsu #ifdef CONFIG_DYNAMIC_FTRACE
158f04f24fbSMasami Hiramatsu 	if (!(ops->flags & FTRACE_OPS_FL_INITIALIZED)) {
15933b7f99cSSteven Rostedt (Red Hat) 		mutex_init(&ops->local_hash.regex_lock);
16033b7f99cSSteven Rostedt (Red Hat) 		ops->func_hash = &ops->local_hash;
161f04f24fbSMasami Hiramatsu 		ops->flags |= FTRACE_OPS_FL_INITIALIZED;
162f04f24fbSMasami Hiramatsu 	}
163f04f24fbSMasami Hiramatsu #endif
164f04f24fbSMasami Hiramatsu }
165f04f24fbSMasami Hiramatsu 
1662f5f6ad9SSteven Rostedt static void ftrace_pid_func(unsigned long ip, unsigned long parent_ip,
167d19ad077SSteven Rostedt (VMware) 			    struct ftrace_ops *op, struct ftrace_regs *fregs)
168df4fc315SSteven Rostedt {
169345ddcc8SSteven Rostedt (Red Hat) 	struct trace_array *tr = op->private;
170717e3f5eSSteven Rostedt (VMware) 	int pid;
171345ddcc8SSteven Rostedt (Red Hat) 
172717e3f5eSSteven Rostedt (VMware) 	if (tr) {
173717e3f5eSSteven Rostedt (VMware) 		pid = this_cpu_read(tr->array_buffer.data->ftrace_ignore_pid);
174717e3f5eSSteven Rostedt (VMware) 		if (pid == FTRACE_PID_IGNORE)
175df4fc315SSteven Rostedt 			return;
176717e3f5eSSteven Rostedt (VMware) 		if (pid != FTRACE_PID_TRACE &&
177717e3f5eSSteven Rostedt (VMware) 		    pid != current->pid)
178717e3f5eSSteven Rostedt (VMware) 			return;
179717e3f5eSSteven Rostedt (VMware) 	}
180df4fc315SSteven Rostedt 
181d19ad077SSteven Rostedt (VMware) 	op->saved_func(ip, parent_ip, op, fregs);
182df4fc315SSteven Rostedt }
183df4fc315SSteven Rostedt 
184405e1d83SSteven Rostedt (Red Hat) static void ftrace_sync_ipi(void *data)
185405e1d83SSteven Rostedt (Red Hat) {
186405e1d83SSteven Rostedt (Red Hat) 	/* Probably not needed, but do it anyway */
187405e1d83SSteven Rostedt (Red Hat) 	smp_rmb();
188405e1d83SSteven Rostedt (Red Hat) }
189405e1d83SSteven Rostedt (Red Hat) 
19000ccbf2fSSteven Rostedt (Red Hat) static ftrace_func_t ftrace_ops_get_list_func(struct ftrace_ops *ops)
19100ccbf2fSSteven Rostedt (Red Hat) {
19200ccbf2fSSteven Rostedt (Red Hat) 	/*
19378a01febSZheng Yejian 	 * If this is a dynamic or RCU ops, or we force list func,
19400ccbf2fSSteven Rostedt (Red Hat) 	 * then it needs to call the list anyway.
19500ccbf2fSSteven Rostedt (Red Hat) 	 */
196b3a88803SPeter Zijlstra 	if (ops->flags & (FTRACE_OPS_FL_DYNAMIC | FTRACE_OPS_FL_RCU) ||
197b3a88803SPeter Zijlstra 	    FTRACE_FORCE_LIST_FUNC)
19800ccbf2fSSteven Rostedt (Red Hat) 		return ftrace_ops_list_func;
19900ccbf2fSSteven Rostedt (Red Hat) 
20000ccbf2fSSteven Rostedt (Red Hat) 	return ftrace_ops_get_func(ops);
20100ccbf2fSSteven Rostedt (Red Hat) }
20200ccbf2fSSteven Rostedt (Red Hat) 
2032b499381SSteven Rostedt static void update_ftrace_function(void)
2042b499381SSteven Rostedt {
2052b499381SSteven Rostedt 	ftrace_func_t func;
2062b499381SSteven Rostedt 
207cdbe61bfSSteven Rostedt 	/*
208f7aad4e1SSteven Rostedt (Red Hat) 	 * Prepare the ftrace_ops that the arch callback will use.
209f7aad4e1SSteven Rostedt (Red Hat) 	 * If there's only one ftrace_ops registered, the ftrace_ops_list
210f7aad4e1SSteven Rostedt (Red Hat) 	 * will point to the ops we want.
211f7aad4e1SSteven Rostedt (Red Hat) 	 */
212f86f4180SChunyan Zhang 	set_function_trace_op = rcu_dereference_protected(ftrace_ops_list,
213f86f4180SChunyan Zhang 						lockdep_is_held(&ftrace_lock));
214f7aad4e1SSteven Rostedt (Red Hat) 
215f7aad4e1SSteven Rostedt (Red Hat) 	/* If there's no ftrace_ops registered, just call the stub function */
216f86f4180SChunyan Zhang 	if (set_function_trace_op == &ftrace_list_end) {
217f7aad4e1SSteven Rostedt (Red Hat) 		func = ftrace_stub;
218f7aad4e1SSteven Rostedt (Red Hat) 
219f7aad4e1SSteven Rostedt (Red Hat) 	/*
220cdbe61bfSSteven Rostedt 	 * If we are at the end of the list and this ops is
2214740974aSSteven Rostedt 	 * recursion safe and not dynamic and the arch supports passing ops,
2224740974aSSteven Rostedt 	 * then have the mcount trampoline call the function directly.
223cdbe61bfSSteven Rostedt 	 */
224f86f4180SChunyan Zhang 	} else if (rcu_dereference_protected(ftrace_ops_list->next,
225f86f4180SChunyan Zhang 			lockdep_is_held(&ftrace_lock)) == &ftrace_list_end) {
22600ccbf2fSSteven Rostedt (Red Hat) 		func = ftrace_ops_get_list_func(ftrace_ops_list);
227f7aad4e1SSteven Rostedt (Red Hat) 
2282f5f6ad9SSteven Rostedt 	} else {
2292f5f6ad9SSteven Rostedt 		/* Just use the default ftrace_ops */
230405e1d83SSteven Rostedt (Red Hat) 		set_function_trace_op = &ftrace_list_end;
231b848914cSSteven Rostedt 		func = ftrace_ops_list_func;
2322f5f6ad9SSteven Rostedt 	}
2332b499381SSteven Rostedt 
2345f8bf2d2SSteven Rostedt (Red Hat) 	update_function_graph_func();
2355f8bf2d2SSteven Rostedt (Red Hat) 
236405e1d83SSteven Rostedt (Red Hat) 	/* If there's no change, then do nothing more here */
237405e1d83SSteven Rostedt (Red Hat) 	if (ftrace_trace_function == func)
238405e1d83SSteven Rostedt (Red Hat) 		return;
239405e1d83SSteven Rostedt (Red Hat) 
240405e1d83SSteven Rostedt (Red Hat) 	/*
241405e1d83SSteven Rostedt (Red Hat) 	 * If we are using the list function, it doesn't care
242405e1d83SSteven Rostedt (Red Hat) 	 * about the function_trace_ops.
243405e1d83SSteven Rostedt (Red Hat) 	 */
244405e1d83SSteven Rostedt (Red Hat) 	if (func == ftrace_ops_list_func) {
245405e1d83SSteven Rostedt (Red Hat) 		ftrace_trace_function = func;
246405e1d83SSteven Rostedt (Red Hat) 		/*
247405e1d83SSteven Rostedt (Red Hat) 		 * Don't even bother setting function_trace_ops,
248405e1d83SSteven Rostedt (Red Hat) 		 * it would be racy to do so anyway.
249405e1d83SSteven Rostedt (Red Hat) 		 */
250405e1d83SSteven Rostedt (Red Hat) 		return;
251405e1d83SSteven Rostedt (Red Hat) 	}
252405e1d83SSteven Rostedt (Red Hat) 
253405e1d83SSteven Rostedt (Red Hat) #ifndef CONFIG_DYNAMIC_FTRACE
254405e1d83SSteven Rostedt (Red Hat) 	/*
255405e1d83SSteven Rostedt (Red Hat) 	 * For static tracing, we need to be a bit more careful.
256405e1d83SSteven Rostedt (Red Hat) 	 * The function change takes affect immediately. Thus,
257fdda88d3SQiujun Huang 	 * we need to coordinate the setting of the function_trace_ops
258405e1d83SSteven Rostedt (Red Hat) 	 * with the setting of the ftrace_trace_function.
259405e1d83SSteven Rostedt (Red Hat) 	 *
260405e1d83SSteven Rostedt (Red Hat) 	 * Set the function to the list ops, which will call the
261405e1d83SSteven Rostedt (Red Hat) 	 * function we want, albeit indirectly, but it handles the
262405e1d83SSteven Rostedt (Red Hat) 	 * ftrace_ops and doesn't depend on function_trace_op.
263405e1d83SSteven Rostedt (Red Hat) 	 */
264405e1d83SSteven Rostedt (Red Hat) 	ftrace_trace_function = ftrace_ops_list_func;
265405e1d83SSteven Rostedt (Red Hat) 	/*
266405e1d83SSteven Rostedt (Red Hat) 	 * Make sure all CPUs see this. Yes this is slow, but static
267405e1d83SSteven Rostedt (Red Hat) 	 * tracing is slow and nasty to have enabled.
268405e1d83SSteven Rostedt (Red Hat) 	 */
269e5a971d7SPaul E. McKenney 	synchronize_rcu_tasks_rude();
270405e1d83SSteven Rostedt (Red Hat) 	/* Now all cpus are using the list ops. */
271405e1d83SSteven Rostedt (Red Hat) 	function_trace_op = set_function_trace_op;
272405e1d83SSteven Rostedt (Red Hat) 	/* Make sure the function_trace_op is visible on all CPUs */
273405e1d83SSteven Rostedt (Red Hat) 	smp_wmb();
274405e1d83SSteven Rostedt (Red Hat) 	/* Nasty way to force a rmb on all cpus */
275405e1d83SSteven Rostedt (Red Hat) 	smp_call_function(ftrace_sync_ipi, NULL, 1);
276405e1d83SSteven Rostedt (Red Hat) 	/* OK, we are all set to update the ftrace_trace_function now! */
277405e1d83SSteven Rostedt (Red Hat) #endif /* !CONFIG_DYNAMIC_FTRACE */
278405e1d83SSteven Rostedt (Red Hat) 
279491d0dcfSSteven Rostedt 	ftrace_trace_function = func;
280491d0dcfSSteven Rostedt }
281491d0dcfSSteven Rostedt 
282f86f4180SChunyan Zhang static void add_ftrace_ops(struct ftrace_ops __rcu **list,
283f86f4180SChunyan Zhang 			   struct ftrace_ops *ops)
2843d083395SSteven Rostedt {
285f86f4180SChunyan Zhang 	rcu_assign_pointer(ops->next, *list);
286f86f4180SChunyan Zhang 
28716444a8aSArnaldo Carvalho de Melo 	/*
288b848914cSSteven Rostedt 	 * We are entering ops into the list but another
28916444a8aSArnaldo Carvalho de Melo 	 * CPU might be walking that list. We need to make sure
29016444a8aSArnaldo Carvalho de Melo 	 * the ops->next pointer is valid before another CPU sees
291b848914cSSteven Rostedt 	 * the ops pointer included into the list.
29216444a8aSArnaldo Carvalho de Melo 	 */
2932b499381SSteven Rostedt 	rcu_assign_pointer(*list, ops);
2942b499381SSteven Rostedt }
2953d083395SSteven Rostedt 
296f86f4180SChunyan Zhang static int remove_ftrace_ops(struct ftrace_ops __rcu **list,
297f86f4180SChunyan Zhang 			     struct ftrace_ops *ops)
2982b499381SSteven Rostedt {
2992b499381SSteven Rostedt 	struct ftrace_ops **p;
3002b499381SSteven Rostedt 
3012b499381SSteven Rostedt 	/*
3022b499381SSteven Rostedt 	 * If we are removing the last function, then simply point
3032b499381SSteven Rostedt 	 * to the ftrace_stub.
3042b499381SSteven Rostedt 	 */
305f86f4180SChunyan Zhang 	if (rcu_dereference_protected(*list,
306f86f4180SChunyan Zhang 			lockdep_is_held(&ftrace_lock)) == ops &&
307f86f4180SChunyan Zhang 	    rcu_dereference_protected(ops->next,
308f86f4180SChunyan Zhang 			lockdep_is_held(&ftrace_lock)) == &ftrace_list_end) {
3092b499381SSteven Rostedt 		*list = &ftrace_list_end;
3102b499381SSteven Rostedt 		return 0;
3112b499381SSteven Rostedt 	}
3122b499381SSteven Rostedt 
3132b499381SSteven Rostedt 	for (p = list; *p != &ftrace_list_end; p = &(*p)->next)
3142b499381SSteven Rostedt 		if (*p == ops)
3152b499381SSteven Rostedt 			break;
3162b499381SSteven Rostedt 
3172b499381SSteven Rostedt 	if (*p != ops)
3182b499381SSteven Rostedt 		return -1;
3192b499381SSteven Rostedt 
3202b499381SSteven Rostedt 	*p = (*p)->next;
3212b499381SSteven Rostedt 	return 0;
3222b499381SSteven Rostedt }
3232b499381SSteven Rostedt 
324f3bea491SSteven Rostedt (Red Hat) static void ftrace_update_trampoline(struct ftrace_ops *ops);
325f3bea491SSteven Rostedt (Red Hat) 
3263306fc4aSSteven Rostedt (VMware) int __register_ftrace_function(struct ftrace_ops *ops)
3272b499381SSteven Rostedt {
328591dffdaSSteven Rostedt (Red Hat) 	if (ops->flags & FTRACE_OPS_FL_DELETED)
329591dffdaSSteven Rostedt (Red Hat) 		return -EINVAL;
330591dffdaSSteven Rostedt (Red Hat) 
331b848914cSSteven Rostedt 	if (WARN_ON(ops->flags & FTRACE_OPS_FL_ENABLED))
332b848914cSSteven Rostedt 		return -EBUSY;
333b848914cSSteven Rostedt 
33406aeaaeaSMasami Hiramatsu #ifndef CONFIG_DYNAMIC_FTRACE_WITH_REGS
33508f6fba5SSteven Rostedt 	/*
33608f6fba5SSteven Rostedt 	 * If the ftrace_ops specifies SAVE_REGS, then it only can be used
33708f6fba5SSteven Rostedt 	 * if the arch supports it, or SAVE_REGS_IF_SUPPORTED is also set.
33808f6fba5SSteven Rostedt 	 * Setting SAVE_REGS_IF_SUPPORTED makes SAVE_REGS irrelevant.
33908f6fba5SSteven Rostedt 	 */
34008f6fba5SSteven Rostedt 	if (ops->flags & FTRACE_OPS_FL_SAVE_REGS &&
34108f6fba5SSteven Rostedt 	    !(ops->flags & FTRACE_OPS_FL_SAVE_REGS_IF_SUPPORTED))
34208f6fba5SSteven Rostedt 		return -EINVAL;
34308f6fba5SSteven Rostedt 
34408f6fba5SSteven Rostedt 	if (ops->flags & FTRACE_OPS_FL_SAVE_REGS_IF_SUPPORTED)
34508f6fba5SSteven Rostedt 		ops->flags |= FTRACE_OPS_FL_SAVE_REGS;
34608f6fba5SSteven Rostedt #endif
3477162431dSMiroslav Benes 	if (!ftrace_enabled && (ops->flags & FTRACE_OPS_FL_PERMANENT))
3487162431dSMiroslav Benes 		return -EBUSY;
34908f6fba5SSteven Rostedt 
350a20deb3aSKefeng Wang 	if (!is_kernel_core_data((unsigned long)ops))
351cdbe61bfSSteven Rostedt 		ops->flags |= FTRACE_OPS_FL_DYNAMIC;
352cdbe61bfSSteven Rostedt 
353b848914cSSteven Rostedt 	add_ftrace_ops(&ftrace_ops_list, ops);
354b848914cSSteven Rostedt 
355e3eea140SSteven Rostedt (Red Hat) 	/* Always save the function, and reset at unregistering */
356e3eea140SSteven Rostedt (Red Hat) 	ops->saved_func = ops->func;
357e3eea140SSteven Rostedt (Red Hat) 
358345ddcc8SSteven Rostedt (Red Hat) 	if (ftrace_pids_enabled(ops))
359e3eea140SSteven Rostedt (Red Hat) 		ops->func = ftrace_pid_func;
360e3eea140SSteven Rostedt (Red Hat) 
361f3bea491SSteven Rostedt (Red Hat) 	ftrace_update_trampoline(ops);
362f3bea491SSteven Rostedt (Red Hat) 
363491d0dcfSSteven Rostedt 	if (ftrace_enabled)
364491d0dcfSSteven Rostedt 		update_ftrace_function();
3653d083395SSteven Rostedt 
36616444a8aSArnaldo Carvalho de Melo 	return 0;
36716444a8aSArnaldo Carvalho de Melo }
36816444a8aSArnaldo Carvalho de Melo 
3693306fc4aSSteven Rostedt (VMware) int __unregister_ftrace_function(struct ftrace_ops *ops)
37016444a8aSArnaldo Carvalho de Melo {
3712b499381SSteven Rostedt 	int ret;
37216444a8aSArnaldo Carvalho de Melo 
373b848914cSSteven Rostedt 	if (WARN_ON(!(ops->flags & FTRACE_OPS_FL_ENABLED)))
374b848914cSSteven Rostedt 		return -EBUSY;
375b848914cSSteven Rostedt 
376b848914cSSteven Rostedt 	ret = remove_ftrace_ops(&ftrace_ops_list, ops);
377b848914cSSteven Rostedt 
3782b499381SSteven Rostedt 	if (ret < 0)
3792b499381SSteven Rostedt 		return ret;
380b848914cSSteven Rostedt 
381491d0dcfSSteven Rostedt 	if (ftrace_enabled)
382491d0dcfSSteven Rostedt 		update_ftrace_function();
38316444a8aSArnaldo Carvalho de Melo 
384e3eea140SSteven Rostedt (Red Hat) 	ops->func = ops->saved_func;
385e3eea140SSteven Rostedt (Red Hat) 
386e6ea44e9SSteven Rostedt 	return 0;
3873d083395SSteven Rostedt }
3883d083395SSteven Rostedt 
389df4fc315SSteven Rostedt static void ftrace_update_pid_func(void)
390df4fc315SSteven Rostedt {
391e3eea140SSteven Rostedt (Red Hat) 	struct ftrace_ops *op;
392e3eea140SSteven Rostedt (Red Hat) 
393491d0dcfSSteven Rostedt 	/* Only do something if we are tracing something */
394df4fc315SSteven Rostedt 	if (ftrace_trace_function == ftrace_stub)
39510dd3ebeSKOSAKI Motohiro 		return;
396df4fc315SSteven Rostedt 
397e3eea140SSteven Rostedt (Red Hat) 	do_for_each_ftrace_op(op, ftrace_ops_list) {
398e3eea140SSteven Rostedt (Red Hat) 		if (op->flags & FTRACE_OPS_FL_PID) {
399345ddcc8SSteven Rostedt (Red Hat) 			op->func = ftrace_pids_enabled(op) ?
400345ddcc8SSteven Rostedt (Red Hat) 				ftrace_pid_func : op->saved_func;
401e3eea140SSteven Rostedt (Red Hat) 			ftrace_update_trampoline(op);
402e3eea140SSteven Rostedt (Red Hat) 		}
403e3eea140SSteven Rostedt (Red Hat) 	} while_for_each_ftrace_op(op);
404e3eea140SSteven Rostedt (Red Hat) 
405491d0dcfSSteven Rostedt 	update_ftrace_function();
406df4fc315SSteven Rostedt }
407df4fc315SSteven Rostedt 
408493762fcSSteven Rostedt #ifdef CONFIG_FUNCTION_PROFILER
409493762fcSSteven Rostedt struct ftrace_profile {
410493762fcSSteven Rostedt 	struct hlist_node		node;
411493762fcSSteven Rostedt 	unsigned long			ip;
412493762fcSSteven Rostedt 	unsigned long			counter;
4130706f1c4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
4140706f1c4SSteven Rostedt 	unsigned long long		time;
415e330b3bcSChase Douglas 	unsigned long long		time_squared;
4160706f1c4SSteven Rostedt #endif
417493762fcSSteven Rostedt };
418493762fcSSteven Rostedt 
419493762fcSSteven Rostedt struct ftrace_profile_page {
420493762fcSSteven Rostedt 	struct ftrace_profile_page	*next;
421493762fcSSteven Rostedt 	unsigned long			index;
422493762fcSSteven Rostedt 	struct ftrace_profile		records[];
423493762fcSSteven Rostedt };
424493762fcSSteven Rostedt 
425cafb168aSSteven Rostedt struct ftrace_profile_stat {
426cafb168aSSteven Rostedt 	atomic_t			disabled;
427cafb168aSSteven Rostedt 	struct hlist_head		*hash;
428cafb168aSSteven Rostedt 	struct ftrace_profile_page	*pages;
429cafb168aSSteven Rostedt 	struct ftrace_profile_page	*start;
430cafb168aSSteven Rostedt 	struct tracer_stat		stat;
431cafb168aSSteven Rostedt };
432cafb168aSSteven Rostedt 
433493762fcSSteven Rostedt #define PROFILE_RECORDS_SIZE						\
434493762fcSSteven Rostedt 	(PAGE_SIZE - offsetof(struct ftrace_profile_page, records))
435493762fcSSteven Rostedt 
436493762fcSSteven Rostedt #define PROFILES_PER_PAGE					\
437493762fcSSteven Rostedt 	(PROFILE_RECORDS_SIZE / sizeof(struct ftrace_profile))
438493762fcSSteven Rostedt 
439fb9fb015SSteven Rostedt static int ftrace_profile_enabled __read_mostly;
440fb9fb015SSteven Rostedt 
441fb9fb015SSteven Rostedt /* ftrace_profile_lock - synchronize the enable and disable of the profiler */
442493762fcSSteven Rostedt static DEFINE_MUTEX(ftrace_profile_lock);
443493762fcSSteven Rostedt 
444cafb168aSSteven Rostedt static DEFINE_PER_CPU(struct ftrace_profile_stat, ftrace_profile_stats);
445493762fcSSteven Rostedt 
44620079ebeSNamhyung Kim #define FTRACE_PROFILE_HASH_BITS 10
44720079ebeSNamhyung Kim #define FTRACE_PROFILE_HASH_SIZE (1 << FTRACE_PROFILE_HASH_BITS)
448493762fcSSteven Rostedt 
449493762fcSSteven Rostedt static void *
450493762fcSSteven Rostedt function_stat_next(void *v, int idx)
451493762fcSSteven Rostedt {
452493762fcSSteven Rostedt 	struct ftrace_profile *rec = v;
453493762fcSSteven Rostedt 	struct ftrace_profile_page *pg;
454493762fcSSteven Rostedt 
455493762fcSSteven Rostedt 	pg = (struct ftrace_profile_page *)((unsigned long)rec & PAGE_MASK);
456493762fcSSteven Rostedt 
457493762fcSSteven Rostedt  again:
4580296e425SLi Zefan 	if (idx != 0)
459493762fcSSteven Rostedt 		rec++;
4600296e425SLi Zefan 
461493762fcSSteven Rostedt 	if ((void *)rec >= (void *)&pg->records[pg->index]) {
462493762fcSSteven Rostedt 		pg = pg->next;
463493762fcSSteven Rostedt 		if (!pg)
464493762fcSSteven Rostedt 			return NULL;
465493762fcSSteven Rostedt 		rec = &pg->records[0];
466493762fcSSteven Rostedt 		if (!rec->counter)
467493762fcSSteven Rostedt 			goto again;
468493762fcSSteven Rostedt 	}
469493762fcSSteven Rostedt 
470493762fcSSteven Rostedt 	return rec;
471493762fcSSteven Rostedt }
472493762fcSSteven Rostedt 
473493762fcSSteven Rostedt static void *function_stat_start(struct tracer_stat *trace)
474493762fcSSteven Rostedt {
475cafb168aSSteven Rostedt 	struct ftrace_profile_stat *stat =
476cafb168aSSteven Rostedt 		container_of(trace, struct ftrace_profile_stat, stat);
477cafb168aSSteven Rostedt 
478cafb168aSSteven Rostedt 	if (!stat || !stat->start)
479cafb168aSSteven Rostedt 		return NULL;
480cafb168aSSteven Rostedt 
481cafb168aSSteven Rostedt 	return function_stat_next(&stat->start->records[0], 0);
482493762fcSSteven Rostedt }
483493762fcSSteven Rostedt 
4840706f1c4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
4850706f1c4SSteven Rostedt /* function graph compares on total time */
48680042c8fSAndy Shevchenko static int function_stat_cmp(const void *p1, const void *p2)
4870706f1c4SSteven Rostedt {
48880042c8fSAndy Shevchenko 	const struct ftrace_profile *a = p1;
48980042c8fSAndy Shevchenko 	const struct ftrace_profile *b = p2;
4900706f1c4SSteven Rostedt 
4910706f1c4SSteven Rostedt 	if (a->time < b->time)
4920706f1c4SSteven Rostedt 		return -1;
4930706f1c4SSteven Rostedt 	if (a->time > b->time)
4940706f1c4SSteven Rostedt 		return 1;
4950706f1c4SSteven Rostedt 	else
4960706f1c4SSteven Rostedt 		return 0;
4970706f1c4SSteven Rostedt }
4980706f1c4SSteven Rostedt #else
4990706f1c4SSteven Rostedt /* not function graph compares against hits */
50080042c8fSAndy Shevchenko static int function_stat_cmp(const void *p1, const void *p2)
501493762fcSSteven Rostedt {
50280042c8fSAndy Shevchenko 	const struct ftrace_profile *a = p1;
50380042c8fSAndy Shevchenko 	const struct ftrace_profile *b = p2;
504493762fcSSteven Rostedt 
505493762fcSSteven Rostedt 	if (a->counter < b->counter)
506493762fcSSteven Rostedt 		return -1;
507493762fcSSteven Rostedt 	if (a->counter > b->counter)
508493762fcSSteven Rostedt 		return 1;
509493762fcSSteven Rostedt 	else
510493762fcSSteven Rostedt 		return 0;
511493762fcSSteven Rostedt }
5120706f1c4SSteven Rostedt #endif
513493762fcSSteven Rostedt 
514493762fcSSteven Rostedt static int function_stat_headers(struct seq_file *m)
515493762fcSSteven Rostedt {
5160706f1c4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
517fa6f0cc7SRasmus Villemoes 	seq_puts(m, "  Function                               "
518e330b3bcSChase Douglas 		 "Hit    Time            Avg             s^2\n"
51934886c8bSSteven Rostedt 		    "  --------                               "
520e330b3bcSChase Douglas 		 "---    ----            ---             ---\n");
5210706f1c4SSteven Rostedt #else
522fa6f0cc7SRasmus Villemoes 	seq_puts(m, "  Function                               Hit\n"
523493762fcSSteven Rostedt 		    "  --------                               ---\n");
5240706f1c4SSteven Rostedt #endif
525493762fcSSteven Rostedt 	return 0;
526493762fcSSteven Rostedt }
527493762fcSSteven Rostedt 
528493762fcSSteven Rostedt static int function_stat_show(struct seq_file *m, void *v)
529493762fcSSteven Rostedt {
530493762fcSSteven Rostedt 	struct ftrace_profile *rec = v;
531493762fcSSteven Rostedt 	char str[KSYM_SYMBOL_LEN];
5323aaba20fSLi Zefan 	int ret = 0;
5330706f1c4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
53434886c8bSSteven Rostedt 	static struct trace_seq s;
53534886c8bSSteven Rostedt 	unsigned long long avg;
536e330b3bcSChase Douglas 	unsigned long long stddev;
5370706f1c4SSteven Rostedt #endif
5383aaba20fSLi Zefan 	mutex_lock(&ftrace_profile_lock);
5393aaba20fSLi Zefan 
5403aaba20fSLi Zefan 	/* we raced with function_profile_reset() */
5413aaba20fSLi Zefan 	if (unlikely(rec->counter == 0)) {
5423aaba20fSLi Zefan 		ret = -EBUSY;
5433aaba20fSLi Zefan 		goto out;
5443aaba20fSLi Zefan 	}
545493762fcSSteven Rostedt 
5468e436ca0SUmesh Tiwari #ifdef CONFIG_FUNCTION_GRAPH_TRACER
547e31f7939SWen Yang 	avg = div64_ul(rec->time, rec->counter);
5488e436ca0SUmesh Tiwari 	if (tracing_thresh && (avg < tracing_thresh))
5498e436ca0SUmesh Tiwari 		goto out;
5508e436ca0SUmesh Tiwari #endif
5518e436ca0SUmesh Tiwari 
552493762fcSSteven Rostedt 	kallsyms_lookup(rec->ip, NULL, NULL, NULL, str);
5530706f1c4SSteven Rostedt 	seq_printf(m, "  %-30.30s  %10lu", str, rec->counter);
554493762fcSSteven Rostedt 
5550706f1c4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
556fa6f0cc7SRasmus Villemoes 	seq_puts(m, "    ");
55734886c8bSSteven Rostedt 
558e330b3bcSChase Douglas 	/* Sample standard deviation (s^2) */
559e330b3bcSChase Douglas 	if (rec->counter <= 1)
560e330b3bcSChase Douglas 		stddev = 0;
561e330b3bcSChase Douglas 	else {
56252d85d76SJuri Lelli 		/*
56352d85d76SJuri Lelli 		 * Apply Welford's method:
56452d85d76SJuri Lelli 		 * s^2 = 1 / (n * (n-1)) * (n * \Sum (x_i)^2 - (\Sum x_i)^2)
56552d85d76SJuri Lelli 		 */
56652d85d76SJuri Lelli 		stddev = rec->counter * rec->time_squared -
56752d85d76SJuri Lelli 			 rec->time * rec->time;
56852d85d76SJuri Lelli 
569e330b3bcSChase Douglas 		/*
570e330b3bcSChase Douglas 		 * Divide only 1000 for ns^2 -> us^2 conversion.
571e330b3bcSChase Douglas 		 * trace_print_graph_duration will divide 1000 again.
572e330b3bcSChase Douglas 		 */
573e31f7939SWen Yang 		stddev = div64_ul(stddev,
574e31f7939SWen Yang 				  rec->counter * (rec->counter - 1) * 1000);
575e330b3bcSChase Douglas 	}
576e330b3bcSChase Douglas 
57734886c8bSSteven Rostedt 	trace_seq_init(&s);
57834886c8bSSteven Rostedt 	trace_print_graph_duration(rec->time, &s);
57934886c8bSSteven Rostedt 	trace_seq_puts(&s, "    ");
58034886c8bSSteven Rostedt 	trace_print_graph_duration(avg, &s);
581e330b3bcSChase Douglas 	trace_seq_puts(&s, "    ");
582e330b3bcSChase Douglas 	trace_print_graph_duration(stddev, &s);
5830706f1c4SSteven Rostedt 	trace_print_seq(m, &s);
5840706f1c4SSteven Rostedt #endif
5850706f1c4SSteven Rostedt 	seq_putc(m, '\n');
5863aaba20fSLi Zefan out:
5873aaba20fSLi Zefan 	mutex_unlock(&ftrace_profile_lock);
5880706f1c4SSteven Rostedt 
5893aaba20fSLi Zefan 	return ret;
590493762fcSSteven Rostedt }
591493762fcSSteven Rostedt 
592cafb168aSSteven Rostedt static void ftrace_profile_reset(struct ftrace_profile_stat *stat)
593493762fcSSteven Rostedt {
594493762fcSSteven Rostedt 	struct ftrace_profile_page *pg;
595493762fcSSteven Rostedt 
596cafb168aSSteven Rostedt 	pg = stat->pages = stat->start;
597493762fcSSteven Rostedt 
598493762fcSSteven Rostedt 	while (pg) {
599493762fcSSteven Rostedt 		memset(pg->records, 0, PROFILE_RECORDS_SIZE);
600493762fcSSteven Rostedt 		pg->index = 0;
601493762fcSSteven Rostedt 		pg = pg->next;
602493762fcSSteven Rostedt 	}
603493762fcSSteven Rostedt 
604cafb168aSSteven Rostedt 	memset(stat->hash, 0,
605493762fcSSteven Rostedt 	       FTRACE_PROFILE_HASH_SIZE * sizeof(struct hlist_head));
606493762fcSSteven Rostedt }
607493762fcSSteven Rostedt 
608172f7ba9Schongjiapeng static int ftrace_profile_pages_init(struct ftrace_profile_stat *stat)
609493762fcSSteven Rostedt {
610493762fcSSteven Rostedt 	struct ftrace_profile_page *pg;
611318e0a73SSteven Rostedt 	int functions;
612318e0a73SSteven Rostedt 	int pages;
613493762fcSSteven Rostedt 	int i;
614493762fcSSteven Rostedt 
615493762fcSSteven Rostedt 	/* If we already allocated, do nothing */
616cafb168aSSteven Rostedt 	if (stat->pages)
617493762fcSSteven Rostedt 		return 0;
618493762fcSSteven Rostedt 
619cafb168aSSteven Rostedt 	stat->pages = (void *)get_zeroed_page(GFP_KERNEL);
620cafb168aSSteven Rostedt 	if (!stat->pages)
621493762fcSSteven Rostedt 		return -ENOMEM;
622493762fcSSteven Rostedt 
623318e0a73SSteven Rostedt #ifdef CONFIG_DYNAMIC_FTRACE
624318e0a73SSteven Rostedt 	functions = ftrace_update_tot_cnt;
625318e0a73SSteven Rostedt #else
626318e0a73SSteven Rostedt 	/*
627318e0a73SSteven Rostedt 	 * We do not know the number of functions that exist because
628318e0a73SSteven Rostedt 	 * dynamic tracing is what counts them. With past experience
629318e0a73SSteven Rostedt 	 * we have around 20K functions. That should be more than enough.
630318e0a73SSteven Rostedt 	 * It is highly unlikely we will execute every function in
631318e0a73SSteven Rostedt 	 * the kernel.
632318e0a73SSteven Rostedt 	 */
633318e0a73SSteven Rostedt 	functions = 20000;
634318e0a73SSteven Rostedt #endif
635318e0a73SSteven Rostedt 
636cafb168aSSteven Rostedt 	pg = stat->start = stat->pages;
637493762fcSSteven Rostedt 
638318e0a73SSteven Rostedt 	pages = DIV_ROUND_UP(functions, PROFILES_PER_PAGE);
639318e0a73SSteven Rostedt 
64039e30cd1SNamhyung Kim 	for (i = 1; i < pages; i++) {
641493762fcSSteven Rostedt 		pg->next = (void *)get_zeroed_page(GFP_KERNEL);
642493762fcSSteven Rostedt 		if (!pg->next)
643318e0a73SSteven Rostedt 			goto out_free;
644493762fcSSteven Rostedt 		pg = pg->next;
645493762fcSSteven Rostedt 	}
646493762fcSSteven Rostedt 
647493762fcSSteven Rostedt 	return 0;
648318e0a73SSteven Rostedt 
649318e0a73SSteven Rostedt  out_free:
650318e0a73SSteven Rostedt 	pg = stat->start;
651318e0a73SSteven Rostedt 	while (pg) {
652318e0a73SSteven Rostedt 		unsigned long tmp = (unsigned long)pg;
653318e0a73SSteven Rostedt 
654318e0a73SSteven Rostedt 		pg = pg->next;
655318e0a73SSteven Rostedt 		free_page(tmp);
656318e0a73SSteven Rostedt 	}
657318e0a73SSteven Rostedt 
658318e0a73SSteven Rostedt 	stat->pages = NULL;
659318e0a73SSteven Rostedt 	stat->start = NULL;
660318e0a73SSteven Rostedt 
661318e0a73SSteven Rostedt 	return -ENOMEM;
662493762fcSSteven Rostedt }
663493762fcSSteven Rostedt 
664cafb168aSSteven Rostedt static int ftrace_profile_init_cpu(int cpu)
665493762fcSSteven Rostedt {
666cafb168aSSteven Rostedt 	struct ftrace_profile_stat *stat;
667493762fcSSteven Rostedt 	int size;
668493762fcSSteven Rostedt 
669cafb168aSSteven Rostedt 	stat = &per_cpu(ftrace_profile_stats, cpu);
670cafb168aSSteven Rostedt 
671cafb168aSSteven Rostedt 	if (stat->hash) {
672493762fcSSteven Rostedt 		/* If the profile is already created, simply reset it */
673cafb168aSSteven Rostedt 		ftrace_profile_reset(stat);
674493762fcSSteven Rostedt 		return 0;
675493762fcSSteven Rostedt 	}
676493762fcSSteven Rostedt 
677493762fcSSteven Rostedt 	/*
678493762fcSSteven Rostedt 	 * We are profiling all functions, but usually only a few thousand
679493762fcSSteven Rostedt 	 * functions are hit. We'll make a hash of 1024 items.
680493762fcSSteven Rostedt 	 */
681493762fcSSteven Rostedt 	size = FTRACE_PROFILE_HASH_SIZE;
682493762fcSSteven Rostedt 
6836396bb22SKees Cook 	stat->hash = kcalloc(size, sizeof(struct hlist_head), GFP_KERNEL);
684493762fcSSteven Rostedt 
685cafb168aSSteven Rostedt 	if (!stat->hash)
686493762fcSSteven Rostedt 		return -ENOMEM;
687493762fcSSteven Rostedt 
688318e0a73SSteven Rostedt 	/* Preallocate the function profiling pages */
689cafb168aSSteven Rostedt 	if (ftrace_profile_pages_init(stat) < 0) {
690cafb168aSSteven Rostedt 		kfree(stat->hash);
691cafb168aSSteven Rostedt 		stat->hash = NULL;
692493762fcSSteven Rostedt 		return -ENOMEM;
693493762fcSSteven Rostedt 	}
694493762fcSSteven Rostedt 
695493762fcSSteven Rostedt 	return 0;
696493762fcSSteven Rostedt }
697493762fcSSteven Rostedt 
698cafb168aSSteven Rostedt static int ftrace_profile_init(void)
699cafb168aSSteven Rostedt {
700cafb168aSSteven Rostedt 	int cpu;
701cafb168aSSteven Rostedt 	int ret = 0;
702cafb168aSSteven Rostedt 
703c4602c1cSMiao Xie 	for_each_possible_cpu(cpu) {
704cafb168aSSteven Rostedt 		ret = ftrace_profile_init_cpu(cpu);
705cafb168aSSteven Rostedt 		if (ret)
706cafb168aSSteven Rostedt 			break;
707cafb168aSSteven Rostedt 	}
708cafb168aSSteven Rostedt 
709cafb168aSSteven Rostedt 	return ret;
710cafb168aSSteven Rostedt }
711cafb168aSSteven Rostedt 
712493762fcSSteven Rostedt /* interrupts must be disabled */
713cafb168aSSteven Rostedt static struct ftrace_profile *
714cafb168aSSteven Rostedt ftrace_find_profiled_func(struct ftrace_profile_stat *stat, unsigned long ip)
715493762fcSSteven Rostedt {
716493762fcSSteven Rostedt 	struct ftrace_profile *rec;
717493762fcSSteven Rostedt 	struct hlist_head *hhd;
718493762fcSSteven Rostedt 	unsigned long key;
719493762fcSSteven Rostedt 
72020079ebeSNamhyung Kim 	key = hash_long(ip, FTRACE_PROFILE_HASH_BITS);
721cafb168aSSteven Rostedt 	hhd = &stat->hash[key];
722493762fcSSteven Rostedt 
723493762fcSSteven Rostedt 	if (hlist_empty(hhd))
724493762fcSSteven Rostedt 		return NULL;
725493762fcSSteven Rostedt 
7261bb539caSSteven Rostedt 	hlist_for_each_entry_rcu_notrace(rec, hhd, node) {
727493762fcSSteven Rostedt 		if (rec->ip == ip)
728493762fcSSteven Rostedt 			return rec;
729493762fcSSteven Rostedt 	}
730493762fcSSteven Rostedt 
731493762fcSSteven Rostedt 	return NULL;
732493762fcSSteven Rostedt }
733493762fcSSteven Rostedt 
734cafb168aSSteven Rostedt static void ftrace_add_profile(struct ftrace_profile_stat *stat,
735cafb168aSSteven Rostedt 			       struct ftrace_profile *rec)
736493762fcSSteven Rostedt {
737493762fcSSteven Rostedt 	unsigned long key;
738493762fcSSteven Rostedt 
73920079ebeSNamhyung Kim 	key = hash_long(rec->ip, FTRACE_PROFILE_HASH_BITS);
740cafb168aSSteven Rostedt 	hlist_add_head_rcu(&rec->node, &stat->hash[key]);
741493762fcSSteven Rostedt }
742493762fcSSteven Rostedt 
743318e0a73SSteven Rostedt /*
744318e0a73SSteven Rostedt  * The memory is already allocated, this simply finds a new record to use.
745318e0a73SSteven Rostedt  */
746493762fcSSteven Rostedt static struct ftrace_profile *
747318e0a73SSteven Rostedt ftrace_profile_alloc(struct ftrace_profile_stat *stat, unsigned long ip)
748493762fcSSteven Rostedt {
749493762fcSSteven Rostedt 	struct ftrace_profile *rec = NULL;
750493762fcSSteven Rostedt 
751318e0a73SSteven Rostedt 	/* prevent recursion (from NMIs) */
752cafb168aSSteven Rostedt 	if (atomic_inc_return(&stat->disabled) != 1)
753493762fcSSteven Rostedt 		goto out;
754493762fcSSteven Rostedt 
755493762fcSSteven Rostedt 	/*
756318e0a73SSteven Rostedt 	 * Try to find the function again since an NMI
757318e0a73SSteven Rostedt 	 * could have added it
758493762fcSSteven Rostedt 	 */
759cafb168aSSteven Rostedt 	rec = ftrace_find_profiled_func(stat, ip);
760493762fcSSteven Rostedt 	if (rec)
761cafb168aSSteven Rostedt 		goto out;
762493762fcSSteven Rostedt 
763cafb168aSSteven Rostedt 	if (stat->pages->index == PROFILES_PER_PAGE) {
764cafb168aSSteven Rostedt 		if (!stat->pages->next)
765cafb168aSSteven Rostedt 			goto out;
766cafb168aSSteven Rostedt 		stat->pages = stat->pages->next;
767493762fcSSteven Rostedt 	}
768493762fcSSteven Rostedt 
769cafb168aSSteven Rostedt 	rec = &stat->pages->records[stat->pages->index++];
770493762fcSSteven Rostedt 	rec->ip = ip;
771cafb168aSSteven Rostedt 	ftrace_add_profile(stat, rec);
772493762fcSSteven Rostedt 
773493762fcSSteven Rostedt  out:
774cafb168aSSteven Rostedt 	atomic_dec(&stat->disabled);
775493762fcSSteven Rostedt 
776493762fcSSteven Rostedt 	return rec;
777493762fcSSteven Rostedt }
778493762fcSSteven Rostedt 
779493762fcSSteven Rostedt static void
7802f5f6ad9SSteven Rostedt function_profile_call(unsigned long ip, unsigned long parent_ip,
781d19ad077SSteven Rostedt (VMware) 		      struct ftrace_ops *ops, struct ftrace_regs *fregs)
782493762fcSSteven Rostedt {
783cafb168aSSteven Rostedt 	struct ftrace_profile_stat *stat;
784493762fcSSteven Rostedt 	struct ftrace_profile *rec;
785493762fcSSteven Rostedt 	unsigned long flags;
786493762fcSSteven Rostedt 
787493762fcSSteven Rostedt 	if (!ftrace_profile_enabled)
788493762fcSSteven Rostedt 		return;
789493762fcSSteven Rostedt 
790493762fcSSteven Rostedt 	local_irq_save(flags);
791cafb168aSSteven Rostedt 
792bdffd893SChristoph Lameter 	stat = this_cpu_ptr(&ftrace_profile_stats);
7930f6ce3deSSteven Rostedt 	if (!stat->hash || !ftrace_profile_enabled)
794cafb168aSSteven Rostedt 		goto out;
795cafb168aSSteven Rostedt 
796cafb168aSSteven Rostedt 	rec = ftrace_find_profiled_func(stat, ip);
797493762fcSSteven Rostedt 	if (!rec) {
798318e0a73SSteven Rostedt 		rec = ftrace_profile_alloc(stat, ip);
799493762fcSSteven Rostedt 		if (!rec)
800493762fcSSteven Rostedt 			goto out;
801493762fcSSteven Rostedt 	}
802493762fcSSteven Rostedt 
803493762fcSSteven Rostedt 	rec->counter++;
804493762fcSSteven Rostedt  out:
805493762fcSSteven Rostedt 	local_irq_restore(flags);
806493762fcSSteven Rostedt }
807493762fcSSteven Rostedt 
8080706f1c4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
809e73e679fSSteven Rostedt (VMware) static bool fgraph_graph_time = true;
810e73e679fSSteven Rostedt (VMware) 
811e73e679fSSteven Rostedt (VMware) void ftrace_graph_graph_time_control(bool enable)
812e73e679fSSteven Rostedt (VMware) {
813e73e679fSSteven Rostedt (VMware) 	fgraph_graph_time = enable;
814e73e679fSSteven Rostedt (VMware) }
815e73e679fSSteven Rostedt (VMware) 
8160706f1c4SSteven Rostedt static int profile_graph_entry(struct ftrace_graph_ent *trace)
8170706f1c4SSteven Rostedt {
818b0e21a61SSteven Rostedt (VMware) 	struct ftrace_ret_stack *ret_stack;
8198861dd30SNamhyung Kim 
820a1e2e31dSSteven Rostedt 	function_profile_call(trace->func, 0, NULL, NULL);
8218861dd30SNamhyung Kim 
822a8f0f9e4SSteven Rostedt (VMware) 	/* If function graph is shutting down, ret_stack can be NULL */
823a8f0f9e4SSteven Rostedt (VMware) 	if (!current->ret_stack)
824a8f0f9e4SSteven Rostedt (VMware) 		return 0;
825a8f0f9e4SSteven Rostedt (VMware) 
826b0e21a61SSteven Rostedt (VMware) 	ret_stack = ftrace_graph_get_ret_stack(current, 0);
827b0e21a61SSteven Rostedt (VMware) 	if (ret_stack)
828b0e21a61SSteven Rostedt (VMware) 		ret_stack->subtime = 0;
8298861dd30SNamhyung Kim 
8300706f1c4SSteven Rostedt 	return 1;
8310706f1c4SSteven Rostedt }
8320706f1c4SSteven Rostedt 
8330706f1c4SSteven Rostedt static void profile_graph_return(struct ftrace_graph_ret *trace)
8340706f1c4SSteven Rostedt {
835b0e21a61SSteven Rostedt (VMware) 	struct ftrace_ret_stack *ret_stack;
836cafb168aSSteven Rostedt 	struct ftrace_profile_stat *stat;
837a2a16d6aSSteven Rostedt 	unsigned long long calltime;
8380706f1c4SSteven Rostedt 	struct ftrace_profile *rec;
839cafb168aSSteven Rostedt 	unsigned long flags;
8400706f1c4SSteven Rostedt 
8410706f1c4SSteven Rostedt 	local_irq_save(flags);
842bdffd893SChristoph Lameter 	stat = this_cpu_ptr(&ftrace_profile_stats);
8430f6ce3deSSteven Rostedt 	if (!stat->hash || !ftrace_profile_enabled)
844cafb168aSSteven Rostedt 		goto out;
845cafb168aSSteven Rostedt 
84637e44bc5SSteven Rostedt 	/* If the calltime was zero'd ignore it */
84737e44bc5SSteven Rostedt 	if (!trace->calltime)
84837e44bc5SSteven Rostedt 		goto out;
84937e44bc5SSteven Rostedt 
850a2a16d6aSSteven Rostedt 	calltime = trace->rettime - trace->calltime;
851a2a16d6aSSteven Rostedt 
85255577204SSteven Rostedt (Red Hat) 	if (!fgraph_graph_time) {
853a2a16d6aSSteven Rostedt 
854a2a16d6aSSteven Rostedt 		/* Append this call time to the parent time to subtract */
855b0e21a61SSteven Rostedt (VMware) 		ret_stack = ftrace_graph_get_ret_stack(current, 1);
856b0e21a61SSteven Rostedt (VMware) 		if (ret_stack)
857b0e21a61SSteven Rostedt (VMware) 			ret_stack->subtime += calltime;
858a2a16d6aSSteven Rostedt 
859b0e21a61SSteven Rostedt (VMware) 		ret_stack = ftrace_graph_get_ret_stack(current, 0);
860b0e21a61SSteven Rostedt (VMware) 		if (ret_stack && ret_stack->subtime < calltime)
861b0e21a61SSteven Rostedt (VMware) 			calltime -= ret_stack->subtime;
862a2a16d6aSSteven Rostedt 		else
863a2a16d6aSSteven Rostedt 			calltime = 0;
864a2a16d6aSSteven Rostedt 	}
865a2a16d6aSSteven Rostedt 
866cafb168aSSteven Rostedt 	rec = ftrace_find_profiled_func(stat, trace->func);
867e330b3bcSChase Douglas 	if (rec) {
868a2a16d6aSSteven Rostedt 		rec->time += calltime;
869e330b3bcSChase Douglas 		rec->time_squared += calltime * calltime;
870e330b3bcSChase Douglas 	}
871a2a16d6aSSteven Rostedt 
872cafb168aSSteven Rostedt  out:
8730706f1c4SSteven Rostedt 	local_irq_restore(flags);
8740706f1c4SSteven Rostedt }
8750706f1c4SSteven Rostedt 
876688f7089SSteven Rostedt (VMware) static struct fgraph_ops fprofiler_ops = {
877688f7089SSteven Rostedt (VMware) 	.entryfunc = &profile_graph_entry,
878688f7089SSteven Rostedt (VMware) 	.retfunc = &profile_graph_return,
879688f7089SSteven Rostedt (VMware) };
880688f7089SSteven Rostedt (VMware) 
8810706f1c4SSteven Rostedt static int register_ftrace_profiler(void)
8820706f1c4SSteven Rostedt {
883688f7089SSteven Rostedt (VMware) 	return register_ftrace_graph(&fprofiler_ops);
8840706f1c4SSteven Rostedt }
8850706f1c4SSteven Rostedt 
8860706f1c4SSteven Rostedt static void unregister_ftrace_profiler(void)
8870706f1c4SSteven Rostedt {
888688f7089SSteven Rostedt (VMware) 	unregister_ftrace_graph(&fprofiler_ops);
8890706f1c4SSteven Rostedt }
8900706f1c4SSteven Rostedt #else
891bd38c0e6SPaul McQuade static struct ftrace_ops ftrace_profile_ops __read_mostly = {
892493762fcSSteven Rostedt 	.func		= function_profile_call,
893a25d036dSSteven Rostedt (VMware) 	.flags		= FTRACE_OPS_FL_INITIALIZED,
89433b7f99cSSteven Rostedt (Red Hat) 	INIT_OPS_HASH(ftrace_profile_ops)
895493762fcSSteven Rostedt };
896493762fcSSteven Rostedt 
8970706f1c4SSteven Rostedt static int register_ftrace_profiler(void)
8980706f1c4SSteven Rostedt {
8990706f1c4SSteven Rostedt 	return register_ftrace_function(&ftrace_profile_ops);
9000706f1c4SSteven Rostedt }
9010706f1c4SSteven Rostedt 
9020706f1c4SSteven Rostedt static void unregister_ftrace_profiler(void)
9030706f1c4SSteven Rostedt {
9040706f1c4SSteven Rostedt 	unregister_ftrace_function(&ftrace_profile_ops);
9050706f1c4SSteven Rostedt }
9060706f1c4SSteven Rostedt #endif /* CONFIG_FUNCTION_GRAPH_TRACER */
9070706f1c4SSteven Rostedt 
908493762fcSSteven Rostedt static ssize_t
909493762fcSSteven Rostedt ftrace_profile_write(struct file *filp, const char __user *ubuf,
910493762fcSSteven Rostedt 		     size_t cnt, loff_t *ppos)
911493762fcSSteven Rostedt {
912493762fcSSteven Rostedt 	unsigned long val;
913493762fcSSteven Rostedt 	int ret;
914493762fcSSteven Rostedt 
91522fe9b54SPeter Huewe 	ret = kstrtoul_from_user(ubuf, cnt, 10, &val);
91622fe9b54SPeter Huewe 	if (ret)
917493762fcSSteven Rostedt 		return ret;
918493762fcSSteven Rostedt 
919493762fcSSteven Rostedt 	val = !!val;
920493762fcSSteven Rostedt 
921493762fcSSteven Rostedt 	mutex_lock(&ftrace_profile_lock);
922493762fcSSteven Rostedt 	if (ftrace_profile_enabled ^ val) {
923493762fcSSteven Rostedt 		if (val) {
924493762fcSSteven Rostedt 			ret = ftrace_profile_init();
925493762fcSSteven Rostedt 			if (ret < 0) {
926493762fcSSteven Rostedt 				cnt = ret;
927493762fcSSteven Rostedt 				goto out;
928493762fcSSteven Rostedt 			}
929493762fcSSteven Rostedt 
9300706f1c4SSteven Rostedt 			ret = register_ftrace_profiler();
9310706f1c4SSteven Rostedt 			if (ret < 0) {
9320706f1c4SSteven Rostedt 				cnt = ret;
9330706f1c4SSteven Rostedt 				goto out;
9340706f1c4SSteven Rostedt 			}
935493762fcSSteven Rostedt 			ftrace_profile_enabled = 1;
936493762fcSSteven Rostedt 		} else {
937493762fcSSteven Rostedt 			ftrace_profile_enabled = 0;
9380f6ce3deSSteven Rostedt 			/*
9390f6ce3deSSteven Rostedt 			 * unregister_ftrace_profiler calls stop_machine
94074401729SPaul E. McKenney 			 * so this acts like an synchronize_rcu.
9410f6ce3deSSteven Rostedt 			 */
9420706f1c4SSteven Rostedt 			unregister_ftrace_profiler();
943493762fcSSteven Rostedt 		}
944493762fcSSteven Rostedt 	}
945493762fcSSteven Rostedt  out:
946493762fcSSteven Rostedt 	mutex_unlock(&ftrace_profile_lock);
947493762fcSSteven Rostedt 
948cf8517cfSJiri Olsa 	*ppos += cnt;
949493762fcSSteven Rostedt 
950493762fcSSteven Rostedt 	return cnt;
951493762fcSSteven Rostedt }
952493762fcSSteven Rostedt 
953493762fcSSteven Rostedt static ssize_t
954493762fcSSteven Rostedt ftrace_profile_read(struct file *filp, char __user *ubuf,
955493762fcSSteven Rostedt 		     size_t cnt, loff_t *ppos)
956493762fcSSteven Rostedt {
957fb9fb015SSteven Rostedt 	char buf[64];		/* big enough to hold a number */
958493762fcSSteven Rostedt 	int r;
959493762fcSSteven Rostedt 
960493762fcSSteven Rostedt 	r = sprintf(buf, "%u\n", ftrace_profile_enabled);
961493762fcSSteven Rostedt 	return simple_read_from_buffer(ubuf, cnt, ppos, buf, r);
962493762fcSSteven Rostedt }
963493762fcSSteven Rostedt 
964493762fcSSteven Rostedt static const struct file_operations ftrace_profile_fops = {
965493762fcSSteven Rostedt 	.open		= tracing_open_generic,
966493762fcSSteven Rostedt 	.read		= ftrace_profile_read,
967493762fcSSteven Rostedt 	.write		= ftrace_profile_write,
9686038f373SArnd Bergmann 	.llseek		= default_llseek,
969493762fcSSteven Rostedt };
970493762fcSSteven Rostedt 
971cafb168aSSteven Rostedt /* used to initialize the real stat files */
972cafb168aSSteven Rostedt static struct tracer_stat function_stats __initdata = {
973cafb168aSSteven Rostedt 	.name		= "functions",
974cafb168aSSteven Rostedt 	.stat_start	= function_stat_start,
975cafb168aSSteven Rostedt 	.stat_next	= function_stat_next,
976cafb168aSSteven Rostedt 	.stat_cmp	= function_stat_cmp,
977cafb168aSSteven Rostedt 	.stat_headers	= function_stat_headers,
978cafb168aSSteven Rostedt 	.stat_show	= function_stat_show
979cafb168aSSteven Rostedt };
980cafb168aSSteven Rostedt 
9818434dc93SSteven Rostedt (Red Hat) static __init void ftrace_profile_tracefs(struct dentry *d_tracer)
982493762fcSSteven Rostedt {
983cafb168aSSteven Rostedt 	struct ftrace_profile_stat *stat;
984cafb168aSSteven Rostedt 	char *name;
985493762fcSSteven Rostedt 	int ret;
986cafb168aSSteven Rostedt 	int cpu;
987493762fcSSteven Rostedt 
988cafb168aSSteven Rostedt 	for_each_possible_cpu(cpu) {
989cafb168aSSteven Rostedt 		stat = &per_cpu(ftrace_profile_stats, cpu);
990cafb168aSSteven Rostedt 
9916363c6b5SGeliang Tang 		name = kasprintf(GFP_KERNEL, "function%d", cpu);
992cafb168aSSteven Rostedt 		if (!name) {
993cafb168aSSteven Rostedt 			/*
994cafb168aSSteven Rostedt 			 * The files created are permanent, if something happens
995cafb168aSSteven Rostedt 			 * we still do not free memory.
996cafb168aSSteven Rostedt 			 */
997cafb168aSSteven Rostedt 			WARN(1,
998cafb168aSSteven Rostedt 			     "Could not allocate stat file for cpu %d\n",
999cafb168aSSteven Rostedt 			     cpu);
1000493762fcSSteven Rostedt 			return;
1001493762fcSSteven Rostedt 		}
1002cafb168aSSteven Rostedt 		stat->stat = function_stats;
1003cafb168aSSteven Rostedt 		stat->stat.name = name;
1004cafb168aSSteven Rostedt 		ret = register_stat_tracer(&stat->stat);
1005cafb168aSSteven Rostedt 		if (ret) {
1006cafb168aSSteven Rostedt 			WARN(1,
1007cafb168aSSteven Rostedt 			     "Could not register function stat for cpu %d\n",
1008cafb168aSSteven Rostedt 			     cpu);
1009cafb168aSSteven Rostedt 			kfree(name);
1010cafb168aSSteven Rostedt 			return;
1011cafb168aSSteven Rostedt 		}
1012cafb168aSSteven Rostedt 	}
1013493762fcSSteven Rostedt 
1014e4931b82SYuntao Wang 	trace_create_file("function_profile_enabled",
101521ccc9cdSSteven Rostedt (VMware) 			  TRACE_MODE_WRITE, d_tracer, NULL,
101621ccc9cdSSteven Rostedt (VMware) 			  &ftrace_profile_fops);
1017493762fcSSteven Rostedt }
1018493762fcSSteven Rostedt 
1019493762fcSSteven Rostedt #else /* CONFIG_FUNCTION_PROFILER */
10208434dc93SSteven Rostedt (Red Hat) static __init void ftrace_profile_tracefs(struct dentry *d_tracer)
1021493762fcSSteven Rostedt {
1022493762fcSSteven Rostedt }
1023493762fcSSteven Rostedt #endif /* CONFIG_FUNCTION_PROFILER */
1024493762fcSSteven Rostedt 
10253d083395SSteven Rostedt #ifdef CONFIG_DYNAMIC_FTRACE
102673d3fd96SIngo Molnar 
102779922b80SSteven Rostedt (Red Hat) static struct ftrace_ops *removed_ops;
102879922b80SSteven Rostedt (Red Hat) 
1029e1effa01SSteven Rostedt (Red Hat) /*
1030e1effa01SSteven Rostedt (Red Hat)  * Set when doing a global update, like enabling all recs or disabling them.
1031e1effa01SSteven Rostedt (Red Hat)  * It is not set when just updating a single ftrace_ops.
1032e1effa01SSteven Rostedt (Red Hat)  */
1033e1effa01SSteven Rostedt (Red Hat) static bool update_all_ops;
1034e1effa01SSteven Rostedt (Red Hat) 
103599ecdc43SSteven Rostedt #ifndef CONFIG_FTRACE_MCOUNT_RECORD
1036cb7be3b2SSteven Rostedt # error Dynamic ftrace depends on MCOUNT_RECORD
103799ecdc43SSteven Rostedt #endif
103899ecdc43SSteven Rostedt 
10397b60f3d8SSteven Rostedt (VMware) struct ftrace_func_probe {
10407b60f3d8SSteven Rostedt (VMware) 	struct ftrace_probe_ops	*probe_ops;
10417b60f3d8SSteven Rostedt (VMware) 	struct ftrace_ops	ops;
10427b60f3d8SSteven Rostedt (VMware) 	struct trace_array	*tr;
10437b60f3d8SSteven Rostedt (VMware) 	struct list_head	list;
10446e444319SSteven Rostedt (VMware) 	void			*data;
10457b60f3d8SSteven Rostedt (VMware) 	int			ref;
10467b60f3d8SSteven Rostedt (VMware) };
10477b60f3d8SSteven Rostedt (VMware) 
104833dc9b12SSteven Rostedt /*
104933dc9b12SSteven Rostedt  * We make these constant because no one should touch them,
105033dc9b12SSteven Rostedt  * but they are used as the default "empty hash", to avoid allocating
105133dc9b12SSteven Rostedt  * it all the time. These are in a read only section such that if
105233dc9b12SSteven Rostedt  * anyone does try to modify it, it will cause an exception.
105333dc9b12SSteven Rostedt  */
105433dc9b12SSteven Rostedt static const struct hlist_head empty_buckets[1];
105533dc9b12SSteven Rostedt static const struct ftrace_hash empty_hash = {
105633dc9b12SSteven Rostedt 	.buckets = (struct hlist_head *)empty_buckets,
1057b448c4e3SSteven Rostedt };
105833dc9b12SSteven Rostedt #define EMPTY_HASH	((struct ftrace_hash *)&empty_hash)
10595072c59fSSteven Rostedt 
10603306fc4aSSteven Rostedt (VMware) struct ftrace_ops global_ops = {
1061f45948e8SSteven Rostedt 	.func				= ftrace_stub,
106233b7f99cSSteven Rostedt (Red Hat) 	.local_hash.notrace_hash	= EMPTY_HASH,
106333b7f99cSSteven Rostedt (Red Hat) 	.local_hash.filter_hash		= EMPTY_HASH,
106433b7f99cSSteven Rostedt (Red Hat) 	INIT_OPS_HASH(global_ops)
1065a25d036dSSteven Rostedt (VMware) 	.flags				= FTRACE_OPS_FL_INITIALIZED |
1066e3eea140SSteven Rostedt (Red Hat) 					  FTRACE_OPS_FL_PID,
1067f45948e8SSteven Rostedt };
1068f45948e8SSteven Rostedt 
1069aec0be2dSSteven Rostedt (Red Hat) /*
1070f2cc020dSIngo Molnar  * Used by the stack unwinder to know about dynamic ftrace trampolines.
1071aec0be2dSSteven Rostedt (Red Hat)  */
10726be7fa3cSSteven Rostedt (VMware) struct ftrace_ops *ftrace_ops_trampoline(unsigned long addr)
1073aec0be2dSSteven Rostedt (Red Hat) {
10746be7fa3cSSteven Rostedt (VMware) 	struct ftrace_ops *op = NULL;
1075aec0be2dSSteven Rostedt (Red Hat) 
1076aec0be2dSSteven Rostedt (Red Hat) 	/*
1077aec0be2dSSteven Rostedt (Red Hat) 	 * Some of the ops may be dynamically allocated,
107874401729SPaul E. McKenney 	 * they are freed after a synchronize_rcu().
1079aec0be2dSSteven Rostedt (Red Hat) 	 */
1080aec0be2dSSteven Rostedt (Red Hat) 	preempt_disable_notrace();
1081aec0be2dSSteven Rostedt (Red Hat) 
1082aec0be2dSSteven Rostedt (Red Hat) 	do_for_each_ftrace_op(op, ftrace_ops_list) {
1083aec0be2dSSteven Rostedt (Red Hat) 		/*
1084aec0be2dSSteven Rostedt (Red Hat) 		 * This is to check for dynamically allocated trampolines.
1085aec0be2dSSteven Rostedt (Red Hat) 		 * Trampolines that are in kernel text will have
1086aec0be2dSSteven Rostedt (Red Hat) 		 * core_kernel_text() return true.
1087aec0be2dSSteven Rostedt (Red Hat) 		 */
1088aec0be2dSSteven Rostedt (Red Hat) 		if (op->trampoline && op->trampoline_size)
1089aec0be2dSSteven Rostedt (Red Hat) 			if (addr >= op->trampoline &&
1090aec0be2dSSteven Rostedt (Red Hat) 			    addr < op->trampoline + op->trampoline_size) {
10916be7fa3cSSteven Rostedt (VMware) 				preempt_enable_notrace();
10926be7fa3cSSteven Rostedt (VMware) 				return op;
1093aec0be2dSSteven Rostedt (Red Hat) 			}
1094aec0be2dSSteven Rostedt (Red Hat) 	} while_for_each_ftrace_op(op);
1095aec0be2dSSteven Rostedt (Red Hat) 	preempt_enable_notrace();
1096aec0be2dSSteven Rostedt (Red Hat) 
10976be7fa3cSSteven Rostedt (VMware) 	return NULL;
10986be7fa3cSSteven Rostedt (VMware) }
10996be7fa3cSSteven Rostedt (VMware) 
11006be7fa3cSSteven Rostedt (VMware) /*
11016be7fa3cSSteven Rostedt (VMware)  * This is used by __kernel_text_address() to return true if the
11026be7fa3cSSteven Rostedt (VMware)  * address is on a dynamically allocated trampoline that would
11036be7fa3cSSteven Rostedt (VMware)  * not return true for either core_kernel_text() or
11046be7fa3cSSteven Rostedt (VMware)  * is_module_text_address().
11056be7fa3cSSteven Rostedt (VMware)  */
11066be7fa3cSSteven Rostedt (VMware) bool is_ftrace_trampoline(unsigned long addr)
11076be7fa3cSSteven Rostedt (VMware) {
11086be7fa3cSSteven Rostedt (VMware) 	return ftrace_ops_trampoline(addr) != NULL;
1109aec0be2dSSteven Rostedt (Red Hat) }
1110aec0be2dSSteven Rostedt (Red Hat) 
11113c1720f0SSteven Rostedt struct ftrace_page {
11123c1720f0SSteven Rostedt 	struct ftrace_page	*next;
1113a7900875SSteven Rostedt 	struct dyn_ftrace	*records;
1114431aa3fbSSteven Rostedt 	int			index;
1115db42523bSLinus Torvalds 	int			order;
1116aa5e5ceaSDavid Miller };
11173c1720f0SSteven Rostedt 
1118a7900875SSteven Rostedt #define ENTRY_SIZE sizeof(struct dyn_ftrace)
1119a7900875SSteven Rostedt #define ENTRIES_PER_PAGE (PAGE_SIZE / ENTRY_SIZE)
11203c1720f0SSteven Rostedt 
11213c1720f0SSteven Rostedt static struct ftrace_page	*ftrace_pages_start;
11223c1720f0SSteven Rostedt static struct ftrace_page	*ftrace_pages;
11233c1720f0SSteven Rostedt 
11242b0cce0eSSteven Rostedt (VMware) static __always_inline unsigned long
11252b0cce0eSSteven Rostedt (VMware) ftrace_hash_key(struct ftrace_hash *hash, unsigned long ip)
11262b0cce0eSSteven Rostedt (VMware) {
11272b0cce0eSSteven Rostedt (VMware) 	if (hash->size_bits > 0)
11282b0cce0eSSteven Rostedt (VMware) 		return hash_long(ip, hash->size_bits);
11292b0cce0eSSteven Rostedt (VMware) 
11302b0cce0eSSteven Rostedt (VMware) 	return 0;
11312b0cce0eSSteven Rostedt (VMware) }
11322b0cce0eSSteven Rostedt (VMware) 
11332b2c279cSSteven Rostedt (VMware) /* Only use this function if ftrace_hash_empty() has already been tested */
11342b2c279cSSteven Rostedt (VMware) static __always_inline struct ftrace_func_entry *
11352b2c279cSSteven Rostedt (VMware) __ftrace_lookup_ip(struct ftrace_hash *hash, unsigned long ip)
1136b448c4e3SSteven Rostedt {
1137b448c4e3SSteven Rostedt 	unsigned long key;
1138b448c4e3SSteven Rostedt 	struct ftrace_func_entry *entry;
1139b448c4e3SSteven Rostedt 	struct hlist_head *hhd;
1140b448c4e3SSteven Rostedt 
11412b0cce0eSSteven Rostedt (VMware) 	key = ftrace_hash_key(hash, ip);
1142b448c4e3SSteven Rostedt 	hhd = &hash->buckets[key];
1143b448c4e3SSteven Rostedt 
11441bb539caSSteven Rostedt 	hlist_for_each_entry_rcu_notrace(entry, hhd, hlist) {
1145b448c4e3SSteven Rostedt 		if (entry->ip == ip)
1146b448c4e3SSteven Rostedt 			return entry;
1147b448c4e3SSteven Rostedt 	}
1148b448c4e3SSteven Rostedt 	return NULL;
1149b448c4e3SSteven Rostedt }
1150b448c4e3SSteven Rostedt 
11512b2c279cSSteven Rostedt (VMware) /**
11522b2c279cSSteven Rostedt (VMware)  * ftrace_lookup_ip - Test to see if an ip exists in an ftrace_hash
11532b2c279cSSteven Rostedt (VMware)  * @hash: The hash to look at
11542b2c279cSSteven Rostedt (VMware)  * @ip: The instruction pointer to test
11552b2c279cSSteven Rostedt (VMware)  *
11562b2c279cSSteven Rostedt (VMware)  * Search a given @hash to see if a given instruction pointer (@ip)
11572b2c279cSSteven Rostedt (VMware)  * exists in it.
11582b2c279cSSteven Rostedt (VMware)  *
11592b2c279cSSteven Rostedt (VMware)  * Returns the entry that holds the @ip if found. NULL otherwise.
11602b2c279cSSteven Rostedt (VMware)  */
11612b2c279cSSteven Rostedt (VMware) struct ftrace_func_entry *
11622b2c279cSSteven Rostedt (VMware) ftrace_lookup_ip(struct ftrace_hash *hash, unsigned long ip)
11632b2c279cSSteven Rostedt (VMware) {
11642b2c279cSSteven Rostedt (VMware) 	if (ftrace_hash_empty(hash))
11652b2c279cSSteven Rostedt (VMware) 		return NULL;
11662b2c279cSSteven Rostedt (VMware) 
11672b2c279cSSteven Rostedt (VMware) 	return __ftrace_lookup_ip(hash, ip);
11682b2c279cSSteven Rostedt (VMware) }
11692b2c279cSSteven Rostedt (VMware) 
117033dc9b12SSteven Rostedt static void __add_hash_entry(struct ftrace_hash *hash,
117133dc9b12SSteven Rostedt 			     struct ftrace_func_entry *entry)
117233dc9b12SSteven Rostedt {
117333dc9b12SSteven Rostedt 	struct hlist_head *hhd;
117433dc9b12SSteven Rostedt 	unsigned long key;
117533dc9b12SSteven Rostedt 
11762b0cce0eSSteven Rostedt (VMware) 	key = ftrace_hash_key(hash, entry->ip);
117733dc9b12SSteven Rostedt 	hhd = &hash->buckets[key];
117833dc9b12SSteven Rostedt 	hlist_add_head(&entry->hlist, hhd);
117933dc9b12SSteven Rostedt 	hash->count++;
118033dc9b12SSteven Rostedt }
118133dc9b12SSteven Rostedt 
1182b448c4e3SSteven Rostedt static int add_hash_entry(struct ftrace_hash *hash, unsigned long ip)
1183b448c4e3SSteven Rostedt {
1184b448c4e3SSteven Rostedt 	struct ftrace_func_entry *entry;
1185b448c4e3SSteven Rostedt 
1186b448c4e3SSteven Rostedt 	entry = kmalloc(sizeof(*entry), GFP_KERNEL);
1187b448c4e3SSteven Rostedt 	if (!entry)
1188b448c4e3SSteven Rostedt 		return -ENOMEM;
1189b448c4e3SSteven Rostedt 
1190b448c4e3SSteven Rostedt 	entry->ip = ip;
119133dc9b12SSteven Rostedt 	__add_hash_entry(hash, entry);
1192b448c4e3SSteven Rostedt 
1193b448c4e3SSteven Rostedt 	return 0;
1194b448c4e3SSteven Rostedt }
1195b448c4e3SSteven Rostedt 
1196b448c4e3SSteven Rostedt static void
119733dc9b12SSteven Rostedt free_hash_entry(struct ftrace_hash *hash,
119833dc9b12SSteven Rostedt 		  struct ftrace_func_entry *entry)
119933dc9b12SSteven Rostedt {
120033dc9b12SSteven Rostedt 	hlist_del(&entry->hlist);
120133dc9b12SSteven Rostedt 	kfree(entry);
120233dc9b12SSteven Rostedt 	hash->count--;
120333dc9b12SSteven Rostedt }
120433dc9b12SSteven Rostedt 
120533dc9b12SSteven Rostedt static void
1206b448c4e3SSteven Rostedt remove_hash_entry(struct ftrace_hash *hash,
1207b448c4e3SSteven Rostedt 		  struct ftrace_func_entry *entry)
1208b448c4e3SSteven Rostedt {
1209eee8ded1SSteven Rostedt (VMware) 	hlist_del_rcu(&entry->hlist);
1210b448c4e3SSteven Rostedt 	hash->count--;
1211b448c4e3SSteven Rostedt }
1212b448c4e3SSteven Rostedt 
1213b448c4e3SSteven Rostedt static void ftrace_hash_clear(struct ftrace_hash *hash)
1214b448c4e3SSteven Rostedt {
1215b448c4e3SSteven Rostedt 	struct hlist_head *hhd;
1216b67bfe0dSSasha Levin 	struct hlist_node *tn;
1217b448c4e3SSteven Rostedt 	struct ftrace_func_entry *entry;
1218b448c4e3SSteven Rostedt 	int size = 1 << hash->size_bits;
1219b448c4e3SSteven Rostedt 	int i;
1220b448c4e3SSteven Rostedt 
122133dc9b12SSteven Rostedt 	if (!hash->count)
122233dc9b12SSteven Rostedt 		return;
122333dc9b12SSteven Rostedt 
1224b448c4e3SSteven Rostedt 	for (i = 0; i < size; i++) {
1225b448c4e3SSteven Rostedt 		hhd = &hash->buckets[i];
1226b67bfe0dSSasha Levin 		hlist_for_each_entry_safe(entry, tn, hhd, hlist)
122733dc9b12SSteven Rostedt 			free_hash_entry(hash, entry);
1228b448c4e3SSteven Rostedt 	}
1229b448c4e3SSteven Rostedt 	FTRACE_WARN_ON(hash->count);
1230b448c4e3SSteven Rostedt }
1231b448c4e3SSteven Rostedt 
1232673feb9dSSteven Rostedt (VMware) static void free_ftrace_mod(struct ftrace_mod_load *ftrace_mod)
1233673feb9dSSteven Rostedt (VMware) {
1234673feb9dSSteven Rostedt (VMware) 	list_del(&ftrace_mod->list);
1235673feb9dSSteven Rostedt (VMware) 	kfree(ftrace_mod->module);
1236673feb9dSSteven Rostedt (VMware) 	kfree(ftrace_mod->func);
1237673feb9dSSteven Rostedt (VMware) 	kfree(ftrace_mod);
1238673feb9dSSteven Rostedt (VMware) }
1239673feb9dSSteven Rostedt (VMware) 
1240673feb9dSSteven Rostedt (VMware) static void clear_ftrace_mod_list(struct list_head *head)
1241673feb9dSSteven Rostedt (VMware) {
1242673feb9dSSteven Rostedt (VMware) 	struct ftrace_mod_load *p, *n;
1243673feb9dSSteven Rostedt (VMware) 
1244673feb9dSSteven Rostedt (VMware) 	/* stack tracer isn't supported yet */
1245673feb9dSSteven Rostedt (VMware) 	if (!head)
1246673feb9dSSteven Rostedt (VMware) 		return;
1247673feb9dSSteven Rostedt (VMware) 
1248673feb9dSSteven Rostedt (VMware) 	mutex_lock(&ftrace_lock);
1249673feb9dSSteven Rostedt (VMware) 	list_for_each_entry_safe(p, n, head, list)
1250673feb9dSSteven Rostedt (VMware) 		free_ftrace_mod(p);
1251673feb9dSSteven Rostedt (VMware) 	mutex_unlock(&ftrace_lock);
1252673feb9dSSteven Rostedt (VMware) }
1253673feb9dSSteven Rostedt (VMware) 
125433dc9b12SSteven Rostedt static void free_ftrace_hash(struct ftrace_hash *hash)
125533dc9b12SSteven Rostedt {
125633dc9b12SSteven Rostedt 	if (!hash || hash == EMPTY_HASH)
125733dc9b12SSteven Rostedt 		return;
125833dc9b12SSteven Rostedt 	ftrace_hash_clear(hash);
125933dc9b12SSteven Rostedt 	kfree(hash->buckets);
126033dc9b12SSteven Rostedt 	kfree(hash);
126133dc9b12SSteven Rostedt }
126233dc9b12SSteven Rostedt 
126307fd5515SSteven Rostedt static void __free_ftrace_hash_rcu(struct rcu_head *rcu)
126407fd5515SSteven Rostedt {
126507fd5515SSteven Rostedt 	struct ftrace_hash *hash;
126607fd5515SSteven Rostedt 
126707fd5515SSteven Rostedt 	hash = container_of(rcu, struct ftrace_hash, rcu);
126807fd5515SSteven Rostedt 	free_ftrace_hash(hash);
126907fd5515SSteven Rostedt }
127007fd5515SSteven Rostedt 
127107fd5515SSteven Rostedt static void free_ftrace_hash_rcu(struct ftrace_hash *hash)
127207fd5515SSteven Rostedt {
127307fd5515SSteven Rostedt 	if (!hash || hash == EMPTY_HASH)
127407fd5515SSteven Rostedt 		return;
127574401729SPaul E. McKenney 	call_rcu(&hash->rcu, __free_ftrace_hash_rcu);
127607fd5515SSteven Rostedt }
127707fd5515SSteven Rostedt 
12788be9fbd5SMark Rutland /**
12798be9fbd5SMark Rutland  * ftrace_free_filter - remove all filters for an ftrace_ops
12808be9fbd5SMark Rutland  * @ops - the ops to remove the filters from
12818be9fbd5SMark Rutland  */
12825500fa51SJiri Olsa void ftrace_free_filter(struct ftrace_ops *ops)
12835500fa51SJiri Olsa {
1284f04f24fbSMasami Hiramatsu 	ftrace_ops_init(ops);
128533b7f99cSSteven Rostedt (Red Hat) 	free_ftrace_hash(ops->func_hash->filter_hash);
128633b7f99cSSteven Rostedt (Red Hat) 	free_ftrace_hash(ops->func_hash->notrace_hash);
12875500fa51SJiri Olsa }
12888be9fbd5SMark Rutland EXPORT_SYMBOL_GPL(ftrace_free_filter);
12895500fa51SJiri Olsa 
129033dc9b12SSteven Rostedt static struct ftrace_hash *alloc_ftrace_hash(int size_bits)
129133dc9b12SSteven Rostedt {
129233dc9b12SSteven Rostedt 	struct ftrace_hash *hash;
129333dc9b12SSteven Rostedt 	int size;
129433dc9b12SSteven Rostedt 
129533dc9b12SSteven Rostedt 	hash = kzalloc(sizeof(*hash), GFP_KERNEL);
129633dc9b12SSteven Rostedt 	if (!hash)
129733dc9b12SSteven Rostedt 		return NULL;
129833dc9b12SSteven Rostedt 
129933dc9b12SSteven Rostedt 	size = 1 << size_bits;
130047b0edcbSThomas Meyer 	hash->buckets = kcalloc(size, sizeof(*hash->buckets), GFP_KERNEL);
130133dc9b12SSteven Rostedt 
130233dc9b12SSteven Rostedt 	if (!hash->buckets) {
130333dc9b12SSteven Rostedt 		kfree(hash);
130433dc9b12SSteven Rostedt 		return NULL;
130533dc9b12SSteven Rostedt 	}
130633dc9b12SSteven Rostedt 
130733dc9b12SSteven Rostedt 	hash->size_bits = size_bits;
130833dc9b12SSteven Rostedt 
130933dc9b12SSteven Rostedt 	return hash;
131033dc9b12SSteven Rostedt }
131133dc9b12SSteven Rostedt 
1312673feb9dSSteven Rostedt (VMware) 
1313673feb9dSSteven Rostedt (VMware) static int ftrace_add_mod(struct trace_array *tr,
1314673feb9dSSteven Rostedt (VMware) 			  const char *func, const char *module,
1315673feb9dSSteven Rostedt (VMware) 			  int enable)
1316673feb9dSSteven Rostedt (VMware) {
1317673feb9dSSteven Rostedt (VMware) 	struct ftrace_mod_load *ftrace_mod;
1318673feb9dSSteven Rostedt (VMware) 	struct list_head *mod_head = enable ? &tr->mod_trace : &tr->mod_notrace;
1319673feb9dSSteven Rostedt (VMware) 
1320673feb9dSSteven Rostedt (VMware) 	ftrace_mod = kzalloc(sizeof(*ftrace_mod), GFP_KERNEL);
1321673feb9dSSteven Rostedt (VMware) 	if (!ftrace_mod)
1322673feb9dSSteven Rostedt (VMware) 		return -ENOMEM;
1323673feb9dSSteven Rostedt (VMware) 
132419ba6c8aSXiu Jianfeng 	INIT_LIST_HEAD(&ftrace_mod->list);
1325673feb9dSSteven Rostedt (VMware) 	ftrace_mod->func = kstrdup(func, GFP_KERNEL);
1326673feb9dSSteven Rostedt (VMware) 	ftrace_mod->module = kstrdup(module, GFP_KERNEL);
1327673feb9dSSteven Rostedt (VMware) 	ftrace_mod->enable = enable;
1328673feb9dSSteven Rostedt (VMware) 
1329673feb9dSSteven Rostedt (VMware) 	if (!ftrace_mod->func || !ftrace_mod->module)
1330673feb9dSSteven Rostedt (VMware) 		goto out_free;
1331673feb9dSSteven Rostedt (VMware) 
1332673feb9dSSteven Rostedt (VMware) 	list_add(&ftrace_mod->list, mod_head);
1333673feb9dSSteven Rostedt (VMware) 
1334673feb9dSSteven Rostedt (VMware) 	return 0;
1335673feb9dSSteven Rostedt (VMware) 
1336673feb9dSSteven Rostedt (VMware)  out_free:
1337673feb9dSSteven Rostedt (VMware) 	free_ftrace_mod(ftrace_mod);
1338673feb9dSSteven Rostedt (VMware) 
1339673feb9dSSteven Rostedt (VMware) 	return -ENOMEM;
1340673feb9dSSteven Rostedt (VMware) }
1341673feb9dSSteven Rostedt (VMware) 
134233dc9b12SSteven Rostedt static struct ftrace_hash *
134333dc9b12SSteven Rostedt alloc_and_copy_ftrace_hash(int size_bits, struct ftrace_hash *hash)
134433dc9b12SSteven Rostedt {
134533dc9b12SSteven Rostedt 	struct ftrace_func_entry *entry;
134633dc9b12SSteven Rostedt 	struct ftrace_hash *new_hash;
134733dc9b12SSteven Rostedt 	int size;
134833dc9b12SSteven Rostedt 	int ret;
134933dc9b12SSteven Rostedt 	int i;
135033dc9b12SSteven Rostedt 
135133dc9b12SSteven Rostedt 	new_hash = alloc_ftrace_hash(size_bits);
135233dc9b12SSteven Rostedt 	if (!new_hash)
135333dc9b12SSteven Rostedt 		return NULL;
135433dc9b12SSteven Rostedt 
13558c08f0d5SSteven Rostedt (VMware) 	if (hash)
13568c08f0d5SSteven Rostedt (VMware) 		new_hash->flags = hash->flags;
13578c08f0d5SSteven Rostedt (VMware) 
135833dc9b12SSteven Rostedt 	/* Empty hash? */
135906a51d93SSteven Rostedt 	if (ftrace_hash_empty(hash))
136033dc9b12SSteven Rostedt 		return new_hash;
136133dc9b12SSteven Rostedt 
136233dc9b12SSteven Rostedt 	size = 1 << hash->size_bits;
136333dc9b12SSteven Rostedt 	for (i = 0; i < size; i++) {
1364b67bfe0dSSasha Levin 		hlist_for_each_entry(entry, &hash->buckets[i], hlist) {
136533dc9b12SSteven Rostedt 			ret = add_hash_entry(new_hash, entry->ip);
136633dc9b12SSteven Rostedt 			if (ret < 0)
136733dc9b12SSteven Rostedt 				goto free_hash;
136833dc9b12SSteven Rostedt 		}
136933dc9b12SSteven Rostedt 	}
137033dc9b12SSteven Rostedt 
137133dc9b12SSteven Rostedt 	FTRACE_WARN_ON(new_hash->count != hash->count);
137233dc9b12SSteven Rostedt 
137333dc9b12SSteven Rostedt 	return new_hash;
137433dc9b12SSteven Rostedt 
137533dc9b12SSteven Rostedt  free_hash:
137633dc9b12SSteven Rostedt 	free_ftrace_hash(new_hash);
137733dc9b12SSteven Rostedt 	return NULL;
137833dc9b12SSteven Rostedt }
137933dc9b12SSteven Rostedt 
138041fb61c2SSteven Rostedt static void
138184261912SSteven Rostedt (Red Hat) ftrace_hash_rec_disable_modify(struct ftrace_ops *ops, int filter_hash);
138241fb61c2SSteven Rostedt static void
138384261912SSteven Rostedt (Red Hat) ftrace_hash_rec_enable_modify(struct ftrace_ops *ops, int filter_hash);
138441fb61c2SSteven Rostedt 
1385f8b8be8aSMasami Hiramatsu static int ftrace_hash_ipmodify_update(struct ftrace_ops *ops,
1386f8b8be8aSMasami Hiramatsu 				       struct ftrace_hash *new_hash);
1387f8b8be8aSMasami Hiramatsu 
1388714641c3SSteven Rostedt (VMware) static struct ftrace_hash *dup_hash(struct ftrace_hash *src, int size)
138933dc9b12SSteven Rostedt {
139033dc9b12SSteven Rostedt 	struct ftrace_func_entry *entry;
139107fd5515SSteven Rostedt 	struct ftrace_hash *new_hash;
1392714641c3SSteven Rostedt (VMware) 	struct hlist_head *hhd;
1393714641c3SSteven Rostedt (VMware) 	struct hlist_node *tn;
139433dc9b12SSteven Rostedt 	int bits = 0;
139533dc9b12SSteven Rostedt 	int i;
139633dc9b12SSteven Rostedt 
139733dc9b12SSteven Rostedt 	/*
1398be493132SSteven Rostedt (VMware) 	 * Use around half the size (max bit of it), but
1399be493132SSteven Rostedt (VMware) 	 * a minimum of 2 is fine (as size of 0 or 1 both give 1 for bits).
140033dc9b12SSteven Rostedt 	 */
1401be493132SSteven Rostedt (VMware) 	bits = fls(size / 2);
140233dc9b12SSteven Rostedt 
140333dc9b12SSteven Rostedt 	/* Don't allocate too much */
140433dc9b12SSteven Rostedt 	if (bits > FTRACE_HASH_MAX_BITS)
140533dc9b12SSteven Rostedt 		bits = FTRACE_HASH_MAX_BITS;
140633dc9b12SSteven Rostedt 
140707fd5515SSteven Rostedt 	new_hash = alloc_ftrace_hash(bits);
140807fd5515SSteven Rostedt 	if (!new_hash)
14093e278c0dSNamhyung Kim 		return NULL;
141033dc9b12SSteven Rostedt 
14118c08f0d5SSteven Rostedt (VMware) 	new_hash->flags = src->flags;
14128c08f0d5SSteven Rostedt (VMware) 
141333dc9b12SSteven Rostedt 	size = 1 << src->size_bits;
141433dc9b12SSteven Rostedt 	for (i = 0; i < size; i++) {
141533dc9b12SSteven Rostedt 		hhd = &src->buckets[i];
1416b67bfe0dSSasha Levin 		hlist_for_each_entry_safe(entry, tn, hhd, hlist) {
141733dc9b12SSteven Rostedt 			remove_hash_entry(src, entry);
141807fd5515SSteven Rostedt 			__add_hash_entry(new_hash, entry);
141933dc9b12SSteven Rostedt 		}
142033dc9b12SSteven Rostedt 	}
14213e278c0dSNamhyung Kim 	return new_hash;
14223e278c0dSNamhyung Kim }
14233e278c0dSNamhyung Kim 
1424714641c3SSteven Rostedt (VMware) static struct ftrace_hash *
1425714641c3SSteven Rostedt (VMware) __ftrace_hash_move(struct ftrace_hash *src)
1426714641c3SSteven Rostedt (VMware) {
1427714641c3SSteven Rostedt (VMware) 	int size = src->count;
1428714641c3SSteven Rostedt (VMware) 
1429714641c3SSteven Rostedt (VMware) 	/*
1430714641c3SSteven Rostedt (VMware) 	 * If the new source is empty, just return the empty_hash.
1431714641c3SSteven Rostedt (VMware) 	 */
1432714641c3SSteven Rostedt (VMware) 	if (ftrace_hash_empty(src))
1433714641c3SSteven Rostedt (VMware) 		return EMPTY_HASH;
1434714641c3SSteven Rostedt (VMware) 
1435714641c3SSteven Rostedt (VMware) 	return dup_hash(src, size);
1436714641c3SSteven Rostedt (VMware) }
1437714641c3SSteven Rostedt (VMware) 
14383e278c0dSNamhyung Kim static int
14393e278c0dSNamhyung Kim ftrace_hash_move(struct ftrace_ops *ops, int enable,
14403e278c0dSNamhyung Kim 		 struct ftrace_hash **dst, struct ftrace_hash *src)
14413e278c0dSNamhyung Kim {
14423e278c0dSNamhyung Kim 	struct ftrace_hash *new_hash;
14433e278c0dSNamhyung Kim 	int ret;
14443e278c0dSNamhyung Kim 
14453e278c0dSNamhyung Kim 	/* Reject setting notrace hash on IPMODIFY ftrace_ops */
14463e278c0dSNamhyung Kim 	if (ops->flags & FTRACE_OPS_FL_IPMODIFY && !enable)
14473e278c0dSNamhyung Kim 		return -EINVAL;
14483e278c0dSNamhyung Kim 
14493e278c0dSNamhyung Kim 	new_hash = __ftrace_hash_move(src);
14503e278c0dSNamhyung Kim 	if (!new_hash)
14513e278c0dSNamhyung Kim 		return -ENOMEM;
14523e278c0dSNamhyung Kim 
1453f8b8be8aSMasami Hiramatsu 	/* Make sure this can be applied if it is IPMODIFY ftrace_ops */
1454f8b8be8aSMasami Hiramatsu 	if (enable) {
1455f8b8be8aSMasami Hiramatsu 		/* IPMODIFY should be updated only when filter_hash updating */
1456f8b8be8aSMasami Hiramatsu 		ret = ftrace_hash_ipmodify_update(ops, new_hash);
1457f8b8be8aSMasami Hiramatsu 		if (ret < 0) {
1458f8b8be8aSMasami Hiramatsu 			free_ftrace_hash(new_hash);
1459f8b8be8aSMasami Hiramatsu 			return ret;
1460f8b8be8aSMasami Hiramatsu 		}
1461f8b8be8aSMasami Hiramatsu 	}
1462f8b8be8aSMasami Hiramatsu 
14635c27c775SMasami Hiramatsu 	/*
14645c27c775SMasami Hiramatsu 	 * Remove the current set, update the hash and add
14655c27c775SMasami Hiramatsu 	 * them back.
14665c27c775SMasami Hiramatsu 	 */
146784261912SSteven Rostedt (Red Hat) 	ftrace_hash_rec_disable_modify(ops, enable);
14685c27c775SMasami Hiramatsu 
146907fd5515SSteven Rostedt 	rcu_assign_pointer(*dst, new_hash);
147007fd5515SSteven Rostedt 
147184261912SSteven Rostedt (Red Hat) 	ftrace_hash_rec_enable_modify(ops, enable);
147241fb61c2SSteven Rostedt 
14735c27c775SMasami Hiramatsu 	return 0;
147433dc9b12SSteven Rostedt }
147533dc9b12SSteven Rostedt 
1476fef5aeeeSSteven Rostedt (Red Hat) static bool hash_contains_ip(unsigned long ip,
1477fef5aeeeSSteven Rostedt (Red Hat) 			     struct ftrace_ops_hash *hash)
1478fef5aeeeSSteven Rostedt (Red Hat) {
1479fef5aeeeSSteven Rostedt (Red Hat) 	/*
1480fef5aeeeSSteven Rostedt (Red Hat) 	 * The function record is a match if it exists in the filter
1481fdda88d3SQiujun Huang 	 * hash and not in the notrace hash. Note, an empty hash is
1482fef5aeeeSSteven Rostedt (Red Hat) 	 * considered a match for the filter hash, but an empty
1483fef5aeeeSSteven Rostedt (Red Hat) 	 * notrace hash is considered not in the notrace hash.
1484fef5aeeeSSteven Rostedt (Red Hat) 	 */
1485fef5aeeeSSteven Rostedt (Red Hat) 	return (ftrace_hash_empty(hash->filter_hash) ||
14862b2c279cSSteven Rostedt (VMware) 		__ftrace_lookup_ip(hash->filter_hash, ip)) &&
1487fef5aeeeSSteven Rostedt (Red Hat) 		(ftrace_hash_empty(hash->notrace_hash) ||
14882b2c279cSSteven Rostedt (VMware) 		 !__ftrace_lookup_ip(hash->notrace_hash, ip));
1489fef5aeeeSSteven Rostedt (Red Hat) }
1490fef5aeeeSSteven Rostedt (Red Hat) 
1491265c831cSSteven Rostedt /*
1492b848914cSSteven Rostedt  * Test the hashes for this ops to see if we want to call
1493b848914cSSteven Rostedt  * the ops->func or not.
1494b848914cSSteven Rostedt  *
1495b848914cSSteven Rostedt  * It's a match if the ip is in the ops->filter_hash or
1496b848914cSSteven Rostedt  * the filter_hash does not exist or is empty,
1497b848914cSSteven Rostedt  *  AND
1498b848914cSSteven Rostedt  * the ip is not in the ops->notrace_hash.
1499cdbe61bfSSteven Rostedt  *
1500cdbe61bfSSteven Rostedt  * This needs to be called with preemption disabled as
150174401729SPaul E. McKenney  * the hashes are freed with call_rcu().
1502b848914cSSteven Rostedt  */
15033306fc4aSSteven Rostedt (VMware) int
1504195a8afcSSteven Rostedt (Red Hat) ftrace_ops_test(struct ftrace_ops *ops, unsigned long ip, void *regs)
1505b848914cSSteven Rostedt {
1506fef5aeeeSSteven Rostedt (Red Hat) 	struct ftrace_ops_hash hash;
1507b848914cSSteven Rostedt 	int ret;
1508b848914cSSteven Rostedt 
1509195a8afcSSteven Rostedt (Red Hat) #ifdef CONFIG_DYNAMIC_FTRACE_WITH_REGS
1510195a8afcSSteven Rostedt (Red Hat) 	/*
1511195a8afcSSteven Rostedt (Red Hat) 	 * There's a small race when adding ops that the ftrace handler
1512195a8afcSSteven Rostedt (Red Hat) 	 * that wants regs, may be called without them. We can not
1513195a8afcSSteven Rostedt (Red Hat) 	 * allow that handler to be called if regs is NULL.
1514195a8afcSSteven Rostedt (Red Hat) 	 */
1515195a8afcSSteven Rostedt (Red Hat) 	if (regs == NULL && (ops->flags & FTRACE_OPS_FL_SAVE_REGS))
1516195a8afcSSteven Rostedt (Red Hat) 		return 0;
1517195a8afcSSteven Rostedt (Red Hat) #endif
1518195a8afcSSteven Rostedt (Red Hat) 
1519f86f4180SChunyan Zhang 	rcu_assign_pointer(hash.filter_hash, ops->func_hash->filter_hash);
1520f86f4180SChunyan Zhang 	rcu_assign_pointer(hash.notrace_hash, ops->func_hash->notrace_hash);
1521b848914cSSteven Rostedt 
1522fef5aeeeSSteven Rostedt (Red Hat) 	if (hash_contains_ip(ip, &hash))
1523b848914cSSteven Rostedt 		ret = 1;
1524b848914cSSteven Rostedt 	else
1525b848914cSSteven Rostedt 		ret = 0;
1526b848914cSSteven Rostedt 
1527b848914cSSteven Rostedt 	return ret;
1528b848914cSSteven Rostedt }
1529b848914cSSteven Rostedt 
1530b848914cSSteven Rostedt /*
1531265c831cSSteven Rostedt  * This is a double for. Do not use 'break' to break out of the loop,
1532265c831cSSteven Rostedt  * you must use a goto.
1533265c831cSSteven Rostedt  */
1534265c831cSSteven Rostedt #define do_for_each_ftrace_rec(pg, rec)					\
1535265c831cSSteven Rostedt 	for (pg = ftrace_pages_start; pg; pg = pg->next) {		\
1536265c831cSSteven Rostedt 		int _____i;						\
1537265c831cSSteven Rostedt 		for (_____i = 0; _____i < pg->index; _____i++) {	\
1538265c831cSSteven Rostedt 			rec = &pg->records[_____i];
1539265c831cSSteven Rostedt 
1540265c831cSSteven Rostedt #define while_for_each_ftrace_rec()		\
1541265c831cSSteven Rostedt 		}				\
1542265c831cSSteven Rostedt 	}
1543ecea656dSAbhishek Sagar 
15445855feadSSteven Rostedt 
15455855feadSSteven Rostedt static int ftrace_cmp_recs(const void *a, const void *b)
15465855feadSSteven Rostedt {
1547a650e02aSSteven Rostedt 	const struct dyn_ftrace *key = a;
1548a650e02aSSteven Rostedt 	const struct dyn_ftrace *rec = b;
15495855feadSSteven Rostedt 
1550a650e02aSSteven Rostedt 	if (key->flags < rec->ip)
15515855feadSSteven Rostedt 		return -1;
1552a650e02aSSteven Rostedt 	if (key->ip >= rec->ip + MCOUNT_INSN_SIZE)
1553a650e02aSSteven Rostedt 		return 1;
1554a650e02aSSteven Rostedt 	return 0;
1555a650e02aSSteven Rostedt }
1556a650e02aSSteven Rostedt 
15577e16f581SSteven Rostedt (VMware) static struct dyn_ftrace *lookup_rec(unsigned long start, unsigned long end)
15587e16f581SSteven Rostedt (VMware) {
15597e16f581SSteven Rostedt (VMware) 	struct ftrace_page *pg;
15607e16f581SSteven Rostedt (VMware) 	struct dyn_ftrace *rec = NULL;
15617e16f581SSteven Rostedt (VMware) 	struct dyn_ftrace key;
15627e16f581SSteven Rostedt (VMware) 
15637e16f581SSteven Rostedt (VMware) 	key.ip = start;
15647e16f581SSteven Rostedt (VMware) 	key.flags = end;	/* overload flags, as it is unsigned long */
15657e16f581SSteven Rostedt (VMware) 
15667e16f581SSteven Rostedt (VMware) 	for (pg = ftrace_pages_start; pg; pg = pg->next) {
1567ee92fa44SChen Zhongjin 		if (pg->index == 0 ||
1568ee92fa44SChen Zhongjin 		    end < pg->records[0].ip ||
15697e16f581SSteven Rostedt (VMware) 		    start >= (pg->records[pg->index - 1].ip + MCOUNT_INSN_SIZE))
15707e16f581SSteven Rostedt (VMware) 			continue;
15717e16f581SSteven Rostedt (VMware) 		rec = bsearch(&key, pg->records, pg->index,
15727e16f581SSteven Rostedt (VMware) 			      sizeof(struct dyn_ftrace),
15737e16f581SSteven Rostedt (VMware) 			      ftrace_cmp_recs);
1574d9815bffSArtem Savkov 		if (rec)
1575d9815bffSArtem Savkov 			break;
15767e16f581SSteven Rostedt (VMware) 	}
15777e16f581SSteven Rostedt (VMware) 	return rec;
15787e16f581SSteven Rostedt (VMware) }
15797e16f581SSteven Rostedt (VMware) 
158004cf31a7SMichael Ellerman /**
158104cf31a7SMichael Ellerman  * ftrace_location_range - return the first address of a traced location
158204cf31a7SMichael Ellerman  *	if it touches the given ip range
158304cf31a7SMichael Ellerman  * @start: start of range to search.
158404cf31a7SMichael Ellerman  * @end: end of range to search (inclusive). @end points to the last byte
158504cf31a7SMichael Ellerman  *	to check.
158604cf31a7SMichael Ellerman  *
158704cf31a7SMichael Ellerman  * Returns rec->ip if the related ftrace location is a least partly within
158804cf31a7SMichael Ellerman  * the given address range. That is, the first address of the instruction
158904cf31a7SMichael Ellerman  * that is either a NOP or call to the function tracer. It checks the ftrace
159004cf31a7SMichael Ellerman  * internal tables to determine if the address belongs or not.
159104cf31a7SMichael Ellerman  */
159204cf31a7SMichael Ellerman unsigned long ftrace_location_range(unsigned long start, unsigned long end)
1593a650e02aSSteven Rostedt {
1594a650e02aSSteven Rostedt 	struct dyn_ftrace *rec;
1595a650e02aSSteven Rostedt 
15967e16f581SSteven Rostedt (VMware) 	rec = lookup_rec(start, end);
1597a650e02aSSteven Rostedt 	if (rec)
1598f0cf973aSSteven Rostedt 		return rec->ip;
1599a650e02aSSteven Rostedt 
16005855feadSSteven Rostedt 	return 0;
16015855feadSSteven Rostedt }
16025855feadSSteven Rostedt 
1603c88fd863SSteven Rostedt /**
1604aebfd125SPeter Zijlstra  * ftrace_location - return the ftrace location
1605c88fd863SSteven Rostedt  * @ip: the instruction pointer to check
1606c88fd863SSteven Rostedt  *
1607aebfd125SPeter Zijlstra  * If @ip matches the ftrace location, return @ip.
1608aebfd125SPeter Zijlstra  * If @ip matches sym+0, return sym's ftrace location.
1609aebfd125SPeter Zijlstra  * Otherwise, return 0.
1610c88fd863SSteven Rostedt  */
1611f0cf973aSSteven Rostedt unsigned long ftrace_location(unsigned long ip)
1612c88fd863SSteven Rostedt {
1613aebfd125SPeter Zijlstra 	struct dyn_ftrace *rec;
1614aebfd125SPeter Zijlstra 	unsigned long offset;
1615aebfd125SPeter Zijlstra 	unsigned long size;
1616aebfd125SPeter Zijlstra 
1617aebfd125SPeter Zijlstra 	rec = lookup_rec(ip, ip);
1618aebfd125SPeter Zijlstra 	if (!rec) {
1619aebfd125SPeter Zijlstra 		if (!kallsyms_lookup_size_offset(ip, &size, &offset))
1620aebfd125SPeter Zijlstra 			goto out;
1621aebfd125SPeter Zijlstra 
1622aebfd125SPeter Zijlstra 		/* map sym+0 to __fentry__ */
1623aebfd125SPeter Zijlstra 		if (!offset)
1624aebfd125SPeter Zijlstra 			rec = lookup_rec(ip, ip + size - 1);
1625aebfd125SPeter Zijlstra 	}
1626aebfd125SPeter Zijlstra 
1627aebfd125SPeter Zijlstra 	if (rec)
1628aebfd125SPeter Zijlstra 		return rec->ip;
1629aebfd125SPeter Zijlstra 
1630aebfd125SPeter Zijlstra out:
1631aebfd125SPeter Zijlstra 	return 0;
16325855feadSSteven Rostedt }
1633c88fd863SSteven Rostedt 
1634a650e02aSSteven Rostedt /**
1635a650e02aSSteven Rostedt  * ftrace_text_reserved - return true if range contains an ftrace location
1636a650e02aSSteven Rostedt  * @start: start of range to search
1637a650e02aSSteven Rostedt  * @end: end of range to search (inclusive). @end points to the last byte to check.
1638a650e02aSSteven Rostedt  *
1639a650e02aSSteven Rostedt  * Returns 1 if @start and @end contains a ftrace location.
1640a650e02aSSteven Rostedt  * That is, the instruction that is either a NOP or call to
1641a650e02aSSteven Rostedt  * the function tracer. It checks the ftrace internal tables to
1642a650e02aSSteven Rostedt  * determine if the address belongs or not.
1643a650e02aSSteven Rostedt  */
1644d88471cbSSasha Levin int ftrace_text_reserved(const void *start, const void *end)
1645a650e02aSSteven Rostedt {
1646f0cf973aSSteven Rostedt 	unsigned long ret;
1647f0cf973aSSteven Rostedt 
1648f0cf973aSSteven Rostedt 	ret = ftrace_location_range((unsigned long)start,
1649a650e02aSSteven Rostedt 				    (unsigned long)end);
1650f0cf973aSSteven Rostedt 
1651f0cf973aSSteven Rostedt 	return (int)!!ret;
1652c88fd863SSteven Rostedt }
1653c88fd863SSteven Rostedt 
16544fbb48cbSSteven Rostedt (Red Hat) /* Test if ops registered to this rec needs regs */
16554fbb48cbSSteven Rostedt (Red Hat) static bool test_rec_ops_needs_regs(struct dyn_ftrace *rec)
16564fbb48cbSSteven Rostedt (Red Hat) {
16574fbb48cbSSteven Rostedt (Red Hat) 	struct ftrace_ops *ops;
16584fbb48cbSSteven Rostedt (Red Hat) 	bool keep_regs = false;
16594fbb48cbSSteven Rostedt (Red Hat) 
16604fbb48cbSSteven Rostedt (Red Hat) 	for (ops = ftrace_ops_list;
16614fbb48cbSSteven Rostedt (Red Hat) 	     ops != &ftrace_list_end; ops = ops->next) {
16624fbb48cbSSteven Rostedt (Red Hat) 		/* pass rec in as regs to have non-NULL val */
16634fbb48cbSSteven Rostedt (Red Hat) 		if (ftrace_ops_test(ops, rec->ip, rec)) {
16644fbb48cbSSteven Rostedt (Red Hat) 			if (ops->flags & FTRACE_OPS_FL_SAVE_REGS) {
16654fbb48cbSSteven Rostedt (Red Hat) 				keep_regs = true;
16664fbb48cbSSteven Rostedt (Red Hat) 				break;
16674fbb48cbSSteven Rostedt (Red Hat) 			}
16684fbb48cbSSteven Rostedt (Red Hat) 		}
16694fbb48cbSSteven Rostedt (Red Hat) 	}
16704fbb48cbSSteven Rostedt (Red Hat) 
16714fbb48cbSSteven Rostedt (Red Hat) 	return  keep_regs;
16724fbb48cbSSteven Rostedt (Red Hat) }
16734fbb48cbSSteven Rostedt (Red Hat) 
1674a124692bSCheng Jian static struct ftrace_ops *
1675a124692bSCheng Jian ftrace_find_tramp_ops_any(struct dyn_ftrace *rec);
1676a124692bSCheng Jian static struct ftrace_ops *
16774c75b0ffSNaveen N. Rao ftrace_find_tramp_ops_any_other(struct dyn_ftrace *rec, struct ftrace_ops *op_exclude);
16784c75b0ffSNaveen N. Rao static struct ftrace_ops *
1679a124692bSCheng Jian ftrace_find_tramp_ops_next(struct dyn_ftrace *rec, struct ftrace_ops *ops);
1680a124692bSCheng Jian 
1681cf04f2d5SSteven Rostedt (Google) static bool skip_record(struct dyn_ftrace *rec)
1682cf04f2d5SSteven Rostedt (Google) {
1683cf04f2d5SSteven Rostedt (Google) 	/*
1684cf04f2d5SSteven Rostedt (Google) 	 * At boot up, weak functions are set to disable. Function tracing
1685cf04f2d5SSteven Rostedt (Google) 	 * can be enabled before they are, and they still need to be disabled now.
1686cf04f2d5SSteven Rostedt (Google) 	 * If the record is disabled, still continue if it is marked as already
1687cf04f2d5SSteven Rostedt (Google) 	 * enabled (this is needed to keep the accounting working).
1688cf04f2d5SSteven Rostedt (Google) 	 */
1689cf04f2d5SSteven Rostedt (Google) 	return rec->flags & FTRACE_FL_DISABLED &&
1690cf04f2d5SSteven Rostedt (Google) 		!(rec->flags & FTRACE_FL_ENABLED);
1691cf04f2d5SSteven Rostedt (Google) }
1692cf04f2d5SSteven Rostedt (Google) 
169384b6d3e6SJiri Olsa static bool __ftrace_hash_rec_update(struct ftrace_ops *ops,
1694ed926f9bSSteven Rostedt 				     int filter_hash,
1695ed926f9bSSteven Rostedt 				     bool inc)
1696ed926f9bSSteven Rostedt {
1697ed926f9bSSteven Rostedt 	struct ftrace_hash *hash;
1698ed926f9bSSteven Rostedt 	struct ftrace_hash *other_hash;
1699ed926f9bSSteven Rostedt 	struct ftrace_page *pg;
1700ed926f9bSSteven Rostedt 	struct dyn_ftrace *rec;
170184b6d3e6SJiri Olsa 	bool update = false;
1702ed926f9bSSteven Rostedt 	int count = 0;
17038c08f0d5SSteven Rostedt (VMware) 	int all = false;
1704ed926f9bSSteven Rostedt 
1705ed926f9bSSteven Rostedt 	/* Only update if the ops has been registered */
1706ed926f9bSSteven Rostedt 	if (!(ops->flags & FTRACE_OPS_FL_ENABLED))
170784b6d3e6SJiri Olsa 		return false;
1708ed926f9bSSteven Rostedt 
1709ed926f9bSSteven Rostedt 	/*
1710ed926f9bSSteven Rostedt 	 * In the filter_hash case:
1711ed926f9bSSteven Rostedt 	 *   If the count is zero, we update all records.
1712ed926f9bSSteven Rostedt 	 *   Otherwise we just update the items in the hash.
1713ed926f9bSSteven Rostedt 	 *
1714ed926f9bSSteven Rostedt 	 * In the notrace_hash case:
1715ed926f9bSSteven Rostedt 	 *   We enable the update in the hash.
1716ed926f9bSSteven Rostedt 	 *   As disabling notrace means enabling the tracing,
1717ed926f9bSSteven Rostedt 	 *   and enabling notrace means disabling, the inc variable
1718ed926f9bSSteven Rostedt 	 *   gets inversed.
1719ed926f9bSSteven Rostedt 	 */
1720ed926f9bSSteven Rostedt 	if (filter_hash) {
172133b7f99cSSteven Rostedt (Red Hat) 		hash = ops->func_hash->filter_hash;
172233b7f99cSSteven Rostedt (Red Hat) 		other_hash = ops->func_hash->notrace_hash;
172306a51d93SSteven Rostedt 		if (ftrace_hash_empty(hash))
17248c08f0d5SSteven Rostedt (VMware) 			all = true;
1725ed926f9bSSteven Rostedt 	} else {
1726ed926f9bSSteven Rostedt 		inc = !inc;
172733b7f99cSSteven Rostedt (Red Hat) 		hash = ops->func_hash->notrace_hash;
172833b7f99cSSteven Rostedt (Red Hat) 		other_hash = ops->func_hash->filter_hash;
1729ed926f9bSSteven Rostedt 		/*
1730ed926f9bSSteven Rostedt 		 * If the notrace hash has no items,
1731ed926f9bSSteven Rostedt 		 * then there's nothing to do.
1732ed926f9bSSteven Rostedt 		 */
173306a51d93SSteven Rostedt 		if (ftrace_hash_empty(hash))
173484b6d3e6SJiri Olsa 			return false;
1735ed926f9bSSteven Rostedt 	}
1736ed926f9bSSteven Rostedt 
1737ed926f9bSSteven Rostedt 	do_for_each_ftrace_rec(pg, rec) {
1738ed926f9bSSteven Rostedt 		int in_other_hash = 0;
1739ed926f9bSSteven Rostedt 		int in_hash = 0;
1740ed926f9bSSteven Rostedt 		int match = 0;
1741ed926f9bSSteven Rostedt 
1742cf04f2d5SSteven Rostedt (Google) 		if (skip_record(rec))
1743b7ffffbbSSteven Rostedt (Red Hat) 			continue;
1744b7ffffbbSSteven Rostedt (Red Hat) 
1745ed926f9bSSteven Rostedt 		if (all) {
1746ed926f9bSSteven Rostedt 			/*
1747ed926f9bSSteven Rostedt 			 * Only the filter_hash affects all records.
1748ed926f9bSSteven Rostedt 			 * Update if the record is not in the notrace hash.
1749ed926f9bSSteven Rostedt 			 */
1750b848914cSSteven Rostedt 			if (!other_hash || !ftrace_lookup_ip(other_hash, rec->ip))
1751ed926f9bSSteven Rostedt 				match = 1;
1752ed926f9bSSteven Rostedt 		} else {
175306a51d93SSteven Rostedt 			in_hash = !!ftrace_lookup_ip(hash, rec->ip);
175406a51d93SSteven Rostedt 			in_other_hash = !!ftrace_lookup_ip(other_hash, rec->ip);
1755ed926f9bSSteven Rostedt 
1756ed926f9bSSteven Rostedt 			/*
175719eab4a4SSteven Rostedt (Red Hat) 			 * If filter_hash is set, we want to match all functions
175819eab4a4SSteven Rostedt (Red Hat) 			 * that are in the hash but not in the other hash.
1759ed926f9bSSteven Rostedt 			 *
176019eab4a4SSteven Rostedt (Red Hat) 			 * If filter_hash is not set, then we are decrementing.
176119eab4a4SSteven Rostedt (Red Hat) 			 * That means we match anything that is in the hash
176219eab4a4SSteven Rostedt (Red Hat) 			 * and also in the other_hash. That is, we need to turn
176319eab4a4SSteven Rostedt (Red Hat) 			 * off functions in the other hash because they are disabled
176419eab4a4SSteven Rostedt (Red Hat) 			 * by this hash.
1765ed926f9bSSteven Rostedt 			 */
1766ed926f9bSSteven Rostedt 			if (filter_hash && in_hash && !in_other_hash)
1767ed926f9bSSteven Rostedt 				match = 1;
1768ed926f9bSSteven Rostedt 			else if (!filter_hash && in_hash &&
176906a51d93SSteven Rostedt 				 (in_other_hash || ftrace_hash_empty(other_hash)))
1770ed926f9bSSteven Rostedt 				match = 1;
1771ed926f9bSSteven Rostedt 		}
1772ed926f9bSSteven Rostedt 		if (!match)
1773ed926f9bSSteven Rostedt 			continue;
1774ed926f9bSSteven Rostedt 
1775ed926f9bSSteven Rostedt 		if (inc) {
1776ed926f9bSSteven Rostedt 			rec->flags++;
17770376bde1SSteven Rostedt (Red Hat) 			if (FTRACE_WARN_ON(ftrace_rec_count(rec) == FTRACE_REF_MAX))
177884b6d3e6SJiri Olsa 				return false;
177979922b80SSteven Rostedt (Red Hat) 
1780763e34e7SSteven Rostedt (VMware) 			if (ops->flags & FTRACE_OPS_FL_DIRECT)
1781763e34e7SSteven Rostedt (VMware) 				rec->flags |= FTRACE_FL_DIRECT;
1782763e34e7SSteven Rostedt (VMware) 
178379922b80SSteven Rostedt (Red Hat) 			/*
178479922b80SSteven Rostedt (Red Hat) 			 * If there's only a single callback registered to a
178579922b80SSteven Rostedt (Red Hat) 			 * function, and the ops has a trampoline registered
178679922b80SSteven Rostedt (Red Hat) 			 * for it, then we can call it directly.
178779922b80SSteven Rostedt (Red Hat) 			 */
1788fef5aeeeSSteven Rostedt (Red Hat) 			if (ftrace_rec_count(rec) == 1 && ops->trampoline)
178979922b80SSteven Rostedt (Red Hat) 				rec->flags |= FTRACE_FL_TRAMP;
1790fef5aeeeSSteven Rostedt (Red Hat) 			else
179179922b80SSteven Rostedt (Red Hat) 				/*
179279922b80SSteven Rostedt (Red Hat) 				 * If we are adding another function callback
179379922b80SSteven Rostedt (Red Hat) 				 * to this function, and the previous had a
1794bce0b6c5SSteven Rostedt (Red Hat) 				 * custom trampoline in use, then we need to go
1795bce0b6c5SSteven Rostedt (Red Hat) 				 * back to the default trampoline.
179679922b80SSteven Rostedt (Red Hat) 				 */
1797fef5aeeeSSteven Rostedt (Red Hat) 				rec->flags &= ~FTRACE_FL_TRAMP;
179879922b80SSteven Rostedt (Red Hat) 
179908f6fba5SSteven Rostedt 			/*
180008f6fba5SSteven Rostedt 			 * If any ops wants regs saved for this function
180108f6fba5SSteven Rostedt 			 * then all ops will get saved regs.
180208f6fba5SSteven Rostedt 			 */
180308f6fba5SSteven Rostedt 			if (ops->flags & FTRACE_OPS_FL_SAVE_REGS)
180408f6fba5SSteven Rostedt 				rec->flags |= FTRACE_FL_REGS;
1805ed926f9bSSteven Rostedt 		} else {
18060376bde1SSteven Rostedt (Red Hat) 			if (FTRACE_WARN_ON(ftrace_rec_count(rec) == 0))
180784b6d3e6SJiri Olsa 				return false;
1808ed926f9bSSteven Rostedt 			rec->flags--;
180979922b80SSteven Rostedt (Red Hat) 
18104fbb48cbSSteven Rostedt (Red Hat) 			/*
1811763e34e7SSteven Rostedt (VMware) 			 * Only the internal direct_ops should have the
1812763e34e7SSteven Rostedt (VMware) 			 * DIRECT flag set. Thus, if it is removing a
1813763e34e7SSteven Rostedt (VMware) 			 * function, then that function should no longer
1814763e34e7SSteven Rostedt (VMware) 			 * be direct.
1815763e34e7SSteven Rostedt (VMware) 			 */
1816763e34e7SSteven Rostedt (VMware) 			if (ops->flags & FTRACE_OPS_FL_DIRECT)
1817763e34e7SSteven Rostedt (VMware) 				rec->flags &= ~FTRACE_FL_DIRECT;
1818763e34e7SSteven Rostedt (VMware) 
1819763e34e7SSteven Rostedt (VMware) 			/*
18204fbb48cbSSteven Rostedt (Red Hat) 			 * If the rec had REGS enabled and the ops that is
18214fbb48cbSSteven Rostedt (Red Hat) 			 * being removed had REGS set, then see if there is
18224fbb48cbSSteven Rostedt (Red Hat) 			 * still any ops for this record that wants regs.
18234fbb48cbSSteven Rostedt (Red Hat) 			 * If not, we can stop recording them.
18244fbb48cbSSteven Rostedt (Red Hat) 			 */
18250376bde1SSteven Rostedt (Red Hat) 			if (ftrace_rec_count(rec) > 0 &&
18264fbb48cbSSteven Rostedt (Red Hat) 			    rec->flags & FTRACE_FL_REGS &&
18274fbb48cbSSteven Rostedt (Red Hat) 			    ops->flags & FTRACE_OPS_FL_SAVE_REGS) {
18284fbb48cbSSteven Rostedt (Red Hat) 				if (!test_rec_ops_needs_regs(rec))
18294fbb48cbSSteven Rostedt (Red Hat) 					rec->flags &= ~FTRACE_FL_REGS;
18304fbb48cbSSteven Rostedt (Red Hat) 			}
183179922b80SSteven Rostedt (Red Hat) 
183279922b80SSteven Rostedt (Red Hat) 			/*
1833a124692bSCheng Jian 			 * The TRAMP needs to be set only if rec count
1834a124692bSCheng Jian 			 * is decremented to one, and the ops that is
1835a124692bSCheng Jian 			 * left has a trampoline. As TRAMP can only be
1836a124692bSCheng Jian 			 * enabled if there is only a single ops attached
1837a124692bSCheng Jian 			 * to it.
1838fef5aeeeSSteven Rostedt (Red Hat) 			 */
1839a124692bSCheng Jian 			if (ftrace_rec_count(rec) == 1 &&
18404c75b0ffSNaveen N. Rao 			    ftrace_find_tramp_ops_any_other(rec, ops))
1841a124692bSCheng Jian 				rec->flags |= FTRACE_FL_TRAMP;
1842a124692bSCheng Jian 			else
1843fef5aeeeSSteven Rostedt (Red Hat) 				rec->flags &= ~FTRACE_FL_TRAMP;
1844fef5aeeeSSteven Rostedt (Red Hat) 
1845fef5aeeeSSteven Rostedt (Red Hat) 			/*
184679922b80SSteven Rostedt (Red Hat) 			 * flags will be cleared in ftrace_check_record()
184779922b80SSteven Rostedt (Red Hat) 			 * if rec count is zero.
184879922b80SSteven Rostedt (Red Hat) 			 */
1849ed926f9bSSteven Rostedt 		}
1850cbad0fb2SMark Rutland 
1851cbad0fb2SMark Rutland 		/*
1852cbad0fb2SMark Rutland 		 * If the rec has a single associated ops, and ops->func can be
1853cbad0fb2SMark Rutland 		 * called directly, allow the call site to call via the ops.
1854cbad0fb2SMark Rutland 		 */
1855cbad0fb2SMark Rutland 		if (IS_ENABLED(CONFIG_DYNAMIC_FTRACE_WITH_CALL_OPS) &&
1856cbad0fb2SMark Rutland 		    ftrace_rec_count(rec) == 1 &&
1857cbad0fb2SMark Rutland 		    ftrace_ops_get_func(ops) == ops->func)
1858cbad0fb2SMark Rutland 			rec->flags |= FTRACE_FL_CALL_OPS;
1859cbad0fb2SMark Rutland 		else
1860cbad0fb2SMark Rutland 			rec->flags &= ~FTRACE_FL_CALL_OPS;
1861cbad0fb2SMark Rutland 
1862ed926f9bSSteven Rostedt 		count++;
186384b6d3e6SJiri Olsa 
186484b6d3e6SJiri Olsa 		/* Must match FTRACE_UPDATE_CALLS in ftrace_modify_all_code() */
18657375dca1SSteven Rostedt (VMware) 		update |= ftrace_test_record(rec, true) != FTRACE_UPDATE_IGNORE;
186684b6d3e6SJiri Olsa 
1867ed926f9bSSteven Rostedt 		/* Shortcut, if we handled all records, we are done. */
1868ed926f9bSSteven Rostedt 		if (!all && count == hash->count)
186984b6d3e6SJiri Olsa 			return update;
1870ed926f9bSSteven Rostedt 	} while_for_each_ftrace_rec();
187184b6d3e6SJiri Olsa 
187284b6d3e6SJiri Olsa 	return update;
1873ed926f9bSSteven Rostedt }
1874ed926f9bSSteven Rostedt 
187584b6d3e6SJiri Olsa static bool ftrace_hash_rec_disable(struct ftrace_ops *ops,
1876ed926f9bSSteven Rostedt 				    int filter_hash)
1877ed926f9bSSteven Rostedt {
187884b6d3e6SJiri Olsa 	return __ftrace_hash_rec_update(ops, filter_hash, 0);
1879ed926f9bSSteven Rostedt }
1880ed926f9bSSteven Rostedt 
188184b6d3e6SJiri Olsa static bool ftrace_hash_rec_enable(struct ftrace_ops *ops,
1882ed926f9bSSteven Rostedt 				   int filter_hash)
1883ed926f9bSSteven Rostedt {
188484b6d3e6SJiri Olsa 	return __ftrace_hash_rec_update(ops, filter_hash, 1);
1885ed926f9bSSteven Rostedt }
1886ed926f9bSSteven Rostedt 
188784261912SSteven Rostedt (Red Hat) static void ftrace_hash_rec_update_modify(struct ftrace_ops *ops,
188884261912SSteven Rostedt (Red Hat) 					  int filter_hash, int inc)
188984261912SSteven Rostedt (Red Hat) {
189084261912SSteven Rostedt (Red Hat) 	struct ftrace_ops *op;
189184261912SSteven Rostedt (Red Hat) 
189284261912SSteven Rostedt (Red Hat) 	__ftrace_hash_rec_update(ops, filter_hash, inc);
189384261912SSteven Rostedt (Red Hat) 
189484261912SSteven Rostedt (Red Hat) 	if (ops->func_hash != &global_ops.local_hash)
189584261912SSteven Rostedt (Red Hat) 		return;
189684261912SSteven Rostedt (Red Hat) 
189784261912SSteven Rostedt (Red Hat) 	/*
189884261912SSteven Rostedt (Red Hat) 	 * If the ops shares the global_ops hash, then we need to update
189984261912SSteven Rostedt (Red Hat) 	 * all ops that are enabled and use this hash.
190084261912SSteven Rostedt (Red Hat) 	 */
190184261912SSteven Rostedt (Red Hat) 	do_for_each_ftrace_op(op, ftrace_ops_list) {
190284261912SSteven Rostedt (Red Hat) 		/* Already done */
190384261912SSteven Rostedt (Red Hat) 		if (op == ops)
190484261912SSteven Rostedt (Red Hat) 			continue;
190584261912SSteven Rostedt (Red Hat) 		if (op->func_hash == &global_ops.local_hash)
190684261912SSteven Rostedt (Red Hat) 			__ftrace_hash_rec_update(op, filter_hash, inc);
190784261912SSteven Rostedt (Red Hat) 	} while_for_each_ftrace_op(op);
190884261912SSteven Rostedt (Red Hat) }
190984261912SSteven Rostedt (Red Hat) 
191084261912SSteven Rostedt (Red Hat) static void ftrace_hash_rec_disable_modify(struct ftrace_ops *ops,
191184261912SSteven Rostedt (Red Hat) 					   int filter_hash)
191284261912SSteven Rostedt (Red Hat) {
191384261912SSteven Rostedt (Red Hat) 	ftrace_hash_rec_update_modify(ops, filter_hash, 0);
191484261912SSteven Rostedt (Red Hat) }
191584261912SSteven Rostedt (Red Hat) 
191684261912SSteven Rostedt (Red Hat) static void ftrace_hash_rec_enable_modify(struct ftrace_ops *ops,
191784261912SSteven Rostedt (Red Hat) 					  int filter_hash)
191884261912SSteven Rostedt (Red Hat) {
191984261912SSteven Rostedt (Red Hat) 	ftrace_hash_rec_update_modify(ops, filter_hash, 1);
192084261912SSteven Rostedt (Red Hat) }
192184261912SSteven Rostedt (Red Hat) 
1922f8b8be8aSMasami Hiramatsu /*
1923f8b8be8aSMasami Hiramatsu  * Try to update IPMODIFY flag on each ftrace_rec. Return 0 if it is OK
1924f8b8be8aSMasami Hiramatsu  * or no-needed to update, -EBUSY if it detects a conflict of the flag
1925f8b8be8aSMasami Hiramatsu  * on a ftrace_rec, and -EINVAL if the new_hash tries to trace all recs.
1926f8b8be8aSMasami Hiramatsu  * Note that old_hash and new_hash has below meanings
1927f8b8be8aSMasami Hiramatsu  *  - If the hash is NULL, it hits all recs (if IPMODIFY is set, this is rejected)
1928f8b8be8aSMasami Hiramatsu  *  - If the hash is EMPTY_HASH, it hits nothing
1929f8b8be8aSMasami Hiramatsu  *  - Anything else hits the recs which match the hash entries.
193053cd885bSSong Liu  *
193153cd885bSSong Liu  * DIRECT ops does not have IPMODIFY flag, but we still need to check it
193253cd885bSSong Liu  * against functions with FTRACE_FL_IPMODIFY. If there is any overlap, call
193353cd885bSSong Liu  * ops_func(SHARE_IPMODIFY_SELF) to make sure current ops can share with
193453cd885bSSong Liu  * IPMODIFY. If ops_func(SHARE_IPMODIFY_SELF) returns non-zero, propagate
193553cd885bSSong Liu  * the return value to the caller and eventually to the owner of the DIRECT
193653cd885bSSong Liu  * ops.
1937f8b8be8aSMasami Hiramatsu  */
1938f8b8be8aSMasami Hiramatsu static int __ftrace_hash_update_ipmodify(struct ftrace_ops *ops,
1939f8b8be8aSMasami Hiramatsu 					 struct ftrace_hash *old_hash,
1940f8b8be8aSMasami Hiramatsu 					 struct ftrace_hash *new_hash)
1941f8b8be8aSMasami Hiramatsu {
1942f8b8be8aSMasami Hiramatsu 	struct ftrace_page *pg;
1943f8b8be8aSMasami Hiramatsu 	struct dyn_ftrace *rec, *end = NULL;
1944f8b8be8aSMasami Hiramatsu 	int in_old, in_new;
194553cd885bSSong Liu 	bool is_ipmodify, is_direct;
1946f8b8be8aSMasami Hiramatsu 
1947f8b8be8aSMasami Hiramatsu 	/* Only update if the ops has been registered */
1948f8b8be8aSMasami Hiramatsu 	if (!(ops->flags & FTRACE_OPS_FL_ENABLED))
1949f8b8be8aSMasami Hiramatsu 		return 0;
1950f8b8be8aSMasami Hiramatsu 
195153cd885bSSong Liu 	is_ipmodify = ops->flags & FTRACE_OPS_FL_IPMODIFY;
195253cd885bSSong Liu 	is_direct = ops->flags & FTRACE_OPS_FL_DIRECT;
195353cd885bSSong Liu 
195453cd885bSSong Liu 	/* neither IPMODIFY nor DIRECT, skip */
195553cd885bSSong Liu 	if (!is_ipmodify && !is_direct)
195653cd885bSSong Liu 		return 0;
195753cd885bSSong Liu 
195853cd885bSSong Liu 	if (WARN_ON_ONCE(is_ipmodify && is_direct))
1959f8b8be8aSMasami Hiramatsu 		return 0;
1960f8b8be8aSMasami Hiramatsu 
1961f8b8be8aSMasami Hiramatsu 	/*
196253cd885bSSong Liu 	 * Since the IPMODIFY and DIRECT are very address sensitive
196353cd885bSSong Liu 	 * actions, we do not allow ftrace_ops to set all functions to new
196453cd885bSSong Liu 	 * hash.
1965f8b8be8aSMasami Hiramatsu 	 */
1966f8b8be8aSMasami Hiramatsu 	if (!new_hash || !old_hash)
1967f8b8be8aSMasami Hiramatsu 		return -EINVAL;
1968f8b8be8aSMasami Hiramatsu 
1969f8b8be8aSMasami Hiramatsu 	/* Update rec->flags */
1970f8b8be8aSMasami Hiramatsu 	do_for_each_ftrace_rec(pg, rec) {
1971546fece4SSteven Rostedt (Red Hat) 
1972546fece4SSteven Rostedt (Red Hat) 		if (rec->flags & FTRACE_FL_DISABLED)
1973546fece4SSteven Rostedt (Red Hat) 			continue;
1974546fece4SSteven Rostedt (Red Hat) 
1975f8b8be8aSMasami Hiramatsu 		/* We need to update only differences of filter_hash */
1976f8b8be8aSMasami Hiramatsu 		in_old = !!ftrace_lookup_ip(old_hash, rec->ip);
1977f8b8be8aSMasami Hiramatsu 		in_new = !!ftrace_lookup_ip(new_hash, rec->ip);
1978f8b8be8aSMasami Hiramatsu 		if (in_old == in_new)
1979f8b8be8aSMasami Hiramatsu 			continue;
1980f8b8be8aSMasami Hiramatsu 
1981f8b8be8aSMasami Hiramatsu 		if (in_new) {
198253cd885bSSong Liu 			if (rec->flags & FTRACE_FL_IPMODIFY) {
198353cd885bSSong Liu 				int ret;
198453cd885bSSong Liu 
198553cd885bSSong Liu 				/* Cannot have two ipmodify on same rec */
198653cd885bSSong Liu 				if (is_ipmodify)
1987f8b8be8aSMasami Hiramatsu 					goto rollback;
198853cd885bSSong Liu 
198953cd885bSSong Liu 				FTRACE_WARN_ON(rec->flags & FTRACE_FL_DIRECT);
199053cd885bSSong Liu 
199153cd885bSSong Liu 				/*
199253cd885bSSong Liu 				 * Another ops with IPMODIFY is already
199353cd885bSSong Liu 				 * attached. We are now attaching a direct
199453cd885bSSong Liu 				 * ops. Run SHARE_IPMODIFY_SELF, to check
199553cd885bSSong Liu 				 * whether sharing is supported.
199653cd885bSSong Liu 				 */
199753cd885bSSong Liu 				if (!ops->ops_func)
199853cd885bSSong Liu 					return -EBUSY;
199953cd885bSSong Liu 				ret = ops->ops_func(ops, FTRACE_OPS_CMD_ENABLE_SHARE_IPMODIFY_SELF);
200053cd885bSSong Liu 				if (ret)
200153cd885bSSong Liu 					return ret;
200253cd885bSSong Liu 			} else if (is_ipmodify) {
2003f8b8be8aSMasami Hiramatsu 				rec->flags |= FTRACE_FL_IPMODIFY;
200453cd885bSSong Liu 			}
200553cd885bSSong Liu 		} else if (is_ipmodify) {
2006f8b8be8aSMasami Hiramatsu 			rec->flags &= ~FTRACE_FL_IPMODIFY;
200753cd885bSSong Liu 		}
2008f8b8be8aSMasami Hiramatsu 	} while_for_each_ftrace_rec();
2009f8b8be8aSMasami Hiramatsu 
2010f8b8be8aSMasami Hiramatsu 	return 0;
2011f8b8be8aSMasami Hiramatsu 
2012f8b8be8aSMasami Hiramatsu rollback:
2013f8b8be8aSMasami Hiramatsu 	end = rec;
2014f8b8be8aSMasami Hiramatsu 
2015f8b8be8aSMasami Hiramatsu 	/* Roll back what we did above */
2016f8b8be8aSMasami Hiramatsu 	do_for_each_ftrace_rec(pg, rec) {
2017546fece4SSteven Rostedt (Red Hat) 
2018546fece4SSteven Rostedt (Red Hat) 		if (rec->flags & FTRACE_FL_DISABLED)
2019546fece4SSteven Rostedt (Red Hat) 			continue;
2020546fece4SSteven Rostedt (Red Hat) 
2021f8b8be8aSMasami Hiramatsu 		if (rec == end)
2022f8b8be8aSMasami Hiramatsu 			goto err_out;
2023f8b8be8aSMasami Hiramatsu 
2024f8b8be8aSMasami Hiramatsu 		in_old = !!ftrace_lookup_ip(old_hash, rec->ip);
2025f8b8be8aSMasami Hiramatsu 		in_new = !!ftrace_lookup_ip(new_hash, rec->ip);
2026f8b8be8aSMasami Hiramatsu 		if (in_old == in_new)
2027f8b8be8aSMasami Hiramatsu 			continue;
2028f8b8be8aSMasami Hiramatsu 
2029f8b8be8aSMasami Hiramatsu 		if (in_new)
2030f8b8be8aSMasami Hiramatsu 			rec->flags &= ~FTRACE_FL_IPMODIFY;
2031f8b8be8aSMasami Hiramatsu 		else
2032f8b8be8aSMasami Hiramatsu 			rec->flags |= FTRACE_FL_IPMODIFY;
2033f8b8be8aSMasami Hiramatsu 	} while_for_each_ftrace_rec();
2034f8b8be8aSMasami Hiramatsu 
2035f8b8be8aSMasami Hiramatsu err_out:
2036f8b8be8aSMasami Hiramatsu 	return -EBUSY;
2037f8b8be8aSMasami Hiramatsu }
2038f8b8be8aSMasami Hiramatsu 
2039f8b8be8aSMasami Hiramatsu static int ftrace_hash_ipmodify_enable(struct ftrace_ops *ops)
2040f8b8be8aSMasami Hiramatsu {
2041f8b8be8aSMasami Hiramatsu 	struct ftrace_hash *hash = ops->func_hash->filter_hash;
2042f8b8be8aSMasami Hiramatsu 
2043f8b8be8aSMasami Hiramatsu 	if (ftrace_hash_empty(hash))
2044f8b8be8aSMasami Hiramatsu 		hash = NULL;
2045f8b8be8aSMasami Hiramatsu 
2046f8b8be8aSMasami Hiramatsu 	return __ftrace_hash_update_ipmodify(ops, EMPTY_HASH, hash);
2047f8b8be8aSMasami Hiramatsu }
2048f8b8be8aSMasami Hiramatsu 
2049f8b8be8aSMasami Hiramatsu /* Disabling always succeeds */
2050f8b8be8aSMasami Hiramatsu static void ftrace_hash_ipmodify_disable(struct ftrace_ops *ops)
2051f8b8be8aSMasami Hiramatsu {
2052f8b8be8aSMasami Hiramatsu 	struct ftrace_hash *hash = ops->func_hash->filter_hash;
2053f8b8be8aSMasami Hiramatsu 
2054f8b8be8aSMasami Hiramatsu 	if (ftrace_hash_empty(hash))
2055f8b8be8aSMasami Hiramatsu 		hash = NULL;
2056f8b8be8aSMasami Hiramatsu 
2057f8b8be8aSMasami Hiramatsu 	__ftrace_hash_update_ipmodify(ops, hash, EMPTY_HASH);
2058f8b8be8aSMasami Hiramatsu }
2059f8b8be8aSMasami Hiramatsu 
2060f8b8be8aSMasami Hiramatsu static int ftrace_hash_ipmodify_update(struct ftrace_ops *ops,
2061f8b8be8aSMasami Hiramatsu 				       struct ftrace_hash *new_hash)
2062f8b8be8aSMasami Hiramatsu {
2063f8b8be8aSMasami Hiramatsu 	struct ftrace_hash *old_hash = ops->func_hash->filter_hash;
2064f8b8be8aSMasami Hiramatsu 
2065f8b8be8aSMasami Hiramatsu 	if (ftrace_hash_empty(old_hash))
2066f8b8be8aSMasami Hiramatsu 		old_hash = NULL;
2067f8b8be8aSMasami Hiramatsu 
2068f8b8be8aSMasami Hiramatsu 	if (ftrace_hash_empty(new_hash))
2069f8b8be8aSMasami Hiramatsu 		new_hash = NULL;
2070f8b8be8aSMasami Hiramatsu 
2071f8b8be8aSMasami Hiramatsu 	return __ftrace_hash_update_ipmodify(ops, old_hash, new_hash);
2072f8b8be8aSMasami Hiramatsu }
2073f8b8be8aSMasami Hiramatsu 
2074b05086c7SSteven Rostedt (Red Hat) static void print_ip_ins(const char *fmt, const unsigned char *p)
207505736a42SSteven Rostedt {
20766c14133dSSteven Rostedt (VMware) 	char ins[MCOUNT_INSN_SIZE];
207705736a42SSteven Rostedt 
20786c14133dSSteven Rostedt (VMware) 	if (copy_from_kernel_nofault(ins, p, MCOUNT_INSN_SIZE)) {
20796c14133dSSteven Rostedt (VMware) 		printk(KERN_CONT "%s[FAULT] %px\n", fmt, p);
20806c14133dSSteven Rostedt (VMware) 		return;
20816c14133dSSteven Rostedt (VMware) 	}
20826c14133dSSteven Rostedt (VMware) 
208305736a42SSteven Rostedt 	printk(KERN_CONT "%s", fmt);
208430f7d1caSZheng Yejian 	pr_cont("%*phC", MCOUNT_INSN_SIZE, ins);
208505736a42SSteven Rostedt }
208605736a42SSteven Rostedt 
208702a392a0SSteven Rostedt (Red Hat) enum ftrace_bug_type ftrace_bug_type;
2088b05086c7SSteven Rostedt (Red Hat) const void *ftrace_expected;
208902a392a0SSteven Rostedt (Red Hat) 
209002a392a0SSteven Rostedt (Red Hat) static void print_bug_type(void)
209102a392a0SSteven Rostedt (Red Hat) {
209202a392a0SSteven Rostedt (Red Hat) 	switch (ftrace_bug_type) {
209302a392a0SSteven Rostedt (Red Hat) 	case FTRACE_BUG_UNKNOWN:
209402a392a0SSteven Rostedt (Red Hat) 		break;
209502a392a0SSteven Rostedt (Red Hat) 	case FTRACE_BUG_INIT:
209602a392a0SSteven Rostedt (Red Hat) 		pr_info("Initializing ftrace call sites\n");
209702a392a0SSteven Rostedt (Red Hat) 		break;
209802a392a0SSteven Rostedt (Red Hat) 	case FTRACE_BUG_NOP:
209902a392a0SSteven Rostedt (Red Hat) 		pr_info("Setting ftrace call site to NOP\n");
210002a392a0SSteven Rostedt (Red Hat) 		break;
210102a392a0SSteven Rostedt (Red Hat) 	case FTRACE_BUG_CALL:
210202a392a0SSteven Rostedt (Red Hat) 		pr_info("Setting ftrace call site to call ftrace function\n");
210302a392a0SSteven Rostedt (Red Hat) 		break;
210402a392a0SSteven Rostedt (Red Hat) 	case FTRACE_BUG_UPDATE:
210502a392a0SSteven Rostedt (Red Hat) 		pr_info("Updating ftrace call site to call a different ftrace function\n");
210602a392a0SSteven Rostedt (Red Hat) 		break;
210702a392a0SSteven Rostedt (Red Hat) 	}
210802a392a0SSteven Rostedt (Red Hat) }
210902a392a0SSteven Rostedt (Red Hat) 
2110c88fd863SSteven Rostedt /**
2111c88fd863SSteven Rostedt  * ftrace_bug - report and shutdown function tracer
2112c88fd863SSteven Rostedt  * @failed: The failed type (EFAULT, EINVAL, EPERM)
21134fd3279bSSteven Rostedt (Red Hat)  * @rec: The record that failed
2114c88fd863SSteven Rostedt  *
2115c88fd863SSteven Rostedt  * The arch code that enables or disables the function tracing
2116c88fd863SSteven Rostedt  * can call ftrace_bug() when it has detected a problem in
2117c88fd863SSteven Rostedt  * modifying the code. @failed should be one of either:
2118c88fd863SSteven Rostedt  * EFAULT - if the problem happens on reading the @ip address
2119c88fd863SSteven Rostedt  * EINVAL - if what is read at @ip is not what was expected
21209efb85c5SHariprasad Kelam  * EPERM - if the problem happens on writing to the @ip address
2121c88fd863SSteven Rostedt  */
21224fd3279bSSteven Rostedt (Red Hat) void ftrace_bug(int failed, struct dyn_ftrace *rec)
21233c1720f0SSteven Rostedt {
21244fd3279bSSteven Rostedt (Red Hat) 	unsigned long ip = rec ? rec->ip : 0;
21254fd3279bSSteven Rostedt (Red Hat) 
2126c143b775SCheng Jian 	pr_info("------------[ ftrace bug ]------------\n");
2127c143b775SCheng Jian 
2128b17e8a37SSteven Rostedt 	switch (failed) {
2129593eb8a2SSteven Rostedt 	case -EFAULT:
213005736a42SSteven Rostedt 		pr_info("ftrace faulted on modifying ");
21312062a4e8SDmitry Safonov 		print_ip_sym(KERN_INFO, ip);
213205736a42SSteven Rostedt 		break;
2133593eb8a2SSteven Rostedt 	case -EINVAL:
213405736a42SSteven Rostedt 		pr_info("ftrace failed to modify ");
21352062a4e8SDmitry Safonov 		print_ip_sym(KERN_INFO, ip);
213605736a42SSteven Rostedt 		print_ip_ins(" actual:   ", (unsigned char *)ip);
21374fd3279bSSteven Rostedt (Red Hat) 		pr_cont("\n");
2138b05086c7SSteven Rostedt (Red Hat) 		if (ftrace_expected) {
2139b05086c7SSteven Rostedt (Red Hat) 			print_ip_ins(" expected: ", ftrace_expected);
2140b05086c7SSteven Rostedt (Red Hat) 			pr_cont("\n");
2141b05086c7SSteven Rostedt (Red Hat) 		}
214205736a42SSteven Rostedt 		break;
2143593eb8a2SSteven Rostedt 	case -EPERM:
2144593eb8a2SSteven Rostedt 		pr_info("ftrace faulted on writing ");
21452062a4e8SDmitry Safonov 		print_ip_sym(KERN_INFO, ip);
2146593eb8a2SSteven Rostedt 		break;
2147593eb8a2SSteven Rostedt 	default:
2148593eb8a2SSteven Rostedt 		pr_info("ftrace faulted on unknown error ");
21492062a4e8SDmitry Safonov 		print_ip_sym(KERN_INFO, ip);
215005736a42SSteven Rostedt 	}
215102a392a0SSteven Rostedt (Red Hat) 	print_bug_type();
21524fd3279bSSteven Rostedt (Red Hat) 	if (rec) {
21534fd3279bSSteven Rostedt (Red Hat) 		struct ftrace_ops *ops = NULL;
21544fd3279bSSteven Rostedt (Red Hat) 
21554fd3279bSSteven Rostedt (Red Hat) 		pr_info("ftrace record flags: %lx\n", rec->flags);
2156cbad0fb2SMark Rutland 		pr_cont(" (%ld)%s%s", ftrace_rec_count(rec),
2157cbad0fb2SMark Rutland 			rec->flags & FTRACE_FL_REGS ? " R" : "  ",
2158cbad0fb2SMark Rutland 			rec->flags & FTRACE_FL_CALL_OPS ? " O" : "  ");
21594fd3279bSSteven Rostedt (Red Hat) 		if (rec->flags & FTRACE_FL_TRAMP_EN) {
21604fd3279bSSteven Rostedt (Red Hat) 			ops = ftrace_find_tramp_ops_any(rec);
216139daa7b9SSteven Rostedt (Red Hat) 			if (ops) {
216239daa7b9SSteven Rostedt (Red Hat) 				do {
216339daa7b9SSteven Rostedt (Red Hat) 					pr_cont("\ttramp: %pS (%pS)",
216439daa7b9SSteven Rostedt (Red Hat) 						(void *)ops->trampoline,
216539daa7b9SSteven Rostedt (Red Hat) 						(void *)ops->func);
216639daa7b9SSteven Rostedt (Red Hat) 					ops = ftrace_find_tramp_ops_next(rec, ops);
216739daa7b9SSteven Rostedt (Red Hat) 				} while (ops);
216839daa7b9SSteven Rostedt (Red Hat) 			} else
21694fd3279bSSteven Rostedt (Red Hat) 				pr_cont("\ttramp: ERROR!");
21704fd3279bSSteven Rostedt (Red Hat) 
21714fd3279bSSteven Rostedt (Red Hat) 		}
21724fd3279bSSteven Rostedt (Red Hat) 		ip = ftrace_get_addr_curr(rec);
217339daa7b9SSteven Rostedt (Red Hat) 		pr_cont("\n expected tramp: %lx\n", ip);
21744fd3279bSSteven Rostedt (Red Hat) 	}
2175c143b775SCheng Jian 
2176c143b775SCheng Jian 	FTRACE_WARN_ON_ONCE(1);
2177b17e8a37SSteven Rostedt }
217805736a42SSteven Rostedt 
21797375dca1SSteven Rostedt (VMware) static int ftrace_check_record(struct dyn_ftrace *rec, bool enable, bool update)
21803d083395SSteven Rostedt {
218164fbcd16SXiao Guangrong 	unsigned long flag = 0UL;
2182e7d3737eSFrederic Weisbecker 
218302a392a0SSteven Rostedt (Red Hat) 	ftrace_bug_type = FTRACE_BUG_UNKNOWN;
218402a392a0SSteven Rostedt (Red Hat) 
2185cf04f2d5SSteven Rostedt (Google) 	if (skip_record(rec))
2186b7ffffbbSSteven Rostedt (Red Hat) 		return FTRACE_UPDATE_IGNORE;
2187b7ffffbbSSteven Rostedt (Red Hat) 
21883d083395SSteven Rostedt 	/*
218930fb6aa7SJiri Olsa 	 * If we are updating calls:
21903d083395SSteven Rostedt 	 *
2191ed926f9bSSteven Rostedt 	 *   If the record has a ref count, then we need to enable it
2192ed926f9bSSteven Rostedt 	 *   because someone is using it.
21933d083395SSteven Rostedt 	 *
2194ed926f9bSSteven Rostedt 	 *   Otherwise we make sure its disabled.
2195ed926f9bSSteven Rostedt 	 *
219630fb6aa7SJiri Olsa 	 * If we are disabling calls, then disable all records that
2197ed926f9bSSteven Rostedt 	 * are enabled.
21983d083395SSteven Rostedt 	 */
21990376bde1SSteven Rostedt (Red Hat) 	if (enable && ftrace_rec_count(rec))
220064fbcd16SXiao Guangrong 		flag = FTRACE_FL_ENABLED;
22013d083395SSteven Rostedt 
220208f6fba5SSteven Rostedt 	/*
220379922b80SSteven Rostedt (Red Hat) 	 * If enabling and the REGS flag does not match the REGS_EN, or
220479922b80SSteven Rostedt (Red Hat) 	 * the TRAMP flag doesn't match the TRAMP_EN, then do not ignore
220579922b80SSteven Rostedt (Red Hat) 	 * this record. Set flags to fail the compare against ENABLED.
2206763e34e7SSteven Rostedt (VMware) 	 * Same for direct calls.
220708f6fba5SSteven Rostedt 	 */
220879922b80SSteven Rostedt (Red Hat) 	if (flag) {
220979922b80SSteven Rostedt (Red Hat) 		if (!(rec->flags & FTRACE_FL_REGS) !=
221079922b80SSteven Rostedt (Red Hat) 		    !(rec->flags & FTRACE_FL_REGS_EN))
221108f6fba5SSteven Rostedt 			flag |= FTRACE_FL_REGS;
221208f6fba5SSteven Rostedt 
221379922b80SSteven Rostedt (Red Hat) 		if (!(rec->flags & FTRACE_FL_TRAMP) !=
221479922b80SSteven Rostedt (Red Hat) 		    !(rec->flags & FTRACE_FL_TRAMP_EN))
221579922b80SSteven Rostedt (Red Hat) 			flag |= FTRACE_FL_TRAMP;
2216763e34e7SSteven Rostedt (VMware) 
2217763e34e7SSteven Rostedt (VMware) 		/*
2218763e34e7SSteven Rostedt (VMware) 		 * Direct calls are special, as count matters.
2219763e34e7SSteven Rostedt (VMware) 		 * We must test the record for direct, if the
2220763e34e7SSteven Rostedt (VMware) 		 * DIRECT and DIRECT_EN do not match, but only
2221763e34e7SSteven Rostedt (VMware) 		 * if the count is 1. That's because, if the
2222763e34e7SSteven Rostedt (VMware) 		 * count is something other than one, we do not
2223763e34e7SSteven Rostedt (VMware) 		 * want the direct enabled (it will be done via the
2224763e34e7SSteven Rostedt (VMware) 		 * direct helper). But if DIRECT_EN is set, and
2225763e34e7SSteven Rostedt (VMware) 		 * the count is not one, we need to clear it.
2226cbad0fb2SMark Rutland 		 *
2227763e34e7SSteven Rostedt (VMware) 		 */
2228763e34e7SSteven Rostedt (VMware) 		if (ftrace_rec_count(rec) == 1) {
2229763e34e7SSteven Rostedt (VMware) 			if (!(rec->flags & FTRACE_FL_DIRECT) !=
2230763e34e7SSteven Rostedt (VMware) 			    !(rec->flags & FTRACE_FL_DIRECT_EN))
2231763e34e7SSteven Rostedt (VMware) 				flag |= FTRACE_FL_DIRECT;
2232763e34e7SSteven Rostedt (VMware) 		} else if (rec->flags & FTRACE_FL_DIRECT_EN) {
2233763e34e7SSteven Rostedt (VMware) 			flag |= FTRACE_FL_DIRECT;
2234763e34e7SSteven Rostedt (VMware) 		}
2235cbad0fb2SMark Rutland 
2236cbad0fb2SMark Rutland 		/*
2237cbad0fb2SMark Rutland 		 * Ops calls are special, as count matters.
2238cbad0fb2SMark Rutland 		 * As with direct calls, they must only be enabled when count
2239cbad0fb2SMark Rutland 		 * is one, otherwise they'll be handled via the list ops.
2240cbad0fb2SMark Rutland 		 */
2241cbad0fb2SMark Rutland 		if (ftrace_rec_count(rec) == 1) {
2242cbad0fb2SMark Rutland 			if (!(rec->flags & FTRACE_FL_CALL_OPS) !=
2243cbad0fb2SMark Rutland 			    !(rec->flags & FTRACE_FL_CALL_OPS_EN))
2244cbad0fb2SMark Rutland 				flag |= FTRACE_FL_CALL_OPS;
2245cbad0fb2SMark Rutland 		} else if (rec->flags & FTRACE_FL_CALL_OPS_EN) {
2246cbad0fb2SMark Rutland 			flag |= FTRACE_FL_CALL_OPS;
2247cbad0fb2SMark Rutland 		}
224879922b80SSteven Rostedt (Red Hat) 	}
224979922b80SSteven Rostedt (Red Hat) 
225064fbcd16SXiao Guangrong 	/* If the state of this record hasn't changed, then do nothing */
225164fbcd16SXiao Guangrong 	if ((rec->flags & FTRACE_FL_ENABLED) == flag)
2252c88fd863SSteven Rostedt 		return FTRACE_UPDATE_IGNORE;
225364fbcd16SXiao Guangrong 
225464fbcd16SXiao Guangrong 	if (flag) {
225508f6fba5SSteven Rostedt 		/* Save off if rec is being enabled (for return value) */
225608f6fba5SSteven Rostedt 		flag ^= rec->flags & FTRACE_FL_ENABLED;
225708f6fba5SSteven Rostedt 
225808f6fba5SSteven Rostedt 		if (update) {
225964fbcd16SXiao Guangrong 			rec->flags |= FTRACE_FL_ENABLED;
226008f6fba5SSteven Rostedt 			if (flag & FTRACE_FL_REGS) {
226108f6fba5SSteven Rostedt 				if (rec->flags & FTRACE_FL_REGS)
226208f6fba5SSteven Rostedt 					rec->flags |= FTRACE_FL_REGS_EN;
226308f6fba5SSteven Rostedt 				else
226408f6fba5SSteven Rostedt 					rec->flags &= ~FTRACE_FL_REGS_EN;
226508f6fba5SSteven Rostedt 			}
226679922b80SSteven Rostedt (Red Hat) 			if (flag & FTRACE_FL_TRAMP) {
226779922b80SSteven Rostedt (Red Hat) 				if (rec->flags & FTRACE_FL_TRAMP)
226879922b80SSteven Rostedt (Red Hat) 					rec->flags |= FTRACE_FL_TRAMP_EN;
226979922b80SSteven Rostedt (Red Hat) 				else
227079922b80SSteven Rostedt (Red Hat) 					rec->flags &= ~FTRACE_FL_TRAMP_EN;
227179922b80SSteven Rostedt (Red Hat) 			}
2272d19ad077SSteven Rostedt (VMware) 
2273763e34e7SSteven Rostedt (VMware) 			if (flag & FTRACE_FL_DIRECT) {
2274763e34e7SSteven Rostedt (VMware) 				/*
2275763e34e7SSteven Rostedt (VMware) 				 * If there's only one user (direct_ops helper)
2276763e34e7SSteven Rostedt (VMware) 				 * then we can call the direct function
2277763e34e7SSteven Rostedt (VMware) 				 * directly (no ftrace trampoline).
2278763e34e7SSteven Rostedt (VMware) 				 */
2279763e34e7SSteven Rostedt (VMware) 				if (ftrace_rec_count(rec) == 1) {
2280763e34e7SSteven Rostedt (VMware) 					if (rec->flags & FTRACE_FL_DIRECT)
2281763e34e7SSteven Rostedt (VMware) 						rec->flags |= FTRACE_FL_DIRECT_EN;
2282763e34e7SSteven Rostedt (VMware) 					else
2283763e34e7SSteven Rostedt (VMware) 						rec->flags &= ~FTRACE_FL_DIRECT_EN;
2284763e34e7SSteven Rostedt (VMware) 				} else {
2285763e34e7SSteven Rostedt (VMware) 					/*
2286763e34e7SSteven Rostedt (VMware) 					 * Can only call directly if there's
2287763e34e7SSteven Rostedt (VMware) 					 * only one callback to the function.
2288763e34e7SSteven Rostedt (VMware) 					 */
2289763e34e7SSteven Rostedt (VMware) 					rec->flags &= ~FTRACE_FL_DIRECT_EN;
2290763e34e7SSteven Rostedt (VMware) 				}
2291763e34e7SSteven Rostedt (VMware) 			}
2292cbad0fb2SMark Rutland 
2293cbad0fb2SMark Rutland 			if (flag & FTRACE_FL_CALL_OPS) {
2294cbad0fb2SMark Rutland 				if (ftrace_rec_count(rec) == 1) {
2295cbad0fb2SMark Rutland 					if (rec->flags & FTRACE_FL_CALL_OPS)
2296cbad0fb2SMark Rutland 						rec->flags |= FTRACE_FL_CALL_OPS_EN;
2297cbad0fb2SMark Rutland 					else
2298cbad0fb2SMark Rutland 						rec->flags &= ~FTRACE_FL_CALL_OPS_EN;
2299cbad0fb2SMark Rutland 				} else {
2300cbad0fb2SMark Rutland 					/*
2301cbad0fb2SMark Rutland 					 * Can only call directly if there's
2302cbad0fb2SMark Rutland 					 * only one set of associated ops.
2303cbad0fb2SMark Rutland 					 */
2304cbad0fb2SMark Rutland 					rec->flags &= ~FTRACE_FL_CALL_OPS_EN;
2305cbad0fb2SMark Rutland 				}
2306cbad0fb2SMark Rutland 			}
230764fbcd16SXiao Guangrong 		}
230864fbcd16SXiao Guangrong 
230908f6fba5SSteven Rostedt 		/*
231008f6fba5SSteven Rostedt 		 * If this record is being updated from a nop, then
231108f6fba5SSteven Rostedt 		 *   return UPDATE_MAKE_CALL.
231208f6fba5SSteven Rostedt 		 * Otherwise,
231308f6fba5SSteven Rostedt 		 *   return UPDATE_MODIFY_CALL to tell the caller to convert
2314f1b2f2bdSSteven Rostedt (Red Hat) 		 *   from the save regs, to a non-save regs function or
231579922b80SSteven Rostedt (Red Hat) 		 *   vice versa, or from a trampoline call.
231608f6fba5SSteven Rostedt 		 */
231702a392a0SSteven Rostedt (Red Hat) 		if (flag & FTRACE_FL_ENABLED) {
231802a392a0SSteven Rostedt (Red Hat) 			ftrace_bug_type = FTRACE_BUG_CALL;
231908f6fba5SSteven Rostedt 			return FTRACE_UPDATE_MAKE_CALL;
232002a392a0SSteven Rostedt (Red Hat) 		}
2321f1b2f2bdSSteven Rostedt (Red Hat) 
232202a392a0SSteven Rostedt (Red Hat) 		ftrace_bug_type = FTRACE_BUG_UPDATE;
232308f6fba5SSteven Rostedt 		return FTRACE_UPDATE_MODIFY_CALL;
232408f6fba5SSteven Rostedt 	}
232508f6fba5SSteven Rostedt 
232608f6fba5SSteven Rostedt 	if (update) {
232708f6fba5SSteven Rostedt 		/* If there's no more users, clear all flags */
23280376bde1SSteven Rostedt (Red Hat) 		if (!ftrace_rec_count(rec))
2329cf04f2d5SSteven Rostedt (Google) 			rec->flags &= FTRACE_FL_DISABLED;
233008f6fba5SSteven Rostedt 		else
2331b24d443bSSteven Rostedt (Red Hat) 			/*
2332b24d443bSSteven Rostedt (Red Hat) 			 * Just disable the record, but keep the ops TRAMP
2333b24d443bSSteven Rostedt (Red Hat) 			 * and REGS states. The _EN flags must be disabled though.
2334b24d443bSSteven Rostedt (Red Hat) 			 */
2335b24d443bSSteven Rostedt (Red Hat) 			rec->flags &= ~(FTRACE_FL_ENABLED | FTRACE_FL_TRAMP_EN |
2336cbad0fb2SMark Rutland 					FTRACE_FL_REGS_EN | FTRACE_FL_DIRECT_EN |
2337cbad0fb2SMark Rutland 					FTRACE_FL_CALL_OPS_EN);
233808f6fba5SSteven Rostedt 	}
2339c88fd863SSteven Rostedt 
234002a392a0SSteven Rostedt (Red Hat) 	ftrace_bug_type = FTRACE_BUG_NOP;
2341c88fd863SSteven Rostedt 	return FTRACE_UPDATE_MAKE_NOP;
2342c88fd863SSteven Rostedt }
2343c88fd863SSteven Rostedt 
2344c88fd863SSteven Rostedt /**
23456130722fSSteven Rostedt (VMware)  * ftrace_update_record - set a record that now is tracing or not
2346c88fd863SSteven Rostedt  * @rec: the record to update
23477375dca1SSteven Rostedt (VMware)  * @enable: set to true if the record is tracing, false to force disable
2348c88fd863SSteven Rostedt  *
2349c88fd863SSteven Rostedt  * The records that represent all functions that can be traced need
2350c88fd863SSteven Rostedt  * to be updated when tracing has been enabled.
2351c88fd863SSteven Rostedt  */
23527375dca1SSteven Rostedt (VMware) int ftrace_update_record(struct dyn_ftrace *rec, bool enable)
2353c88fd863SSteven Rostedt {
23547375dca1SSteven Rostedt (VMware) 	return ftrace_check_record(rec, enable, true);
2355c88fd863SSteven Rostedt }
2356c88fd863SSteven Rostedt 
2357c88fd863SSteven Rostedt /**
23586130722fSSteven Rostedt (VMware)  * ftrace_test_record - check if the record has been enabled or not
2359c88fd863SSteven Rostedt  * @rec: the record to test
23607375dca1SSteven Rostedt (VMware)  * @enable: set to true to check if enabled, false if it is disabled
2361c88fd863SSteven Rostedt  *
2362c88fd863SSteven Rostedt  * The arch code may need to test if a record is already set to
2363c88fd863SSteven Rostedt  * tracing to determine how to modify the function code that it
2364c88fd863SSteven Rostedt  * represents.
2365c88fd863SSteven Rostedt  */
23667375dca1SSteven Rostedt (VMware) int ftrace_test_record(struct dyn_ftrace *rec, bool enable)
2367c88fd863SSteven Rostedt {
23687375dca1SSteven Rostedt (VMware) 	return ftrace_check_record(rec, enable, false);
2369c88fd863SSteven Rostedt }
2370c88fd863SSteven Rostedt 
237179922b80SSteven Rostedt (Red Hat) static struct ftrace_ops *
23725fecaa04SSteven Rostedt (Red Hat) ftrace_find_tramp_ops_any(struct dyn_ftrace *rec)
23735fecaa04SSteven Rostedt (Red Hat) {
23745fecaa04SSteven Rostedt (Red Hat) 	struct ftrace_ops *op;
2375fef5aeeeSSteven Rostedt (Red Hat) 	unsigned long ip = rec->ip;
23765fecaa04SSteven Rostedt (Red Hat) 
23775fecaa04SSteven Rostedt (Red Hat) 	do_for_each_ftrace_op(op, ftrace_ops_list) {
23785fecaa04SSteven Rostedt (Red Hat) 
23795fecaa04SSteven Rostedt (Red Hat) 		if (!op->trampoline)
23805fecaa04SSteven Rostedt (Red Hat) 			continue;
23815fecaa04SSteven Rostedt (Red Hat) 
2382fef5aeeeSSteven Rostedt (Red Hat) 		if (hash_contains_ip(ip, op->func_hash))
23835fecaa04SSteven Rostedt (Red Hat) 			return op;
23845fecaa04SSteven Rostedt (Red Hat) 	} while_for_each_ftrace_op(op);
23855fecaa04SSteven Rostedt (Red Hat) 
23865fecaa04SSteven Rostedt (Red Hat) 	return NULL;
23875fecaa04SSteven Rostedt (Red Hat) }
23885fecaa04SSteven Rostedt (Red Hat) 
23895fecaa04SSteven Rostedt (Red Hat) static struct ftrace_ops *
23904c75b0ffSNaveen N. Rao ftrace_find_tramp_ops_any_other(struct dyn_ftrace *rec, struct ftrace_ops *op_exclude)
23914c75b0ffSNaveen N. Rao {
23924c75b0ffSNaveen N. Rao 	struct ftrace_ops *op;
23934c75b0ffSNaveen N. Rao 	unsigned long ip = rec->ip;
23944c75b0ffSNaveen N. Rao 
23954c75b0ffSNaveen N. Rao 	do_for_each_ftrace_op(op, ftrace_ops_list) {
23964c75b0ffSNaveen N. Rao 
23974c75b0ffSNaveen N. Rao 		if (op == op_exclude || !op->trampoline)
23984c75b0ffSNaveen N. Rao 			continue;
23994c75b0ffSNaveen N. Rao 
24004c75b0ffSNaveen N. Rao 		if (hash_contains_ip(ip, op->func_hash))
24014c75b0ffSNaveen N. Rao 			return op;
24024c75b0ffSNaveen N. Rao 	} while_for_each_ftrace_op(op);
24034c75b0ffSNaveen N. Rao 
24044c75b0ffSNaveen N. Rao 	return NULL;
24054c75b0ffSNaveen N. Rao }
24064c75b0ffSNaveen N. Rao 
24074c75b0ffSNaveen N. Rao static struct ftrace_ops *
240839daa7b9SSteven Rostedt (Red Hat) ftrace_find_tramp_ops_next(struct dyn_ftrace *rec,
240939daa7b9SSteven Rostedt (Red Hat) 			   struct ftrace_ops *op)
241039daa7b9SSteven Rostedt (Red Hat) {
241139daa7b9SSteven Rostedt (Red Hat) 	unsigned long ip = rec->ip;
241239daa7b9SSteven Rostedt (Red Hat) 
241339daa7b9SSteven Rostedt (Red Hat) 	while_for_each_ftrace_op(op) {
241439daa7b9SSteven Rostedt (Red Hat) 
241539daa7b9SSteven Rostedt (Red Hat) 		if (!op->trampoline)
241639daa7b9SSteven Rostedt (Red Hat) 			continue;
241739daa7b9SSteven Rostedt (Red Hat) 
241839daa7b9SSteven Rostedt (Red Hat) 		if (hash_contains_ip(ip, op->func_hash))
241939daa7b9SSteven Rostedt (Red Hat) 			return op;
242039daa7b9SSteven Rostedt (Red Hat) 	}
242139daa7b9SSteven Rostedt (Red Hat) 
242239daa7b9SSteven Rostedt (Red Hat) 	return NULL;
242339daa7b9SSteven Rostedt (Red Hat) }
242439daa7b9SSteven Rostedt (Red Hat) 
242539daa7b9SSteven Rostedt (Red Hat) static struct ftrace_ops *
242679922b80SSteven Rostedt (Red Hat) ftrace_find_tramp_ops_curr(struct dyn_ftrace *rec)
242779922b80SSteven Rostedt (Red Hat) {
242879922b80SSteven Rostedt (Red Hat) 	struct ftrace_ops *op;
2429fef5aeeeSSteven Rostedt (Red Hat) 	unsigned long ip = rec->ip;
243079922b80SSteven Rostedt (Red Hat) 
2431fef5aeeeSSteven Rostedt (Red Hat) 	/*
2432fef5aeeeSSteven Rostedt (Red Hat) 	 * Need to check removed ops first.
2433fef5aeeeSSteven Rostedt (Red Hat) 	 * If they are being removed, and this rec has a tramp,
2434fef5aeeeSSteven Rostedt (Red Hat) 	 * and this rec is in the ops list, then it would be the
2435fef5aeeeSSteven Rostedt (Red Hat) 	 * one with the tramp.
2436fef5aeeeSSteven Rostedt (Red Hat) 	 */
2437fef5aeeeSSteven Rostedt (Red Hat) 	if (removed_ops) {
2438fef5aeeeSSteven Rostedt (Red Hat) 		if (hash_contains_ip(ip, &removed_ops->old_hash))
243979922b80SSteven Rostedt (Red Hat) 			return removed_ops;
244079922b80SSteven Rostedt (Red Hat) 	}
244179922b80SSteven Rostedt (Red Hat) 
2442fef5aeeeSSteven Rostedt (Red Hat) 	/*
2443fef5aeeeSSteven Rostedt (Red Hat) 	 * Need to find the current trampoline for a rec.
2444fef5aeeeSSteven Rostedt (Red Hat) 	 * Now, a trampoline is only attached to a rec if there
2445fef5aeeeSSteven Rostedt (Red Hat) 	 * was a single 'ops' attached to it. But this can be called
2446fef5aeeeSSteven Rostedt (Red Hat) 	 * when we are adding another op to the rec or removing the
2447fef5aeeeSSteven Rostedt (Red Hat) 	 * current one. Thus, if the op is being added, we can
2448fef5aeeeSSteven Rostedt (Red Hat) 	 * ignore it because it hasn't attached itself to the rec
24494fc40904SSteven Rostedt (Red Hat) 	 * yet.
24504fc40904SSteven Rostedt (Red Hat) 	 *
24514fc40904SSteven Rostedt (Red Hat) 	 * If an ops is being modified (hooking to different functions)
24524fc40904SSteven Rostedt (Red Hat) 	 * then we don't care about the new functions that are being
24534fc40904SSteven Rostedt (Red Hat) 	 * added, just the old ones (that are probably being removed).
24544fc40904SSteven Rostedt (Red Hat) 	 *
24554fc40904SSteven Rostedt (Red Hat) 	 * If we are adding an ops to a function that already is using
24564fc40904SSteven Rostedt (Red Hat) 	 * a trampoline, it needs to be removed (trampolines are only
24574fc40904SSteven Rostedt (Red Hat) 	 * for single ops connected), then an ops that is not being
24584fc40904SSteven Rostedt (Red Hat) 	 * modified also needs to be checked.
2459fef5aeeeSSteven Rostedt (Red Hat) 	 */
246079922b80SSteven Rostedt (Red Hat) 	do_for_each_ftrace_op(op, ftrace_ops_list) {
2461fef5aeeeSSteven Rostedt (Red Hat) 
2462fef5aeeeSSteven Rostedt (Red Hat) 		if (!op->trampoline)
246379922b80SSteven Rostedt (Red Hat) 			continue;
246479922b80SSteven Rostedt (Red Hat) 
2465fef5aeeeSSteven Rostedt (Red Hat) 		/*
2466fef5aeeeSSteven Rostedt (Red Hat) 		 * If the ops is being added, it hasn't gotten to
2467fef5aeeeSSteven Rostedt (Red Hat) 		 * the point to be removed from this tree yet.
2468fef5aeeeSSteven Rostedt (Red Hat) 		 */
2469fef5aeeeSSteven Rostedt (Red Hat) 		if (op->flags & FTRACE_OPS_FL_ADDING)
2470fef5aeeeSSteven Rostedt (Red Hat) 			continue;
2471fef5aeeeSSteven Rostedt (Red Hat) 
2472fef5aeeeSSteven Rostedt (Red Hat) 
24734fc40904SSteven Rostedt (Red Hat) 		/*
24744fc40904SSteven Rostedt (Red Hat) 		 * If the ops is being modified and is in the old
24754fc40904SSteven Rostedt (Red Hat) 		 * hash, then it is probably being removed from this
24764fc40904SSteven Rostedt (Red Hat) 		 * function.
24774fc40904SSteven Rostedt (Red Hat) 		 */
2478fef5aeeeSSteven Rostedt (Red Hat) 		if ((op->flags & FTRACE_OPS_FL_MODIFYING) &&
2479fef5aeeeSSteven Rostedt (Red Hat) 		    hash_contains_ip(ip, &op->old_hash))
248079922b80SSteven Rostedt (Red Hat) 			return op;
24814fc40904SSteven Rostedt (Red Hat) 		/*
24824fc40904SSteven Rostedt (Red Hat) 		 * If the ops is not being added or modified, and it's
24834fc40904SSteven Rostedt (Red Hat) 		 * in its normal filter hash, then this must be the one
24844fc40904SSteven Rostedt (Red Hat) 		 * we want!
24854fc40904SSteven Rostedt (Red Hat) 		 */
24864fc40904SSteven Rostedt (Red Hat) 		if (!(op->flags & FTRACE_OPS_FL_MODIFYING) &&
24874fc40904SSteven Rostedt (Red Hat) 		    hash_contains_ip(ip, op->func_hash))
24884fc40904SSteven Rostedt (Red Hat) 			return op;
248979922b80SSteven Rostedt (Red Hat) 
249079922b80SSteven Rostedt (Red Hat) 	} while_for_each_ftrace_op(op);
249179922b80SSteven Rostedt (Red Hat) 
249279922b80SSteven Rostedt (Red Hat) 	return NULL;
249379922b80SSteven Rostedt (Red Hat) }
249479922b80SSteven Rostedt (Red Hat) 
249579922b80SSteven Rostedt (Red Hat) static struct ftrace_ops *
249679922b80SSteven Rostedt (Red Hat) ftrace_find_tramp_ops_new(struct dyn_ftrace *rec)
249779922b80SSteven Rostedt (Red Hat) {
249879922b80SSteven Rostedt (Red Hat) 	struct ftrace_ops *op;
2499fef5aeeeSSteven Rostedt (Red Hat) 	unsigned long ip = rec->ip;
250079922b80SSteven Rostedt (Red Hat) 
250179922b80SSteven Rostedt (Red Hat) 	do_for_each_ftrace_op(op, ftrace_ops_list) {
250279922b80SSteven Rostedt (Red Hat) 		/* pass rec in as regs to have non-NULL val */
2503fef5aeeeSSteven Rostedt (Red Hat) 		if (hash_contains_ip(ip, op->func_hash))
250479922b80SSteven Rostedt (Red Hat) 			return op;
250579922b80SSteven Rostedt (Red Hat) 	} while_for_each_ftrace_op(op);
250679922b80SSteven Rostedt (Red Hat) 
250779922b80SSteven Rostedt (Red Hat) 	return NULL;
250879922b80SSteven Rostedt (Red Hat) }
250979922b80SSteven Rostedt (Red Hat) 
2510cbad0fb2SMark Rutland struct ftrace_ops *
2511cbad0fb2SMark Rutland ftrace_find_unique_ops(struct dyn_ftrace *rec)
2512cbad0fb2SMark Rutland {
2513cbad0fb2SMark Rutland 	struct ftrace_ops *op, *found = NULL;
2514cbad0fb2SMark Rutland 	unsigned long ip = rec->ip;
2515cbad0fb2SMark Rutland 
2516cbad0fb2SMark Rutland 	do_for_each_ftrace_op(op, ftrace_ops_list) {
2517cbad0fb2SMark Rutland 
2518cbad0fb2SMark Rutland 		if (hash_contains_ip(ip, op->func_hash)) {
2519cbad0fb2SMark Rutland 			if (found)
2520cbad0fb2SMark Rutland 				return NULL;
2521cbad0fb2SMark Rutland 			found = op;
2522cbad0fb2SMark Rutland 		}
2523cbad0fb2SMark Rutland 
2524cbad0fb2SMark Rutland 	} while_for_each_ftrace_op(op);
2525cbad0fb2SMark Rutland 
2526cbad0fb2SMark Rutland 	return found;
2527cbad0fb2SMark Rutland }
2528cbad0fb2SMark Rutland 
2529763e34e7SSteven Rostedt (VMware) #ifdef CONFIG_DYNAMIC_FTRACE_WITH_DIRECT_CALLS
2530763e34e7SSteven Rostedt (VMware) /* Protected by rcu_tasks for reading, and direct_mutex for writing */
2531763e34e7SSteven Rostedt (VMware) static struct ftrace_hash *direct_functions = EMPTY_HASH;
2532763e34e7SSteven Rostedt (VMware) static DEFINE_MUTEX(direct_mutex);
2533a3ad1a7eSSteven Rostedt (VMware) int ftrace_direct_func_count;
2534763e34e7SSteven Rostedt (VMware) 
2535763e34e7SSteven Rostedt (VMware) /*
2536763e34e7SSteven Rostedt (VMware)  * Search the direct_functions hash to see if the given instruction pointer
2537763e34e7SSteven Rostedt (VMware)  * has a direct caller attached to it.
2538763e34e7SSteven Rostedt (VMware)  */
2539ff205766SAlexei Starovoitov unsigned long ftrace_find_rec_direct(unsigned long ip)
2540763e34e7SSteven Rostedt (VMware) {
2541763e34e7SSteven Rostedt (VMware) 	struct ftrace_func_entry *entry;
2542763e34e7SSteven Rostedt (VMware) 
2543763e34e7SSteven Rostedt (VMware) 	entry = __ftrace_lookup_ip(direct_functions, ip);
2544763e34e7SSteven Rostedt (VMware) 	if (!entry)
2545763e34e7SSteven Rostedt (VMware) 		return 0;
2546763e34e7SSteven Rostedt (VMware) 
2547763e34e7SSteven Rostedt (VMware) 	return entry->direct;
2548763e34e7SSteven Rostedt (VMware) }
2549763e34e7SSteven Rostedt (VMware) 
25501904a814SJiri Olsa static struct ftrace_func_entry*
25511904a814SJiri Olsa ftrace_add_rec_direct(unsigned long ip, unsigned long addr,
25521904a814SJiri Olsa 		      struct ftrace_hash **free_hash)
25531904a814SJiri Olsa {
25541904a814SJiri Olsa 	struct ftrace_func_entry *entry;
25551904a814SJiri Olsa 
25561904a814SJiri Olsa 	if (ftrace_hash_empty(direct_functions) ||
25571904a814SJiri Olsa 	    direct_functions->count > 2 * (1 << direct_functions->size_bits)) {
25581904a814SJiri Olsa 		struct ftrace_hash *new_hash;
25591904a814SJiri Olsa 		int size = ftrace_hash_empty(direct_functions) ? 0 :
25601904a814SJiri Olsa 			direct_functions->count + 1;
25611904a814SJiri Olsa 
25621904a814SJiri Olsa 		if (size < 32)
25631904a814SJiri Olsa 			size = 32;
25641904a814SJiri Olsa 
25651904a814SJiri Olsa 		new_hash = dup_hash(direct_functions, size);
25661904a814SJiri Olsa 		if (!new_hash)
25671904a814SJiri Olsa 			return NULL;
25681904a814SJiri Olsa 
25691904a814SJiri Olsa 		*free_hash = direct_functions;
25701904a814SJiri Olsa 		direct_functions = new_hash;
25711904a814SJiri Olsa 	}
25721904a814SJiri Olsa 
25731904a814SJiri Olsa 	entry = kmalloc(sizeof(*entry), GFP_KERNEL);
25741904a814SJiri Olsa 	if (!entry)
25751904a814SJiri Olsa 		return NULL;
25761904a814SJiri Olsa 
25771904a814SJiri Olsa 	entry->ip = ip;
25781904a814SJiri Olsa 	entry->direct = addr;
25791904a814SJiri Olsa 	__add_hash_entry(direct_functions, entry);
25801904a814SJiri Olsa 	return entry;
25811904a814SJiri Olsa }
25821904a814SJiri Olsa 
2583763e34e7SSteven Rostedt (VMware) static void call_direct_funcs(unsigned long ip, unsigned long pip,
2584d19ad077SSteven Rostedt (VMware) 			      struct ftrace_ops *ops, struct ftrace_regs *fregs)
2585763e34e7SSteven Rostedt (VMware) {
2586763e34e7SSteven Rostedt (VMware) 	unsigned long addr;
2587763e34e7SSteven Rostedt (VMware) 
2588ff205766SAlexei Starovoitov 	addr = ftrace_find_rec_direct(ip);
2589763e34e7SSteven Rostedt (VMware) 	if (!addr)
2590763e34e7SSteven Rostedt (VMware) 		return;
2591763e34e7SSteven Rostedt (VMware) 
25929705bc70SMark Rutland 	arch_ftrace_set_direct_caller(fregs, addr);
2593763e34e7SSteven Rostedt (VMware) }
2594763e34e7SSteven Rostedt (VMware) #endif /* CONFIG_DYNAMIC_FTRACE_WITH_DIRECT_CALLS */
2595763e34e7SSteven Rostedt (VMware) 
25967413af1fSSteven Rostedt (Red Hat) /**
25977413af1fSSteven Rostedt (Red Hat)  * ftrace_get_addr_new - Get the call address to set to
25987413af1fSSteven Rostedt (Red Hat)  * @rec:  The ftrace record descriptor
25997413af1fSSteven Rostedt (Red Hat)  *
26007413af1fSSteven Rostedt (Red Hat)  * If the record has the FTRACE_FL_REGS set, that means that it
26017413af1fSSteven Rostedt (Red Hat)  * wants to convert to a callback that saves all regs. If FTRACE_FL_REGS
26025c8c206eSRandy Dunlap  * is not set, then it wants to convert to the normal callback.
26037413af1fSSteven Rostedt (Red Hat)  *
26047413af1fSSteven Rostedt (Red Hat)  * Returns the address of the trampoline to set to
26057413af1fSSteven Rostedt (Red Hat)  */
26067413af1fSSteven Rostedt (Red Hat) unsigned long ftrace_get_addr_new(struct dyn_ftrace *rec)
26077413af1fSSteven Rostedt (Red Hat) {
260879922b80SSteven Rostedt (Red Hat) 	struct ftrace_ops *ops;
2609763e34e7SSteven Rostedt (VMware) 	unsigned long addr;
2610763e34e7SSteven Rostedt (VMware) 
2611763e34e7SSteven Rostedt (VMware) 	if ((rec->flags & FTRACE_FL_DIRECT) &&
2612763e34e7SSteven Rostedt (VMware) 	    (ftrace_rec_count(rec) == 1)) {
2613ff205766SAlexei Starovoitov 		addr = ftrace_find_rec_direct(rec->ip);
2614763e34e7SSteven Rostedt (VMware) 		if (addr)
2615763e34e7SSteven Rostedt (VMware) 			return addr;
2616763e34e7SSteven Rostedt (VMware) 		WARN_ON_ONCE(1);
2617763e34e7SSteven Rostedt (VMware) 	}
261879922b80SSteven Rostedt (Red Hat) 
261979922b80SSteven Rostedt (Red Hat) 	/* Trampolines take precedence over regs */
262079922b80SSteven Rostedt (Red Hat) 	if (rec->flags & FTRACE_FL_TRAMP) {
262179922b80SSteven Rostedt (Red Hat) 		ops = ftrace_find_tramp_ops_new(rec);
262279922b80SSteven Rostedt (Red Hat) 		if (FTRACE_WARN_ON(!ops || !ops->trampoline)) {
2623bce0b6c5SSteven Rostedt (Red Hat) 			pr_warn("Bad trampoline accounting at: %p (%pS) (%lx)\n",
2624bce0b6c5SSteven Rostedt (Red Hat) 				(void *)rec->ip, (void *)rec->ip, rec->flags);
262579922b80SSteven Rostedt (Red Hat) 			/* Ftrace is shutting down, return anything */
262679922b80SSteven Rostedt (Red Hat) 			return (unsigned long)FTRACE_ADDR;
262779922b80SSteven Rostedt (Red Hat) 		}
262879922b80SSteven Rostedt (Red Hat) 		return ops->trampoline;
262979922b80SSteven Rostedt (Red Hat) 	}
263079922b80SSteven Rostedt (Red Hat) 
26317413af1fSSteven Rostedt (Red Hat) 	if (rec->flags & FTRACE_FL_REGS)
26327413af1fSSteven Rostedt (Red Hat) 		return (unsigned long)FTRACE_REGS_ADDR;
26337413af1fSSteven Rostedt (Red Hat) 	else
26347413af1fSSteven Rostedt (Red Hat) 		return (unsigned long)FTRACE_ADDR;
26357413af1fSSteven Rostedt (Red Hat) }
26367413af1fSSteven Rostedt (Red Hat) 
26377413af1fSSteven Rostedt (Red Hat) /**
26387413af1fSSteven Rostedt (Red Hat)  * ftrace_get_addr_curr - Get the call address that is already there
26397413af1fSSteven Rostedt (Red Hat)  * @rec:  The ftrace record descriptor
26407413af1fSSteven Rostedt (Red Hat)  *
26417413af1fSSteven Rostedt (Red Hat)  * The FTRACE_FL_REGS_EN is set when the record already points to
26427413af1fSSteven Rostedt (Red Hat)  * a function that saves all the regs. Basically the '_EN' version
26437413af1fSSteven Rostedt (Red Hat)  * represents the current state of the function.
26447413af1fSSteven Rostedt (Red Hat)  *
26457413af1fSSteven Rostedt (Red Hat)  * Returns the address of the trampoline that is currently being called
26467413af1fSSteven Rostedt (Red Hat)  */
26477413af1fSSteven Rostedt (Red Hat) unsigned long ftrace_get_addr_curr(struct dyn_ftrace *rec)
26487413af1fSSteven Rostedt (Red Hat) {
264979922b80SSteven Rostedt (Red Hat) 	struct ftrace_ops *ops;
2650763e34e7SSteven Rostedt (VMware) 	unsigned long addr;
2651763e34e7SSteven Rostedt (VMware) 
2652763e34e7SSteven Rostedt (VMware) 	/* Direct calls take precedence over trampolines */
2653763e34e7SSteven Rostedt (VMware) 	if (rec->flags & FTRACE_FL_DIRECT_EN) {
2654ff205766SAlexei Starovoitov 		addr = ftrace_find_rec_direct(rec->ip);
2655763e34e7SSteven Rostedt (VMware) 		if (addr)
2656763e34e7SSteven Rostedt (VMware) 			return addr;
2657763e34e7SSteven Rostedt (VMware) 		WARN_ON_ONCE(1);
2658763e34e7SSteven Rostedt (VMware) 	}
265979922b80SSteven Rostedt (Red Hat) 
266079922b80SSteven Rostedt (Red Hat) 	/* Trampolines take precedence over regs */
266179922b80SSteven Rostedt (Red Hat) 	if (rec->flags & FTRACE_FL_TRAMP_EN) {
266279922b80SSteven Rostedt (Red Hat) 		ops = ftrace_find_tramp_ops_curr(rec);
266379922b80SSteven Rostedt (Red Hat) 		if (FTRACE_WARN_ON(!ops)) {
2664a395d6a7SJoe Perches 			pr_warn("Bad trampoline accounting at: %p (%pS)\n",
266579922b80SSteven Rostedt (Red Hat) 				(void *)rec->ip, (void *)rec->ip);
266679922b80SSteven Rostedt (Red Hat) 			/* Ftrace is shutting down, return anything */
266779922b80SSteven Rostedt (Red Hat) 			return (unsigned long)FTRACE_ADDR;
266879922b80SSteven Rostedt (Red Hat) 		}
266979922b80SSteven Rostedt (Red Hat) 		return ops->trampoline;
267079922b80SSteven Rostedt (Red Hat) 	}
267179922b80SSteven Rostedt (Red Hat) 
26727413af1fSSteven Rostedt (Red Hat) 	if (rec->flags & FTRACE_FL_REGS_EN)
26737413af1fSSteven Rostedt (Red Hat) 		return (unsigned long)FTRACE_REGS_ADDR;
26747413af1fSSteven Rostedt (Red Hat) 	else
26757413af1fSSteven Rostedt (Red Hat) 		return (unsigned long)FTRACE_ADDR;
26767413af1fSSteven Rostedt (Red Hat) }
26777413af1fSSteven Rostedt (Red Hat) 
2678c88fd863SSteven Rostedt static int
26797375dca1SSteven Rostedt (VMware) __ftrace_replace_code(struct dyn_ftrace *rec, bool enable)
2680c88fd863SSteven Rostedt {
268108f6fba5SSteven Rostedt 	unsigned long ftrace_old_addr;
2682c88fd863SSteven Rostedt 	unsigned long ftrace_addr;
2683c88fd863SSteven Rostedt 	int ret;
2684c88fd863SSteven Rostedt 
26857c0868e0SSteven Rostedt (Red Hat) 	ftrace_addr = ftrace_get_addr_new(rec);
2686c88fd863SSteven Rostedt 
26877c0868e0SSteven Rostedt (Red Hat) 	/* This needs to be done before we call ftrace_update_record */
26887c0868e0SSteven Rostedt (Red Hat) 	ftrace_old_addr = ftrace_get_addr_curr(rec);
26897c0868e0SSteven Rostedt (Red Hat) 
26907c0868e0SSteven Rostedt (Red Hat) 	ret = ftrace_update_record(rec, enable);
269108f6fba5SSteven Rostedt 
269202a392a0SSteven Rostedt (Red Hat) 	ftrace_bug_type = FTRACE_BUG_UNKNOWN;
269302a392a0SSteven Rostedt (Red Hat) 
2694c88fd863SSteven Rostedt 	switch (ret) {
2695c88fd863SSteven Rostedt 	case FTRACE_UPDATE_IGNORE:
2696c88fd863SSteven Rostedt 		return 0;
2697c88fd863SSteven Rostedt 
2698c88fd863SSteven Rostedt 	case FTRACE_UPDATE_MAKE_CALL:
269902a392a0SSteven Rostedt (Red Hat) 		ftrace_bug_type = FTRACE_BUG_CALL;
2700c88fd863SSteven Rostedt 		return ftrace_make_call(rec, ftrace_addr);
2701c88fd863SSteven Rostedt 
2702c88fd863SSteven Rostedt 	case FTRACE_UPDATE_MAKE_NOP:
270302a392a0SSteven Rostedt (Red Hat) 		ftrace_bug_type = FTRACE_BUG_NOP;
270439b5552cSSteven Rostedt (Red Hat) 		return ftrace_make_nop(NULL, rec, ftrace_old_addr);
270508f6fba5SSteven Rostedt 
270608f6fba5SSteven Rostedt 	case FTRACE_UPDATE_MODIFY_CALL:
270702a392a0SSteven Rostedt (Red Hat) 		ftrace_bug_type = FTRACE_BUG_UPDATE;
270808f6fba5SSteven Rostedt 		return ftrace_modify_call(rec, ftrace_old_addr, ftrace_addr);
27093d083395SSteven Rostedt 	}
27103d083395SSteven Rostedt 
27119efb85c5SHariprasad Kelam 	return -1; /* unknown ftrace bug */
2712c88fd863SSteven Rostedt }
2713c88fd863SSteven Rostedt 
2714a0572f68SSteven Rostedt (VMware) void __weak ftrace_replace_code(int mod_flags)
27153d083395SSteven Rostedt {
27163d083395SSteven Rostedt 	struct dyn_ftrace *rec;
27173d083395SSteven Rostedt 	struct ftrace_page *pg;
27187375dca1SSteven Rostedt (VMware) 	bool enable = mod_flags & FTRACE_MODIFY_ENABLE_FL;
2719a0572f68SSteven Rostedt (VMware) 	int schedulable = mod_flags & FTRACE_MODIFY_MAY_SLEEP_FL;
27206a24a244SSteven Rostedt 	int failed;
27213d083395SSteven Rostedt 
272245a4a237SSteven Rostedt 	if (unlikely(ftrace_disabled))
272345a4a237SSteven Rostedt 		return;
272445a4a237SSteven Rostedt 
2725265c831cSSteven Rostedt 	do_for_each_ftrace_rec(pg, rec) {
2726546fece4SSteven Rostedt (Red Hat) 
2727cf04f2d5SSteven Rostedt (Google) 		if (skip_record(rec))
2728546fece4SSteven Rostedt (Red Hat) 			continue;
2729546fece4SSteven Rostedt (Red Hat) 
2730e4f5d544SSteven Rostedt 		failed = __ftrace_replace_code(rec, enable);
2731fa9d13cfSZhaolei 		if (failed) {
27324fd3279bSSteven Rostedt (Red Hat) 			ftrace_bug(failed, rec);
27334377245aSSteven Rostedt 			/* Stop processing */
27344377245aSSteven Rostedt 			return;
27354377245aSSteven Rostedt 		}
2736a0572f68SSteven Rostedt (VMware) 		if (schedulable)
2737a0572f68SSteven Rostedt (VMware) 			cond_resched();
2738265c831cSSteven Rostedt 	} while_for_each_ftrace_rec();
27393d083395SSteven Rostedt }
27403c1720f0SSteven Rostedt 
2741c88fd863SSteven Rostedt struct ftrace_rec_iter {
2742c88fd863SSteven Rostedt 	struct ftrace_page	*pg;
2743c88fd863SSteven Rostedt 	int			index;
2744c88fd863SSteven Rostedt };
2745c88fd863SSteven Rostedt 
2746c88fd863SSteven Rostedt /**
27476130722fSSteven Rostedt (VMware)  * ftrace_rec_iter_start - start up iterating over traced functions
2748c88fd863SSteven Rostedt  *
2749c88fd863SSteven Rostedt  * Returns an iterator handle that is used to iterate over all
2750c88fd863SSteven Rostedt  * the records that represent address locations where functions
2751c88fd863SSteven Rostedt  * are traced.
2752c88fd863SSteven Rostedt  *
2753c88fd863SSteven Rostedt  * May return NULL if no records are available.
2754c88fd863SSteven Rostedt  */
2755c88fd863SSteven Rostedt struct ftrace_rec_iter *ftrace_rec_iter_start(void)
2756c88fd863SSteven Rostedt {
2757c88fd863SSteven Rostedt 	/*
2758c88fd863SSteven Rostedt 	 * We only use a single iterator.
2759c88fd863SSteven Rostedt 	 * Protected by the ftrace_lock mutex.
2760c88fd863SSteven Rostedt 	 */
2761c88fd863SSteven Rostedt 	static struct ftrace_rec_iter ftrace_rec_iter;
2762c88fd863SSteven Rostedt 	struct ftrace_rec_iter *iter = &ftrace_rec_iter;
2763c88fd863SSteven Rostedt 
2764c88fd863SSteven Rostedt 	iter->pg = ftrace_pages_start;
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 	if (!iter->pg)
2772c88fd863SSteven Rostedt 		return NULL;
2773c88fd863SSteven Rostedt 
2774c88fd863SSteven Rostedt 	return iter;
2775c88fd863SSteven Rostedt }
2776c88fd863SSteven Rostedt 
2777c88fd863SSteven Rostedt /**
27786130722fSSteven Rostedt (VMware)  * ftrace_rec_iter_next - get the next record to process.
2779c88fd863SSteven Rostedt  * @iter: The handle to the iterator.
2780c88fd863SSteven Rostedt  *
2781c88fd863SSteven Rostedt  * Returns the next iterator after the given iterator @iter.
2782c88fd863SSteven Rostedt  */
2783c88fd863SSteven Rostedt struct ftrace_rec_iter *ftrace_rec_iter_next(struct ftrace_rec_iter *iter)
2784c88fd863SSteven Rostedt {
2785c88fd863SSteven Rostedt 	iter->index++;
2786c88fd863SSteven Rostedt 
2787c88fd863SSteven Rostedt 	if (iter->index >= iter->pg->index) {
2788c88fd863SSteven Rostedt 		iter->pg = iter->pg->next;
2789c88fd863SSteven Rostedt 		iter->index = 0;
2790c88fd863SSteven Rostedt 
2791c88fd863SSteven Rostedt 		/* Could have empty pages */
2792c88fd863SSteven Rostedt 		while (iter->pg && !iter->pg->index)
2793c88fd863SSteven Rostedt 			iter->pg = iter->pg->next;
2794c88fd863SSteven Rostedt 	}
2795c88fd863SSteven Rostedt 
2796c88fd863SSteven Rostedt 	if (!iter->pg)
2797c88fd863SSteven Rostedt 		return NULL;
2798c88fd863SSteven Rostedt 
2799c88fd863SSteven Rostedt 	return iter;
2800c88fd863SSteven Rostedt }
2801c88fd863SSteven Rostedt 
2802c88fd863SSteven Rostedt /**
28036130722fSSteven Rostedt (VMware)  * ftrace_rec_iter_record - get the record at the iterator location
2804c88fd863SSteven Rostedt  * @iter: The current iterator location
2805c88fd863SSteven Rostedt  *
2806c88fd863SSteven Rostedt  * Returns the record that the current @iter is at.
2807c88fd863SSteven Rostedt  */
2808c88fd863SSteven Rostedt struct dyn_ftrace *ftrace_rec_iter_record(struct ftrace_rec_iter *iter)
2809c88fd863SSteven Rostedt {
2810c88fd863SSteven Rostedt 	return &iter->pg->records[iter->index];
2811c88fd863SSteven Rostedt }
2812c88fd863SSteven Rostedt 
28133b47bfc1SSteven Rostedt static int
2814fbf6c73cSMark Rutland ftrace_nop_initialize(struct module *mod, struct dyn_ftrace *rec)
28153c1720f0SSteven Rostedt {
2816492a7ea5SAbhishek Sagar 	int ret;
281737ad5084SSteven Rostedt 
281845a4a237SSteven Rostedt 	if (unlikely(ftrace_disabled))
281945a4a237SSteven Rostedt 		return 0;
282045a4a237SSteven Rostedt 
2821fbf6c73cSMark Rutland 	ret = ftrace_init_nop(mod, rec);
28223d083395SSteven Rostedt 	if (ret) {
282302a392a0SSteven Rostedt (Red Hat) 		ftrace_bug_type = FTRACE_BUG_INIT;
28244fd3279bSSteven Rostedt (Red Hat) 		ftrace_bug(ret, rec);
28253d083395SSteven Rostedt 		return 0;
2826d61f82d0SSteven Rostedt 	}
2827d61f82d0SSteven Rostedt 	return 1;
28283d083395SSteven Rostedt }
28293d083395SSteven Rostedt 
2830000ab691SSteven Rostedt /*
2831000ab691SSteven Rostedt  * archs can override this function if they must do something
2832000ab691SSteven Rostedt  * before the modifying code is performed.
2833000ab691SSteven Rostedt  */
28343a2bfec0SLi kunyu void __weak ftrace_arch_code_modify_prepare(void)
2835000ab691SSteven Rostedt {
2836000ab691SSteven Rostedt }
2837000ab691SSteven Rostedt 
2838000ab691SSteven Rostedt /*
2839000ab691SSteven Rostedt  * archs can override this function if they must do something
2840000ab691SSteven Rostedt  * after the modifying code is performed.
2841000ab691SSteven Rostedt  */
28423a2bfec0SLi kunyu void __weak ftrace_arch_code_modify_post_process(void)
2843000ab691SSteven Rostedt {
2844000ab691SSteven Rostedt }
2845000ab691SSteven Rostedt 
2846bd604f3dSSteven Rostedt (Google) static int update_ftrace_func(ftrace_func_t func)
2847bd604f3dSSteven Rostedt (Google) {
2848bd604f3dSSteven Rostedt (Google) 	static ftrace_func_t save_func;
2849bd604f3dSSteven Rostedt (Google) 
2850bd604f3dSSteven Rostedt (Google) 	/* Avoid updating if it hasn't changed */
2851bd604f3dSSteven Rostedt (Google) 	if (func == save_func)
2852bd604f3dSSteven Rostedt (Google) 		return 0;
2853bd604f3dSSteven Rostedt (Google) 
2854bd604f3dSSteven Rostedt (Google) 	save_func = func;
2855bd604f3dSSteven Rostedt (Google) 
2856bd604f3dSSteven Rostedt (Google) 	return ftrace_update_ftrace_func(func);
2857bd604f3dSSteven Rostedt (Google) }
2858bd604f3dSSteven Rostedt (Google) 
28598ed3e2cfSSteven Rostedt void ftrace_modify_all_code(int command)
28608ed3e2cfSSteven Rostedt {
286159338f75SSteven Rostedt (Red Hat) 	int update = command & FTRACE_UPDATE_TRACE_FUNC;
2862a0572f68SSteven Rostedt (VMware) 	int mod_flags = 0;
2863cd21067fSPetr Mladek 	int err = 0;
286459338f75SSteven Rostedt (Red Hat) 
2865a0572f68SSteven Rostedt (VMware) 	if (command & FTRACE_MAY_SLEEP)
2866a0572f68SSteven Rostedt (VMware) 		mod_flags = FTRACE_MODIFY_MAY_SLEEP_FL;
2867a0572f68SSteven Rostedt (VMware) 
286859338f75SSteven Rostedt (Red Hat) 	/*
286959338f75SSteven Rostedt (Red Hat) 	 * If the ftrace_caller calls a ftrace_ops func directly,
287059338f75SSteven Rostedt (Red Hat) 	 * we need to make sure that it only traces functions it
287159338f75SSteven Rostedt (Red Hat) 	 * expects to trace. When doing the switch of functions,
287259338f75SSteven Rostedt (Red Hat) 	 * we need to update to the ftrace_ops_list_func first
287359338f75SSteven Rostedt (Red Hat) 	 * before the transition between old and new calls are set,
287459338f75SSteven Rostedt (Red Hat) 	 * as the ftrace_ops_list_func will check the ops hashes
287559338f75SSteven Rostedt (Red Hat) 	 * to make sure the ops are having the right functions
287659338f75SSteven Rostedt (Red Hat) 	 * traced.
287759338f75SSteven Rostedt (Red Hat) 	 */
2878cd21067fSPetr Mladek 	if (update) {
2879bd604f3dSSteven Rostedt (Google) 		err = update_ftrace_func(ftrace_ops_list_func);
2880cd21067fSPetr Mladek 		if (FTRACE_WARN_ON(err))
2881cd21067fSPetr Mladek 			return;
2882cd21067fSPetr Mladek 	}
288359338f75SSteven Rostedt (Red Hat) 
28848ed3e2cfSSteven Rostedt 	if (command & FTRACE_UPDATE_CALLS)
2885a0572f68SSteven Rostedt (VMware) 		ftrace_replace_code(mod_flags | FTRACE_MODIFY_ENABLE_FL);
28868ed3e2cfSSteven Rostedt 	else if (command & FTRACE_DISABLE_CALLS)
2887a0572f68SSteven Rostedt (VMware) 		ftrace_replace_code(mod_flags);
28888ed3e2cfSSteven Rostedt 
2889405e1d83SSteven Rostedt (Red Hat) 	if (update && ftrace_trace_function != ftrace_ops_list_func) {
2890405e1d83SSteven Rostedt (Red Hat) 		function_trace_op = set_function_trace_op;
2891405e1d83SSteven Rostedt (Red Hat) 		smp_wmb();
2892405e1d83SSteven Rostedt (Red Hat) 		/* If irqs are disabled, we are in stop machine */
2893405e1d83SSteven Rostedt (Red Hat) 		if (!irqs_disabled())
2894405e1d83SSteven Rostedt (Red Hat) 			smp_call_function(ftrace_sync_ipi, NULL, 1);
2895bd604f3dSSteven Rostedt (Google) 		err = update_ftrace_func(ftrace_trace_function);
2896cd21067fSPetr Mladek 		if (FTRACE_WARN_ON(err))
2897cd21067fSPetr Mladek 			return;
2898405e1d83SSteven Rostedt (Red Hat) 	}
28998ed3e2cfSSteven Rostedt 
29008ed3e2cfSSteven Rostedt 	if (command & FTRACE_START_FUNC_RET)
2901cd21067fSPetr Mladek 		err = ftrace_enable_ftrace_graph_caller();
29028ed3e2cfSSteven Rostedt 	else if (command & FTRACE_STOP_FUNC_RET)
2903cd21067fSPetr Mladek 		err = ftrace_disable_ftrace_graph_caller();
2904cd21067fSPetr Mladek 	FTRACE_WARN_ON(err);
29058ed3e2cfSSteven Rostedt }
29068ed3e2cfSSteven Rostedt 
29073d083395SSteven Rostedt static int __ftrace_modify_code(void *data)
29083d083395SSteven Rostedt {
29093d083395SSteven Rostedt 	int *command = data;
29103d083395SSteven Rostedt 
29118ed3e2cfSSteven Rostedt 	ftrace_modify_all_code(*command);
29125a45cfe1SSteven Rostedt 
2913c88fd863SSteven Rostedt 	return 0;
2914c88fd863SSteven Rostedt }
2915c88fd863SSteven Rostedt 
2916c88fd863SSteven Rostedt /**
29176130722fSSteven Rostedt (VMware)  * ftrace_run_stop_machine - go back to the stop machine method
2918c88fd863SSteven Rostedt  * @command: The command to tell ftrace what to do
2919c88fd863SSteven Rostedt  *
2920c88fd863SSteven Rostedt  * If an arch needs to fall back to the stop machine method, the
2921c88fd863SSteven Rostedt  * it can call this function.
2922c88fd863SSteven Rostedt  */
2923c88fd863SSteven Rostedt void ftrace_run_stop_machine(int command)
2924c88fd863SSteven Rostedt {
2925c88fd863SSteven Rostedt 	stop_machine(__ftrace_modify_code, &command, NULL);
2926c88fd863SSteven Rostedt }
2927c88fd863SSteven Rostedt 
2928c88fd863SSteven Rostedt /**
29296130722fSSteven Rostedt (VMware)  * arch_ftrace_update_code - modify the code to trace or not trace
2930c88fd863SSteven Rostedt  * @command: The command that needs to be done
2931c88fd863SSteven Rostedt  *
2932c88fd863SSteven Rostedt  * Archs can override this function if it does not need to
2933c88fd863SSteven Rostedt  * run stop_machine() to modify code.
2934c88fd863SSteven Rostedt  */
2935c88fd863SSteven Rostedt void __weak arch_ftrace_update_code(int command)
2936c88fd863SSteven Rostedt {
2937c88fd863SSteven Rostedt 	ftrace_run_stop_machine(command);
2938c88fd863SSteven Rostedt }
2939c88fd863SSteven Rostedt 
2940c88fd863SSteven Rostedt static void ftrace_run_update_code(int command)
2941c88fd863SSteven Rostedt {
29423a2bfec0SLi kunyu 	ftrace_arch_code_modify_prepare();
2943c88fd863SSteven Rostedt 
2944c88fd863SSteven Rostedt 	/*
2945c88fd863SSteven Rostedt 	 * By default we use stop_machine() to modify the code.
2946c88fd863SSteven Rostedt 	 * But archs can do what ever they want as long as it
2947c88fd863SSteven Rostedt 	 * is safe. The stop_machine() is the safest, but also
2948c88fd863SSteven Rostedt 	 * produces the most overhead.
2949c88fd863SSteven Rostedt 	 */
2950c88fd863SSteven Rostedt 	arch_ftrace_update_code(command);
2951c88fd863SSteven Rostedt 
29523a2bfec0SLi kunyu 	ftrace_arch_code_modify_post_process();
29533d083395SSteven Rostedt }
29543d083395SSteven Rostedt 
29558252ecf3SSteven Rostedt (Red Hat) static void ftrace_run_modify_code(struct ftrace_ops *ops, int command,
29567485058eSSteven Rostedt (Red Hat) 				   struct ftrace_ops_hash *old_hash)
2957e1effa01SSteven Rostedt (Red Hat) {
2958e1effa01SSteven Rostedt (Red Hat) 	ops->flags |= FTRACE_OPS_FL_MODIFYING;
29597485058eSSteven Rostedt (Red Hat) 	ops->old_hash.filter_hash = old_hash->filter_hash;
29607485058eSSteven Rostedt (Red Hat) 	ops->old_hash.notrace_hash = old_hash->notrace_hash;
2961e1effa01SSteven Rostedt (Red Hat) 	ftrace_run_update_code(command);
29628252ecf3SSteven Rostedt (Red Hat) 	ops->old_hash.filter_hash = NULL;
29637485058eSSteven Rostedt (Red Hat) 	ops->old_hash.notrace_hash = NULL;
2964e1effa01SSteven Rostedt (Red Hat) 	ops->flags &= ~FTRACE_OPS_FL_MODIFYING;
2965e1effa01SSteven Rostedt (Red Hat) }
2966e1effa01SSteven Rostedt (Red Hat) 
29673d083395SSteven Rostedt static ftrace_func_t saved_ftrace_func;
296860a7ecf4SSteven Rostedt static int ftrace_start_up;
2969df4fc315SSteven Rostedt 
297012cce594SSteven Rostedt (Red Hat) void __weak arch_ftrace_trampoline_free(struct ftrace_ops *ops)
297112cce594SSteven Rostedt (Red Hat) {
297212cce594SSteven Rostedt (Red Hat) }
297312cce594SSteven Rostedt (Red Hat) 
2974fc0ea795SAdrian Hunter /* List of trace_ops that have allocated trampolines */
2975fc0ea795SAdrian Hunter static LIST_HEAD(ftrace_ops_trampoline_list);
2976fc0ea795SAdrian Hunter 
2977fc0ea795SAdrian Hunter static void ftrace_add_trampoline_to_kallsyms(struct ftrace_ops *ops)
2978fc0ea795SAdrian Hunter {
2979fc0ea795SAdrian Hunter 	lockdep_assert_held(&ftrace_lock);
2980fc0ea795SAdrian Hunter 	list_add_rcu(&ops->list, &ftrace_ops_trampoline_list);
2981fc0ea795SAdrian Hunter }
2982fc0ea795SAdrian Hunter 
2983fc0ea795SAdrian Hunter static void ftrace_remove_trampoline_from_kallsyms(struct ftrace_ops *ops)
2984fc0ea795SAdrian Hunter {
2985fc0ea795SAdrian Hunter 	lockdep_assert_held(&ftrace_lock);
2986fc0ea795SAdrian Hunter 	list_del_rcu(&ops->list);
2987478ece95SAdrian Hunter 	synchronize_rcu();
2988fc0ea795SAdrian Hunter }
2989fc0ea795SAdrian Hunter 
2990fc0ea795SAdrian Hunter /*
2991fc0ea795SAdrian Hunter  * "__builtin__ftrace" is used as a module name in /proc/kallsyms for symbols
2992fc0ea795SAdrian Hunter  * for pages allocated for ftrace purposes, even though "__builtin__ftrace" is
2993fc0ea795SAdrian Hunter  * not a module.
2994fc0ea795SAdrian Hunter  */
2995fc0ea795SAdrian Hunter #define FTRACE_TRAMPOLINE_MOD "__builtin__ftrace"
2996fc0ea795SAdrian Hunter #define FTRACE_TRAMPOLINE_SYM "ftrace_trampoline"
2997fc0ea795SAdrian Hunter 
2998fc0ea795SAdrian Hunter static void ftrace_trampoline_free(struct ftrace_ops *ops)
2999fc0ea795SAdrian Hunter {
3000fc0ea795SAdrian Hunter 	if (ops && (ops->flags & FTRACE_OPS_FL_ALLOC_TRAMP) &&
3001dd9ddf46SAdrian Hunter 	    ops->trampoline) {
3002548e1f6cSAdrian Hunter 		/*
3003548e1f6cSAdrian Hunter 		 * Record the text poke event before the ksymbol unregister
3004548e1f6cSAdrian Hunter 		 * event.
3005548e1f6cSAdrian Hunter 		 */
3006548e1f6cSAdrian Hunter 		perf_event_text_poke((void *)ops->trampoline,
3007548e1f6cSAdrian Hunter 				     (void *)ops->trampoline,
3008548e1f6cSAdrian Hunter 				     ops->trampoline_size, NULL, 0);
3009dd9ddf46SAdrian Hunter 		perf_event_ksymbol(PERF_RECORD_KSYMBOL_TYPE_OOL,
3010dd9ddf46SAdrian Hunter 				   ops->trampoline, ops->trampoline_size,
3011dd9ddf46SAdrian Hunter 				   true, FTRACE_TRAMPOLINE_SYM);
3012dd9ddf46SAdrian Hunter 		/* Remove from kallsyms after the perf events */
3013fc0ea795SAdrian Hunter 		ftrace_remove_trampoline_from_kallsyms(ops);
3014dd9ddf46SAdrian Hunter 	}
3015fc0ea795SAdrian Hunter 
3016fc0ea795SAdrian Hunter 	arch_ftrace_trampoline_free(ops);
3017fc0ea795SAdrian Hunter }
3018fc0ea795SAdrian Hunter 
3019df4fc315SSteven Rostedt static void ftrace_startup_enable(int command)
3020df4fc315SSteven Rostedt {
3021df4fc315SSteven Rostedt 	if (saved_ftrace_func != ftrace_trace_function) {
3022df4fc315SSteven Rostedt 		saved_ftrace_func = ftrace_trace_function;
3023df4fc315SSteven Rostedt 		command |= FTRACE_UPDATE_TRACE_FUNC;
3024df4fc315SSteven Rostedt 	}
3025df4fc315SSteven Rostedt 
3026df4fc315SSteven Rostedt 	if (!command || !ftrace_enabled)
3027df4fc315SSteven Rostedt 		return;
3028df4fc315SSteven Rostedt 
3029df4fc315SSteven Rostedt 	ftrace_run_update_code(command);
3030df4fc315SSteven Rostedt }
30313d083395SSteven Rostedt 
3032e1effa01SSteven Rostedt (Red Hat) static void ftrace_startup_all(int command)
3033e1effa01SSteven Rostedt (Red Hat) {
3034e1effa01SSteven Rostedt (Red Hat) 	update_all_ops = true;
3035e1effa01SSteven Rostedt (Red Hat) 	ftrace_startup_enable(command);
3036e1effa01SSteven Rostedt (Red Hat) 	update_all_ops = false;
3037e1effa01SSteven Rostedt (Red Hat) }
3038e1effa01SSteven Rostedt (Red Hat) 
30393306fc4aSSteven Rostedt (VMware) int ftrace_startup(struct ftrace_ops *ops, int command)
30403d083395SSteven Rostedt {
30418a56d776SSteven Rostedt (Red Hat) 	int ret;
3042b848914cSSteven Rostedt 
30434eebcc81SSteven Rostedt 	if (unlikely(ftrace_disabled))
3044a1cd6173SSteven Rostedt 		return -ENODEV;
30454eebcc81SSteven Rostedt 
30468a56d776SSteven Rostedt (Red Hat) 	ret = __register_ftrace_function(ops);
30478a56d776SSteven Rostedt (Red Hat) 	if (ret)
30488a56d776SSteven Rostedt (Red Hat) 		return ret;
30498a56d776SSteven Rostedt (Red Hat) 
305060a7ecf4SSteven Rostedt 	ftrace_start_up++;
30513d083395SSteven Rostedt 
3052e1effa01SSteven Rostedt (Red Hat) 	/*
3053e1effa01SSteven Rostedt (Red Hat) 	 * Note that ftrace probes uses this to start up
3054e1effa01SSteven Rostedt (Red Hat) 	 * and modify functions it will probe. But we still
3055e1effa01SSteven Rostedt (Red Hat) 	 * set the ADDING flag for modification, as probes
3056e1effa01SSteven Rostedt (Red Hat) 	 * do not have trampolines. If they add them in the
3057e1effa01SSteven Rostedt (Red Hat) 	 * future, then the probes will need to distinguish
3058e1effa01SSteven Rostedt (Red Hat) 	 * between adding and updating probes.
3059e1effa01SSteven Rostedt (Red Hat) 	 */
3060e1effa01SSteven Rostedt (Red Hat) 	ops->flags |= FTRACE_OPS_FL_ENABLED | FTRACE_OPS_FL_ADDING;
306166209a5bSSteven Rostedt (Red Hat) 
3062f8b8be8aSMasami Hiramatsu 	ret = ftrace_hash_ipmodify_enable(ops);
3063f8b8be8aSMasami Hiramatsu 	if (ret < 0) {
3064f8b8be8aSMasami Hiramatsu 		/* Rollback registration process */
3065f8b8be8aSMasami Hiramatsu 		__unregister_ftrace_function(ops);
3066f8b8be8aSMasami Hiramatsu 		ftrace_start_up--;
3067f8b8be8aSMasami Hiramatsu 		ops->flags &= ~FTRACE_OPS_FL_ENABLED;
3068d5e47505SMiroslav Benes 		if (ops->flags & FTRACE_OPS_FL_DYNAMIC)
3069d5e47505SMiroslav Benes 			ftrace_trampoline_free(ops);
3070f8b8be8aSMasami Hiramatsu 		return ret;
3071f8b8be8aSMasami Hiramatsu 	}
3072f8b8be8aSMasami Hiramatsu 
30737f50d06bSJiri Olsa 	if (ftrace_hash_rec_enable(ops, 1))
30747f50d06bSJiri Olsa 		command |= FTRACE_UPDATE_CALLS;
3075ed926f9bSSteven Rostedt 
3076df4fc315SSteven Rostedt 	ftrace_startup_enable(command);
3077a1cd6173SSteven Rostedt 
3078c3b0f72eSYang Jihong 	/*
3079c3b0f72eSYang Jihong 	 * If ftrace is in an undefined state, we just remove ops from list
3080c3b0f72eSYang Jihong 	 * to prevent the NULL pointer, instead of totally rolling it back and
3081c3b0f72eSYang Jihong 	 * free trampoline, because those actions could cause further damage.
3082c3b0f72eSYang Jihong 	 */
3083c3b0f72eSYang Jihong 	if (unlikely(ftrace_disabled)) {
3084c3b0f72eSYang Jihong 		__unregister_ftrace_function(ops);
3085c3b0f72eSYang Jihong 		return -ENODEV;
3086c3b0f72eSYang Jihong 	}
3087c3b0f72eSYang Jihong 
3088e1effa01SSteven Rostedt (Red Hat) 	ops->flags &= ~FTRACE_OPS_FL_ADDING;
3089e1effa01SSteven Rostedt (Red Hat) 
3090a1cd6173SSteven Rostedt 	return 0;
30913d083395SSteven Rostedt }
30923d083395SSteven Rostedt 
30933306fc4aSSteven Rostedt (VMware) int ftrace_shutdown(struct ftrace_ops *ops, int command)
30943d083395SSteven Rostedt {
30958a56d776SSteven Rostedt (Red Hat) 	int ret;
3096b848914cSSteven Rostedt 
30974eebcc81SSteven Rostedt 	if (unlikely(ftrace_disabled))
30988a56d776SSteven Rostedt (Red Hat) 		return -ENODEV;
30998a56d776SSteven Rostedt (Red Hat) 
31008a56d776SSteven Rostedt (Red Hat) 	ret = __unregister_ftrace_function(ops);
31018a56d776SSteven Rostedt (Red Hat) 	if (ret)
31028a56d776SSteven Rostedt (Red Hat) 		return ret;
31034eebcc81SSteven Rostedt 
310460a7ecf4SSteven Rostedt 	ftrace_start_up--;
31059ea1a153SFrederic Weisbecker 	/*
31069ea1a153SFrederic Weisbecker 	 * Just warn in case of unbalance, no need to kill ftrace, it's not
31079ea1a153SFrederic Weisbecker 	 * critical but the ftrace_call callers may be never nopped again after
31089ea1a153SFrederic Weisbecker 	 * further ftrace uses.
31099ea1a153SFrederic Weisbecker 	 */
31109ea1a153SFrederic Weisbecker 	WARN_ON_ONCE(ftrace_start_up < 0);
31119ea1a153SFrederic Weisbecker 
3112f8b8be8aSMasami Hiramatsu 	/* Disabling ipmodify never fails */
3113f8b8be8aSMasami Hiramatsu 	ftrace_hash_ipmodify_disable(ops);
31147f50d06bSJiri Olsa 
31157f50d06bSJiri Olsa 	if (ftrace_hash_rec_disable(ops, 1))
31167f50d06bSJiri Olsa 		command |= FTRACE_UPDATE_CALLS;
3117ed926f9bSSteven Rostedt 
3118ed926f9bSSteven Rostedt 	ops->flags &= ~FTRACE_OPS_FL_ENABLED;
3119b848914cSSteven Rostedt 
3120d61f82d0SSteven Rostedt 	if (saved_ftrace_func != ftrace_trace_function) {
3121d61f82d0SSteven Rostedt 		saved_ftrace_func = ftrace_trace_function;
3122d61f82d0SSteven Rostedt 		command |= FTRACE_UPDATE_TRACE_FUNC;
3123d61f82d0SSteven Rostedt 	}
3124d61f82d0SSteven Rostedt 
31250e792b89SLi Huafei 	if (!command || !ftrace_enabled)
31260e792b89SLi Huafei 		goto out;
31273d083395SSteven Rostedt 
312879922b80SSteven Rostedt (Red Hat) 	/*
312979922b80SSteven Rostedt (Red Hat) 	 * If the ops uses a trampoline, then it needs to be
313079922b80SSteven Rostedt (Red Hat) 	 * tested first on update.
313179922b80SSteven Rostedt (Red Hat) 	 */
3132e1effa01SSteven Rostedt (Red Hat) 	ops->flags |= FTRACE_OPS_FL_REMOVING;
313379922b80SSteven Rostedt (Red Hat) 	removed_ops = ops;
313479922b80SSteven Rostedt (Red Hat) 
3135fef5aeeeSSteven Rostedt (Red Hat) 	/* The trampoline logic checks the old hashes */
3136fef5aeeeSSteven Rostedt (Red Hat) 	ops->old_hash.filter_hash = ops->func_hash->filter_hash;
3137fef5aeeeSSteven Rostedt (Red Hat) 	ops->old_hash.notrace_hash = ops->func_hash->notrace_hash;
3138fef5aeeeSSteven Rostedt (Red Hat) 
3139d61f82d0SSteven Rostedt 	ftrace_run_update_code(command);
3140a4c35ed2SSteven Rostedt (Red Hat) 
314184bde62cSSteven Rostedt (Red Hat) 	/*
314284bde62cSSteven Rostedt (Red Hat) 	 * If there's no more ops registered with ftrace, run a
314384bde62cSSteven Rostedt (Red Hat) 	 * sanity check to make sure all rec flags are cleared.
314484bde62cSSteven Rostedt (Red Hat) 	 */
3145f86f4180SChunyan Zhang 	if (rcu_dereference_protected(ftrace_ops_list,
3146f86f4180SChunyan Zhang 			lockdep_is_held(&ftrace_lock)) == &ftrace_list_end) {
314784bde62cSSteven Rostedt (Red Hat) 		struct ftrace_page *pg;
314884bde62cSSteven Rostedt (Red Hat) 		struct dyn_ftrace *rec;
314984bde62cSSteven Rostedt (Red Hat) 
315084bde62cSSteven Rostedt (Red Hat) 		do_for_each_ftrace_rec(pg, rec) {
3151977c1f9cSAlexei Starovoitov 			if (FTRACE_WARN_ON_ONCE(rec->flags & ~FTRACE_FL_DISABLED))
315284bde62cSSteven Rostedt (Red Hat) 				pr_warn("  %pS flags:%lx\n",
315384bde62cSSteven Rostedt (Red Hat) 					(void *)rec->ip, rec->flags);
315484bde62cSSteven Rostedt (Red Hat) 		} while_for_each_ftrace_rec();
315584bde62cSSteven Rostedt (Red Hat) 	}
315684bde62cSSteven Rostedt (Red Hat) 
3157fef5aeeeSSteven Rostedt (Red Hat) 	ops->old_hash.filter_hash = NULL;
3158fef5aeeeSSteven Rostedt (Red Hat) 	ops->old_hash.notrace_hash = NULL;
3159fef5aeeeSSteven Rostedt (Red Hat) 
3160fef5aeeeSSteven Rostedt (Red Hat) 	removed_ops = NULL;
3161e1effa01SSteven Rostedt (Red Hat) 	ops->flags &= ~FTRACE_OPS_FL_REMOVING;
316279922b80SSteven Rostedt (Red Hat) 
31630e792b89SLi Huafei out:
3164a4c35ed2SSteven Rostedt (Red Hat) 	/*
3165a4c35ed2SSteven Rostedt (Red Hat) 	 * Dynamic ops may be freed, we must make sure that all
3166a4c35ed2SSteven Rostedt (Red Hat) 	 * callers are done before leaving this function.
31670598e4f0SSteven Rostedt (VMware) 	 */
3168b3a88803SPeter Zijlstra 	if (ops->flags & FTRACE_OPS_FL_DYNAMIC) {
31690598e4f0SSteven Rostedt (VMware) 		/*
3170a4c35ed2SSteven Rostedt (Red Hat) 		 * We need to do a hard force of sched synchronization.
3171a4c35ed2SSteven Rostedt (Red Hat) 		 * This is because we use preempt_disable() to do RCU, but
3172a4c35ed2SSteven Rostedt (Red Hat) 		 * the function tracers can be called where RCU is not watching
3173a4c35ed2SSteven Rostedt (Red Hat) 		 * (like before user_exit()). We can not rely on the RCU
3174a4c35ed2SSteven Rostedt (Red Hat) 		 * infrastructure to do the synchronization, thus we must do it
3175a4c35ed2SSteven Rostedt (Red Hat) 		 * ourselves.
3176a4c35ed2SSteven Rostedt (Red Hat) 		 */
3177e5a971d7SPaul E. McKenney 		synchronize_rcu_tasks_rude();
3178a4c35ed2SSteven Rostedt (Red Hat) 
31790598e4f0SSteven Rostedt (VMware) 		/*
3180fdda88d3SQiujun Huang 		 * When the kernel is preemptive, tasks can be preempted
31810598e4f0SSteven Rostedt (VMware) 		 * while on a ftrace trampoline. Just scheduling a task on
31820598e4f0SSteven Rostedt (VMware) 		 * a CPU is not good enough to flush them. Calling
3183f2cc020dSIngo Molnar 		 * synchronize_rcu_tasks() will wait for those tasks to
31840598e4f0SSteven Rostedt (VMware) 		 * execute and either schedule voluntarily or enter user space.
31850598e4f0SSteven Rostedt (VMware) 		 */
318630c93704SThomas Gleixner 		if (IS_ENABLED(CONFIG_PREEMPTION))
31870598e4f0SSteven Rostedt (VMware) 			synchronize_rcu_tasks();
31880598e4f0SSteven Rostedt (VMware) 
3189fc0ea795SAdrian Hunter 		ftrace_trampoline_free(ops);
3190a4c35ed2SSteven Rostedt (Red Hat) 	}
3191a4c35ed2SSteven Rostedt (Red Hat) 
31928a56d776SSteven Rostedt (Red Hat) 	return 0;
31933d083395SSteven Rostedt }
31943d083395SSteven Rostedt 
3195a5a1d1c2SThomas Gleixner static u64		ftrace_update_time;
31963d083395SSteven Rostedt unsigned long		ftrace_update_tot_cnt;
3197da537f0aSSteven Rostedt (VMware) unsigned long		ftrace_number_of_pages;
3198da537f0aSSteven Rostedt (VMware) unsigned long		ftrace_number_of_groups;
31993d083395SSteven Rostedt 
32008c4f3c3fSSteven Rostedt (Red Hat) static inline int ops_traces_mod(struct ftrace_ops *ops)
3201f7bc8b61SSteven Rostedt {
32028c4f3c3fSSteven Rostedt (Red Hat) 	/*
32038c4f3c3fSSteven Rostedt (Red Hat) 	 * Filter_hash being empty will default to trace module.
32048c4f3c3fSSteven Rostedt (Red Hat) 	 * But notrace hash requires a test of individual module functions.
32058c4f3c3fSSteven Rostedt (Red Hat) 	 */
320633b7f99cSSteven Rostedt (Red Hat) 	return ftrace_hash_empty(ops->func_hash->filter_hash) &&
320733b7f99cSSteven Rostedt (Red Hat) 		ftrace_hash_empty(ops->func_hash->notrace_hash);
32088c4f3c3fSSteven Rostedt (Red Hat) }
3209f7bc8b61SSteven Rostedt 
32101dc43cf0SJiri Slaby static int ftrace_update_code(struct module *mod, struct ftrace_page *new_pgs)
32113d083395SSteven Rostedt {
321267ccddf8SIlya Leoshkevich 	bool init_nop = ftrace_need_init_nop();
321385ae32aeSSteven Rostedt 	struct ftrace_page *pg;
3214e94142a6SLai Jiangshan 	struct dyn_ftrace *p;
3215a5a1d1c2SThomas Gleixner 	u64 start, stop;
32161dc43cf0SJiri Slaby 	unsigned long update_cnt = 0;
3217b7ffffbbSSteven Rostedt (Red Hat) 	unsigned long rec_flags = 0;
321885ae32aeSSteven Rostedt 	int i;
3219f7bc8b61SSteven Rostedt 
3220750ed1a4SIngo Molnar 	start = ftrace_now(raw_smp_processor_id());
32213d083395SSteven Rostedt 
3222b7ffffbbSSteven Rostedt (Red Hat) 	/*
3223b7ffffbbSSteven Rostedt (Red Hat) 	 * When a module is loaded, this function is called to convert
3224b7ffffbbSSteven Rostedt (Red Hat) 	 * the calls to mcount in its text to nops, and also to create
3225b7ffffbbSSteven Rostedt (Red Hat) 	 * an entry in the ftrace data. Now, if ftrace is activated
3226b7ffffbbSSteven Rostedt (Red Hat) 	 * after this call, but before the module sets its text to
3227b7ffffbbSSteven Rostedt (Red Hat) 	 * read-only, the modification of enabling ftrace can fail if
3228b7ffffbbSSteven Rostedt (Red Hat) 	 * the read-only is done while ftrace is converting the calls.
3229b7ffffbbSSteven Rostedt (Red Hat) 	 * To prevent this, the module's records are set as disabled
3230b7ffffbbSSteven Rostedt (Red Hat) 	 * and will be enabled after the call to set the module's text
3231b7ffffbbSSteven Rostedt (Red Hat) 	 * to read-only.
3232b7ffffbbSSteven Rostedt (Red Hat) 	 */
3233b7ffffbbSSteven Rostedt (Red Hat) 	if (mod)
3234b7ffffbbSSteven Rostedt (Red Hat) 		rec_flags |= FTRACE_FL_DISABLED;
3235b7ffffbbSSteven Rostedt (Red Hat) 
32361dc43cf0SJiri Slaby 	for (pg = new_pgs; pg; pg = pg->next) {
3237f22f9a89SAbhishek Sagar 
323885ae32aeSSteven Rostedt 		for (i = 0; i < pg->index; i++) {
32398c4f3c3fSSteven Rostedt (Red Hat) 
324008f5ac90SSteven Rostedt 			/* If something went wrong, bail without enabling anything */
324108f5ac90SSteven Rostedt 			if (unlikely(ftrace_disabled))
324208f5ac90SSteven Rostedt 				return -1;
32433d083395SSteven Rostedt 
324485ae32aeSSteven Rostedt 			p = &pg->records[i];
3245b7ffffbbSSteven Rostedt (Red Hat) 			p->flags = rec_flags;
3246f22f9a89SAbhishek Sagar 
32475cb084bbSJiri Olsa 			/*
324825985edcSLucas De Marchi 			 * Do the initial record conversion from mcount jump
32495cb084bbSJiri Olsa 			 * to the NOP instructions.
32505cb084bbSJiri Olsa 			 */
325167ccddf8SIlya Leoshkevich 			if (init_nop && !ftrace_nop_initialize(mod, p))
3252d2c8c3eaSSteven Rostedt 				break;
32535cb084bbSJiri Olsa 
32541dc43cf0SJiri Slaby 			update_cnt++;
32555cb084bbSJiri Olsa 		}
325685ae32aeSSteven Rostedt 	}
325785ae32aeSSteven Rostedt 
3258750ed1a4SIngo Molnar 	stop = ftrace_now(raw_smp_processor_id());
32593d083395SSteven Rostedt 	ftrace_update_time = stop - start;
32601dc43cf0SJiri Slaby 	ftrace_update_tot_cnt += update_cnt;
32613d083395SSteven Rostedt 
326216444a8aSArnaldo Carvalho de Melo 	return 0;
326316444a8aSArnaldo Carvalho de Melo }
326416444a8aSArnaldo Carvalho de Melo 
3265a7900875SSteven Rostedt static int ftrace_allocate_records(struct ftrace_page *pg, int count)
32663c1720f0SSteven Rostedt {
3267a7900875SSteven Rostedt 	int order;
32687ba031e8SSteven Rostedt (VMware) 	int pages;
32693c1720f0SSteven Rostedt 	int cnt;
32703c1720f0SSteven Rostedt 
3271a7900875SSteven Rostedt 	if (WARN_ON(!count))
3272a7900875SSteven Rostedt 		return -EINVAL;
3273a7900875SSteven Rostedt 
3274ceaaa129SSteven Rostedt (VMware) 	/* We want to fill as much as possible, with no empty pages */
3275b40c6eabSWei Yang 	pages = DIV_ROUND_UP(count, ENTRIES_PER_PAGE);
3276ceaaa129SSteven Rostedt (VMware) 	order = fls(pages) - 1;
32773c1720f0SSteven Rostedt 
3278a7900875SSteven Rostedt  again:
3279a7900875SSteven Rostedt 	pg->records = (void *)__get_free_pages(GFP_KERNEL | __GFP_ZERO, order);
3280a7900875SSteven Rostedt 
3281a7900875SSteven Rostedt 	if (!pg->records) {
3282a7900875SSteven Rostedt 		/* if we can't allocate this size, try something smaller */
3283a7900875SSteven Rostedt 		if (!order)
3284a7900875SSteven Rostedt 			return -ENOMEM;
3285bcea02b0SWang Wensheng 		order--;
3286a7900875SSteven Rostedt 		goto again;
3287a7900875SSteven Rostedt 	}
3288a7900875SSteven Rostedt 
3289da537f0aSSteven Rostedt (VMware) 	ftrace_number_of_pages += 1 << order;
3290da537f0aSSteven Rostedt (VMware) 	ftrace_number_of_groups++;
3291da537f0aSSteven Rostedt (VMware) 
3292a7900875SSteven Rostedt 	cnt = (PAGE_SIZE << order) / ENTRY_SIZE;
3293db42523bSLinus Torvalds 	pg->order = order;
3294a7900875SSteven Rostedt 
3295a7900875SSteven Rostedt 	if (cnt > count)
3296a7900875SSteven Rostedt 		cnt = count;
3297a7900875SSteven Rostedt 
3298a7900875SSteven Rostedt 	return cnt;
3299a7900875SSteven Rostedt }
3300a7900875SSteven Rostedt 
3301a7900875SSteven Rostedt static struct ftrace_page *
3302a7900875SSteven Rostedt ftrace_allocate_pages(unsigned long num_to_init)
3303a7900875SSteven Rostedt {
3304a7900875SSteven Rostedt 	struct ftrace_page *start_pg;
3305a7900875SSteven Rostedt 	struct ftrace_page *pg;
3306a7900875SSteven Rostedt 	int cnt;
3307a7900875SSteven Rostedt 
3308a7900875SSteven Rostedt 	if (!num_to_init)
33099efb85c5SHariprasad Kelam 		return NULL;
3310a7900875SSteven Rostedt 
3311a7900875SSteven Rostedt 	start_pg = pg = kzalloc(sizeof(*pg), GFP_KERNEL);
3312a7900875SSteven Rostedt 	if (!pg)
3313a7900875SSteven Rostedt 		return NULL;
3314a7900875SSteven Rostedt 
3315a7900875SSteven Rostedt 	/*
3316a7900875SSteven Rostedt 	 * Try to allocate as much as possible in one continues
3317a7900875SSteven Rostedt 	 * location that fills in all of the space. We want to
3318a7900875SSteven Rostedt 	 * waste as little space as possible.
3319a7900875SSteven Rostedt 	 */
3320a7900875SSteven Rostedt 	for (;;) {
3321a7900875SSteven Rostedt 		cnt = ftrace_allocate_records(pg, num_to_init);
3322a7900875SSteven Rostedt 		if (cnt < 0)
3323a7900875SSteven Rostedt 			goto free_pages;
3324a7900875SSteven Rostedt 
3325a7900875SSteven Rostedt 		num_to_init -= cnt;
3326a7900875SSteven Rostedt 		if (!num_to_init)
3327a7900875SSteven Rostedt 			break;
3328a7900875SSteven Rostedt 
3329a7900875SSteven Rostedt 		pg->next = kzalloc(sizeof(*pg), GFP_KERNEL);
3330a7900875SSteven Rostedt 		if (!pg->next)
3331a7900875SSteven Rostedt 			goto free_pages;
3332a7900875SSteven Rostedt 
3333a7900875SSteven Rostedt 		pg = pg->next;
3334a7900875SSteven Rostedt 	}
3335a7900875SSteven Rostedt 
3336a7900875SSteven Rostedt 	return start_pg;
3337a7900875SSteven Rostedt 
3338a7900875SSteven Rostedt  free_pages:
33391f61be00SNamhyung Kim 	pg = start_pg;
33401f61be00SNamhyung Kim 	while (pg) {
3341db42523bSLinus Torvalds 		if (pg->records) {
3342db42523bSLinus Torvalds 			free_pages((unsigned long)pg->records, pg->order);
3343db42523bSLinus Torvalds 			ftrace_number_of_pages -= 1 << pg->order;
3344db42523bSLinus Torvalds 		}
3345a7900875SSteven Rostedt 		start_pg = pg->next;
3346a7900875SSteven Rostedt 		kfree(pg);
3347a7900875SSteven Rostedt 		pg = start_pg;
3348da537f0aSSteven Rostedt (VMware) 		ftrace_number_of_groups--;
3349a7900875SSteven Rostedt 	}
3350a7900875SSteven Rostedt 	pr_info("ftrace: FAILED to allocate memory for functions\n");
3351a7900875SSteven Rostedt 	return NULL;
3352a7900875SSteven Rostedt }
3353a7900875SSteven Rostedt 
33545072c59fSSteven Rostedt #define FTRACE_BUFF_MAX (KSYM_SYMBOL_LEN+4) /* room for wildcards */
33555072c59fSSteven Rostedt 
33565072c59fSSteven Rostedt struct ftrace_iterator {
335798c4fd04SSteven Rostedt 	loff_t				pos;
33582bccfffdSSteven Rostedt 	loff_t				func_pos;
33595985ea8bSSteven Rostedt (VMware) 	loff_t				mod_pos;
33605072c59fSSteven Rostedt 	struct ftrace_page		*pg;
33614aeb6967SSteven Rostedt 	struct dyn_ftrace		*func;
33624aeb6967SSteven Rostedt 	struct ftrace_func_probe	*probe;
3363eee8ded1SSteven Rostedt (VMware) 	struct ftrace_func_entry	*probe_entry;
33644aeb6967SSteven Rostedt 	struct trace_parser		parser;
33651cf41dd7SSteven Rostedt 	struct ftrace_hash		*hash;
336633dc9b12SSteven Rostedt 	struct ftrace_ops		*ops;
33675985ea8bSSteven Rostedt (VMware) 	struct trace_array		*tr;
33685985ea8bSSteven Rostedt (VMware) 	struct list_head		*mod_list;
3369eee8ded1SSteven Rostedt (VMware) 	int				pidx;
3370431aa3fbSSteven Rostedt 	int				idx;
33715072c59fSSteven Rostedt 	unsigned			flags;
33725072c59fSSteven Rostedt };
33735072c59fSSteven Rostedt 
3374e309b41dSIngo Molnar static void *
3375eee8ded1SSteven Rostedt (VMware) t_probe_next(struct seq_file *m, loff_t *pos)
33768fc0c701SSteven Rostedt {
33778fc0c701SSteven Rostedt 	struct ftrace_iterator *iter = m->private;
3378d2afd57aSSteven Rostedt (VMware) 	struct trace_array *tr = iter->ops->private;
337904ec7bb6SSteven Rostedt (VMware) 	struct list_head *func_probes;
3380eee8ded1SSteven Rostedt (VMware) 	struct ftrace_hash *hash;
3381eee8ded1SSteven Rostedt (VMware) 	struct list_head *next;
33824aeb6967SSteven Rostedt 	struct hlist_node *hnd = NULL;
33838fc0c701SSteven Rostedt 	struct hlist_head *hhd;
3384eee8ded1SSteven Rostedt (VMware) 	int size;
33858fc0c701SSteven Rostedt 
33868fc0c701SSteven Rostedt 	(*pos)++;
338798c4fd04SSteven Rostedt 	iter->pos = *pos;
33888fc0c701SSteven Rostedt 
338904ec7bb6SSteven Rostedt (VMware) 	if (!tr)
33908fc0c701SSteven Rostedt 		return NULL;
33918fc0c701SSteven Rostedt 
339204ec7bb6SSteven Rostedt (VMware) 	func_probes = &tr->func_probes;
339304ec7bb6SSteven Rostedt (VMware) 	if (list_empty(func_probes))
33948fc0c701SSteven Rostedt 		return NULL;
33958fc0c701SSteven Rostedt 
3396eee8ded1SSteven Rostedt (VMware) 	if (!iter->probe) {
339704ec7bb6SSteven Rostedt (VMware) 		next = func_probes->next;
33987b60f3d8SSteven Rostedt (VMware) 		iter->probe = list_entry(next, struct ftrace_func_probe, list);
3399eee8ded1SSteven Rostedt (VMware) 	}
3400eee8ded1SSteven Rostedt (VMware) 
3401eee8ded1SSteven Rostedt (VMware) 	if (iter->probe_entry)
3402eee8ded1SSteven Rostedt (VMware) 		hnd = &iter->probe_entry->hlist;
3403eee8ded1SSteven Rostedt (VMware) 
3404eee8ded1SSteven Rostedt (VMware) 	hash = iter->probe->ops.func_hash->filter_hash;
34057bd46644SNaveen N. Rao 
3406372e0d01SSteven Rostedt (VMware) 	/*
3407372e0d01SSteven Rostedt (VMware) 	 * A probe being registered may temporarily have an empty hash
3408372e0d01SSteven Rostedt (VMware) 	 * and it's at the end of the func_probes list.
3409372e0d01SSteven Rostedt (VMware) 	 */
3410372e0d01SSteven Rostedt (VMware) 	if (!hash || hash == EMPTY_HASH)
34117bd46644SNaveen N. Rao 		return NULL;
34127bd46644SNaveen N. Rao 
3413eee8ded1SSteven Rostedt (VMware) 	size = 1 << hash->size_bits;
3414eee8ded1SSteven Rostedt (VMware) 
3415eee8ded1SSteven Rostedt (VMware)  retry:
3416eee8ded1SSteven Rostedt (VMware) 	if (iter->pidx >= size) {
341704ec7bb6SSteven Rostedt (VMware) 		if (iter->probe->list.next == func_probes)
3418eee8ded1SSteven Rostedt (VMware) 			return NULL;
3419eee8ded1SSteven Rostedt (VMware) 		next = iter->probe->list.next;
34207b60f3d8SSteven Rostedt (VMware) 		iter->probe = list_entry(next, struct ftrace_func_probe, list);
3421eee8ded1SSteven Rostedt (VMware) 		hash = iter->probe->ops.func_hash->filter_hash;
3422eee8ded1SSteven Rostedt (VMware) 		size = 1 << hash->size_bits;
3423eee8ded1SSteven Rostedt (VMware) 		iter->pidx = 0;
3424eee8ded1SSteven Rostedt (VMware) 	}
3425eee8ded1SSteven Rostedt (VMware) 
3426eee8ded1SSteven Rostedt (VMware) 	hhd = &hash->buckets[iter->pidx];
34278fc0c701SSteven Rostedt 
34288fc0c701SSteven Rostedt 	if (hlist_empty(hhd)) {
3429eee8ded1SSteven Rostedt (VMware) 		iter->pidx++;
34308fc0c701SSteven Rostedt 		hnd = NULL;
34318fc0c701SSteven Rostedt 		goto retry;
34328fc0c701SSteven Rostedt 	}
34338fc0c701SSteven Rostedt 
34348fc0c701SSteven Rostedt 	if (!hnd)
34358fc0c701SSteven Rostedt 		hnd = hhd->first;
34368fc0c701SSteven Rostedt 	else {
34378fc0c701SSteven Rostedt 		hnd = hnd->next;
34388fc0c701SSteven Rostedt 		if (!hnd) {
3439eee8ded1SSteven Rostedt (VMware) 			iter->pidx++;
34408fc0c701SSteven Rostedt 			goto retry;
34418fc0c701SSteven Rostedt 		}
34428fc0c701SSteven Rostedt 	}
34438fc0c701SSteven Rostedt 
34444aeb6967SSteven Rostedt 	if (WARN_ON_ONCE(!hnd))
34454aeb6967SSteven Rostedt 		return NULL;
34464aeb6967SSteven Rostedt 
3447eee8ded1SSteven Rostedt (VMware) 	iter->probe_entry = hlist_entry(hnd, struct ftrace_func_entry, hlist);
34484aeb6967SSteven Rostedt 
34494aeb6967SSteven Rostedt 	return iter;
34508fc0c701SSteven Rostedt }
34518fc0c701SSteven Rostedt 
3452eee8ded1SSteven Rostedt (VMware) static void *t_probe_start(struct seq_file *m, loff_t *pos)
34538fc0c701SSteven Rostedt {
34548fc0c701SSteven Rostedt 	struct ftrace_iterator *iter = m->private;
34558fc0c701SSteven Rostedt 	void *p = NULL;
3456d82d6244SLi Zefan 	loff_t l;
3457d82d6244SLi Zefan 
3458eee8ded1SSteven Rostedt (VMware) 	if (!(iter->flags & FTRACE_ITER_DO_PROBES))
345969a3083cSSteven Rostedt 		return NULL;
346069a3083cSSteven Rostedt 
34615985ea8bSSteven Rostedt (VMware) 	if (iter->mod_pos > *pos)
34622bccfffdSSteven Rostedt 		return NULL;
34638fc0c701SSteven Rostedt 
3464eee8ded1SSteven Rostedt (VMware) 	iter->probe = NULL;
3465eee8ded1SSteven Rostedt (VMware) 	iter->probe_entry = NULL;
3466eee8ded1SSteven Rostedt (VMware) 	iter->pidx = 0;
34675985ea8bSSteven Rostedt (VMware) 	for (l = 0; l <= (*pos - iter->mod_pos); ) {
3468eee8ded1SSteven Rostedt (VMware) 		p = t_probe_next(m, &l);
3469d82d6244SLi Zefan 		if (!p)
3470d82d6244SLi Zefan 			break;
3471d82d6244SLi Zefan 	}
34724aeb6967SSteven Rostedt 	if (!p)
34734aeb6967SSteven Rostedt 		return NULL;
34744aeb6967SSteven Rostedt 
347598c4fd04SSteven Rostedt 	/* Only set this if we have an item */
3476eee8ded1SSteven Rostedt (VMware) 	iter->flags |= FTRACE_ITER_PROBE;
347798c4fd04SSteven Rostedt 
34784aeb6967SSteven Rostedt 	return iter;
34798fc0c701SSteven Rostedt }
34808fc0c701SSteven Rostedt 
34814aeb6967SSteven Rostedt static int
3482eee8ded1SSteven Rostedt (VMware) t_probe_show(struct seq_file *m, struct ftrace_iterator *iter)
34838fc0c701SSteven Rostedt {
3484eee8ded1SSteven Rostedt (VMware) 	struct ftrace_func_entry *probe_entry;
34857b60f3d8SSteven Rostedt (VMware) 	struct ftrace_probe_ops *probe_ops;
34867b60f3d8SSteven Rostedt (VMware) 	struct ftrace_func_probe *probe;
34878fc0c701SSteven Rostedt 
3488eee8ded1SSteven Rostedt (VMware) 	probe = iter->probe;
3489eee8ded1SSteven Rostedt (VMware) 	probe_entry = iter->probe_entry;
3490eee8ded1SSteven Rostedt (VMware) 
3491eee8ded1SSteven Rostedt (VMware) 	if (WARN_ON_ONCE(!probe || !probe_entry))
34924aeb6967SSteven Rostedt 		return -EIO;
34938fc0c701SSteven Rostedt 
34947b60f3d8SSteven Rostedt (VMware) 	probe_ops = probe->probe_ops;
3495809dcf29SSteven Rostedt 
34967b60f3d8SSteven Rostedt (VMware) 	if (probe_ops->print)
34976e444319SSteven Rostedt (VMware) 		return probe_ops->print(m, probe_entry->ip, probe_ops, probe->data);
34988fc0c701SSteven Rostedt 
34997b60f3d8SSteven Rostedt (VMware) 	seq_printf(m, "%ps:%ps\n", (void *)probe_entry->ip,
35007b60f3d8SSteven Rostedt (VMware) 		   (void *)probe_ops->func);
35018fc0c701SSteven Rostedt 
35028fc0c701SSteven Rostedt 	return 0;
35038fc0c701SSteven Rostedt }
35048fc0c701SSteven Rostedt 
35058fc0c701SSteven Rostedt static void *
35065985ea8bSSteven Rostedt (VMware) t_mod_next(struct seq_file *m, loff_t *pos)
35075985ea8bSSteven Rostedt (VMware) {
35085985ea8bSSteven Rostedt (VMware) 	struct ftrace_iterator *iter = m->private;
35095985ea8bSSteven Rostedt (VMware) 	struct trace_array *tr = iter->tr;
35105985ea8bSSteven Rostedt (VMware) 
35115985ea8bSSteven Rostedt (VMware) 	(*pos)++;
35125985ea8bSSteven Rostedt (VMware) 	iter->pos = *pos;
35135985ea8bSSteven Rostedt (VMware) 
35145985ea8bSSteven Rostedt (VMware) 	iter->mod_list = iter->mod_list->next;
35155985ea8bSSteven Rostedt (VMware) 
35165985ea8bSSteven Rostedt (VMware) 	if (iter->mod_list == &tr->mod_trace ||
35175985ea8bSSteven Rostedt (VMware) 	    iter->mod_list == &tr->mod_notrace) {
35185985ea8bSSteven Rostedt (VMware) 		iter->flags &= ~FTRACE_ITER_MOD;
35195985ea8bSSteven Rostedt (VMware) 		return NULL;
35205985ea8bSSteven Rostedt (VMware) 	}
35215985ea8bSSteven Rostedt (VMware) 
35225985ea8bSSteven Rostedt (VMware) 	iter->mod_pos = *pos;
35235985ea8bSSteven Rostedt (VMware) 
35245985ea8bSSteven Rostedt (VMware) 	return iter;
35255985ea8bSSteven Rostedt (VMware) }
35265985ea8bSSteven Rostedt (VMware) 
35275985ea8bSSteven Rostedt (VMware) static void *t_mod_start(struct seq_file *m, loff_t *pos)
35285985ea8bSSteven Rostedt (VMware) {
35295985ea8bSSteven Rostedt (VMware) 	struct ftrace_iterator *iter = m->private;
35305985ea8bSSteven Rostedt (VMware) 	void *p = NULL;
35315985ea8bSSteven Rostedt (VMware) 	loff_t l;
35325985ea8bSSteven Rostedt (VMware) 
35335985ea8bSSteven Rostedt (VMware) 	if (iter->func_pos > *pos)
35345985ea8bSSteven Rostedt (VMware) 		return NULL;
35355985ea8bSSteven Rostedt (VMware) 
35365985ea8bSSteven Rostedt (VMware) 	iter->mod_pos = iter->func_pos;
35375985ea8bSSteven Rostedt (VMware) 
35385985ea8bSSteven Rostedt (VMware) 	/* probes are only available if tr is set */
35395985ea8bSSteven Rostedt (VMware) 	if (!iter->tr)
35405985ea8bSSteven Rostedt (VMware) 		return NULL;
35415985ea8bSSteven Rostedt (VMware) 
35425985ea8bSSteven Rostedt (VMware) 	for (l = 0; l <= (*pos - iter->func_pos); ) {
35435985ea8bSSteven Rostedt (VMware) 		p = t_mod_next(m, &l);
35445985ea8bSSteven Rostedt (VMware) 		if (!p)
35455985ea8bSSteven Rostedt (VMware) 			break;
35465985ea8bSSteven Rostedt (VMware) 	}
35475985ea8bSSteven Rostedt (VMware) 	if (!p) {
35485985ea8bSSteven Rostedt (VMware) 		iter->flags &= ~FTRACE_ITER_MOD;
35495985ea8bSSteven Rostedt (VMware) 		return t_probe_start(m, pos);
35505985ea8bSSteven Rostedt (VMware) 	}
35515985ea8bSSteven Rostedt (VMware) 
35525985ea8bSSteven Rostedt (VMware) 	/* Only set this if we have an item */
35535985ea8bSSteven Rostedt (VMware) 	iter->flags |= FTRACE_ITER_MOD;
35545985ea8bSSteven Rostedt (VMware) 
35555985ea8bSSteven Rostedt (VMware) 	return iter;
35565985ea8bSSteven Rostedt (VMware) }
35575985ea8bSSteven Rostedt (VMware) 
35585985ea8bSSteven Rostedt (VMware) static int
35595985ea8bSSteven Rostedt (VMware) t_mod_show(struct seq_file *m, struct ftrace_iterator *iter)
35605985ea8bSSteven Rostedt (VMware) {
35615985ea8bSSteven Rostedt (VMware) 	struct ftrace_mod_load *ftrace_mod;
35625985ea8bSSteven Rostedt (VMware) 	struct trace_array *tr = iter->tr;
35635985ea8bSSteven Rostedt (VMware) 
35645985ea8bSSteven Rostedt (VMware) 	if (WARN_ON_ONCE(!iter->mod_list) ||
35655985ea8bSSteven Rostedt (VMware) 			 iter->mod_list == &tr->mod_trace ||
35665985ea8bSSteven Rostedt (VMware) 			 iter->mod_list == &tr->mod_notrace)
35675985ea8bSSteven Rostedt (VMware) 		return -EIO;
35685985ea8bSSteven Rostedt (VMware) 
35695985ea8bSSteven Rostedt (VMware) 	ftrace_mod = list_entry(iter->mod_list, struct ftrace_mod_load, list);
35705985ea8bSSteven Rostedt (VMware) 
35715985ea8bSSteven Rostedt (VMware) 	if (ftrace_mod->func)
35725985ea8bSSteven Rostedt (VMware) 		seq_printf(m, "%s", ftrace_mod->func);
35735985ea8bSSteven Rostedt (VMware) 	else
35745985ea8bSSteven Rostedt (VMware) 		seq_putc(m, '*');
35755985ea8bSSteven Rostedt (VMware) 
35765985ea8bSSteven Rostedt (VMware) 	seq_printf(m, ":mod:%s\n", ftrace_mod->module);
35775985ea8bSSteven Rostedt (VMware) 
35785985ea8bSSteven Rostedt (VMware) 	return 0;
35795985ea8bSSteven Rostedt (VMware) }
35805985ea8bSSteven Rostedt (VMware) 
35815985ea8bSSteven Rostedt (VMware) static void *
35825bd84629SSteven Rostedt (VMware) t_func_next(struct seq_file *m, loff_t *pos)
35835072c59fSSteven Rostedt {
35845072c59fSSteven Rostedt 	struct ftrace_iterator *iter = m->private;
35855072c59fSSteven Rostedt 	struct dyn_ftrace *rec = NULL;
35865072c59fSSteven Rostedt 
35875072c59fSSteven Rostedt 	(*pos)++;
35880c75a3edSSteven Rostedt 
35895072c59fSSteven Rostedt  retry:
35905072c59fSSteven Rostedt 	if (iter->idx >= iter->pg->index) {
35915072c59fSSteven Rostedt 		if (iter->pg->next) {
35925072c59fSSteven Rostedt 			iter->pg = iter->pg->next;
35935072c59fSSteven Rostedt 			iter->idx = 0;
35945072c59fSSteven Rostedt 			goto retry;
35955072c59fSSteven Rostedt 		}
35965072c59fSSteven Rostedt 	} else {
35975072c59fSSteven Rostedt 		rec = &iter->pg->records[iter->idx++];
3598c20489daSSteven Rostedt (VMware) 		if (((iter->flags & (FTRACE_ITER_FILTER | FTRACE_ITER_NOTRACE)) &&
3599c20489daSSteven Rostedt (VMware) 		     !ftrace_lookup_ip(iter->hash, rec->ip)) ||
3600647bcd03SSteven Rostedt 
3601647bcd03SSteven Rostedt 		    ((iter->flags & FTRACE_ITER_ENABLED) &&
360223ea9c4dSSteven Rostedt (Red Hat) 		     !(rec->flags & FTRACE_FL_ENABLED))) {
3603647bcd03SSteven Rostedt 
36045072c59fSSteven Rostedt 			rec = NULL;
36055072c59fSSteven Rostedt 			goto retry;
36065072c59fSSteven Rostedt 		}
36075072c59fSSteven Rostedt 	}
36085072c59fSSteven Rostedt 
36094aeb6967SSteven Rostedt 	if (!rec)
36105bd84629SSteven Rostedt (VMware) 		return NULL;
36114aeb6967SSteven Rostedt 
36125bd84629SSteven Rostedt (VMware) 	iter->pos = iter->func_pos = *pos;
36134aeb6967SSteven Rostedt 	iter->func = rec;
36144aeb6967SSteven Rostedt 
36154aeb6967SSteven Rostedt 	return iter;
36165072c59fSSteven Rostedt }
36175072c59fSSteven Rostedt 
36185bd84629SSteven Rostedt (VMware) static void *
36195bd84629SSteven Rostedt (VMware) t_next(struct seq_file *m, void *v, loff_t *pos)
36205bd84629SSteven Rostedt (VMware) {
36215bd84629SSteven Rostedt (VMware) 	struct ftrace_iterator *iter = m->private;
36225985ea8bSSteven Rostedt (VMware) 	loff_t l = *pos; /* t_probe_start() must use original pos */
36235bd84629SSteven Rostedt (VMware) 	void *ret;
36245bd84629SSteven Rostedt (VMware) 
36255bd84629SSteven Rostedt (VMware) 	if (unlikely(ftrace_disabled))
36265bd84629SSteven Rostedt (VMware) 		return NULL;
36275bd84629SSteven Rostedt (VMware) 
3628eee8ded1SSteven Rostedt (VMware) 	if (iter->flags & FTRACE_ITER_PROBE)
3629eee8ded1SSteven Rostedt (VMware) 		return t_probe_next(m, pos);
36305bd84629SSteven Rostedt (VMware) 
36315985ea8bSSteven Rostedt (VMware) 	if (iter->flags & FTRACE_ITER_MOD)
36325985ea8bSSteven Rostedt (VMware) 		return t_mod_next(m, pos);
36335985ea8bSSteven Rostedt (VMware) 
36345bd84629SSteven Rostedt (VMware) 	if (iter->flags & FTRACE_ITER_PRINTALL) {
3635eee8ded1SSteven Rostedt (VMware) 		/* next must increment pos, and t_probe_start does not */
36365bd84629SSteven Rostedt (VMware) 		(*pos)++;
36375985ea8bSSteven Rostedt (VMware) 		return t_mod_start(m, &l);
36385bd84629SSteven Rostedt (VMware) 	}
36395bd84629SSteven Rostedt (VMware) 
36405bd84629SSteven Rostedt (VMware) 	ret = t_func_next(m, pos);
36415bd84629SSteven Rostedt (VMware) 
36425bd84629SSteven Rostedt (VMware) 	if (!ret)
36435985ea8bSSteven Rostedt (VMware) 		return t_mod_start(m, &l);
36445bd84629SSteven Rostedt (VMware) 
36455bd84629SSteven Rostedt (VMware) 	return ret;
36465bd84629SSteven Rostedt (VMware) }
36475bd84629SSteven Rostedt (VMware) 
364898c4fd04SSteven Rostedt static void reset_iter_read(struct ftrace_iterator *iter)
364998c4fd04SSteven Rostedt {
365098c4fd04SSteven Rostedt 	iter->pos = 0;
365198c4fd04SSteven Rostedt 	iter->func_pos = 0;
36525985ea8bSSteven Rostedt (VMware) 	iter->flags &= ~(FTRACE_ITER_PRINTALL | FTRACE_ITER_PROBE | FTRACE_ITER_MOD);
36535072c59fSSteven Rostedt }
36545072c59fSSteven Rostedt 
36555072c59fSSteven Rostedt static void *t_start(struct seq_file *m, loff_t *pos)
36565072c59fSSteven Rostedt {
36575072c59fSSteven Rostedt 	struct ftrace_iterator *iter = m->private;
36585072c59fSSteven Rostedt 	void *p = NULL;
3659694ce0a5SLi Zefan 	loff_t l;
36605072c59fSSteven Rostedt 
36618fc0c701SSteven Rostedt 	mutex_lock(&ftrace_lock);
366245a4a237SSteven Rostedt 
366345a4a237SSteven Rostedt 	if (unlikely(ftrace_disabled))
366445a4a237SSteven Rostedt 		return NULL;
366545a4a237SSteven Rostedt 
36660c75a3edSSteven Rostedt 	/*
366798c4fd04SSteven Rostedt 	 * If an lseek was done, then reset and start from beginning.
366898c4fd04SSteven Rostedt 	 */
366998c4fd04SSteven Rostedt 	if (*pos < iter->pos)
367098c4fd04SSteven Rostedt 		reset_iter_read(iter);
367198c4fd04SSteven Rostedt 
367298c4fd04SSteven Rostedt 	/*
36730c75a3edSSteven Rostedt 	 * For set_ftrace_filter reading, if we have the filter
36740c75a3edSSteven Rostedt 	 * off, we can short cut and just print out that all
36750c75a3edSSteven Rostedt 	 * functions are enabled.
36760c75a3edSSteven Rostedt 	 */
3677c20489daSSteven Rostedt (VMware) 	if ((iter->flags & (FTRACE_ITER_FILTER | FTRACE_ITER_NOTRACE)) &&
3678c20489daSSteven Rostedt (VMware) 	    ftrace_hash_empty(iter->hash)) {
367943ff926aSSteven Rostedt (VMware) 		iter->func_pos = 1; /* Account for the message */
36800c75a3edSSteven Rostedt 		if (*pos > 0)
36815985ea8bSSteven Rostedt (VMware) 			return t_mod_start(m, pos);
36820c75a3edSSteven Rostedt 		iter->flags |= FTRACE_ITER_PRINTALL;
3683df091625SChris Wright 		/* reset in case of seek/pread */
3684eee8ded1SSteven Rostedt (VMware) 		iter->flags &= ~FTRACE_ITER_PROBE;
36850c75a3edSSteven Rostedt 		return iter;
36860c75a3edSSteven Rostedt 	}
36870c75a3edSSteven Rostedt 
36885985ea8bSSteven Rostedt (VMware) 	if (iter->flags & FTRACE_ITER_MOD)
36895985ea8bSSteven Rostedt (VMware) 		return t_mod_start(m, pos);
36908fc0c701SSteven Rostedt 
369198c4fd04SSteven Rostedt 	/*
369298c4fd04SSteven Rostedt 	 * Unfortunately, we need to restart at ftrace_pages_start
369398c4fd04SSteven Rostedt 	 * every time we let go of the ftrace_mutex. This is because
369498c4fd04SSteven Rostedt 	 * those pointers can change without the lock.
369598c4fd04SSteven Rostedt 	 */
3696694ce0a5SLi Zefan 	iter->pg = ftrace_pages_start;
3697694ce0a5SLi Zefan 	iter->idx = 0;
3698694ce0a5SLi Zefan 	for (l = 0; l <= *pos; ) {
36995bd84629SSteven Rostedt (VMware) 		p = t_func_next(m, &l);
3700694ce0a5SLi Zefan 		if (!p)
3701694ce0a5SLi Zefan 			break;
370250cdaf08SLiming Wang 	}
37035821e1b7Swalimis 
370469a3083cSSteven Rostedt 	if (!p)
37055985ea8bSSteven Rostedt (VMware) 		return t_mod_start(m, pos);
37068fc0c701SSteven Rostedt 
37074aeb6967SSteven Rostedt 	return iter;
37085072c59fSSteven Rostedt }
37095072c59fSSteven Rostedt 
37105072c59fSSteven Rostedt static void t_stop(struct seq_file *m, void *p)
37115072c59fSSteven Rostedt {
37128fc0c701SSteven Rostedt 	mutex_unlock(&ftrace_lock);
37135072c59fSSteven Rostedt }
37145072c59fSSteven Rostedt 
371515d5b02cSSteven Rostedt (Red Hat) void * __weak
371615d5b02cSSteven Rostedt (Red Hat) arch_ftrace_trampoline_func(struct ftrace_ops *ops, struct dyn_ftrace *rec)
371715d5b02cSSteven Rostedt (Red Hat) {
371815d5b02cSSteven Rostedt (Red Hat) 	return NULL;
371915d5b02cSSteven Rostedt (Red Hat) }
372015d5b02cSSteven Rostedt (Red Hat) 
372115d5b02cSSteven Rostedt (Red Hat) static void add_trampoline_func(struct seq_file *m, struct ftrace_ops *ops,
372215d5b02cSSteven Rostedt (Red Hat) 				struct dyn_ftrace *rec)
372315d5b02cSSteven Rostedt (Red Hat) {
372415d5b02cSSteven Rostedt (Red Hat) 	void *ptr;
372515d5b02cSSteven Rostedt (Red Hat) 
372615d5b02cSSteven Rostedt (Red Hat) 	ptr = arch_ftrace_trampoline_func(ops, rec);
372715d5b02cSSteven Rostedt (Red Hat) 	if (ptr)
372815d5b02cSSteven Rostedt (Red Hat) 		seq_printf(m, " ->%pS", ptr);
372915d5b02cSSteven Rostedt (Red Hat) }
373015d5b02cSSteven Rostedt (Red Hat) 
3731b39181f7SSteven Rostedt (Google) #ifdef FTRACE_MCOUNT_MAX_OFFSET
3732b39181f7SSteven Rostedt (Google) /*
3733b39181f7SSteven Rostedt (Google)  * Weak functions can still have an mcount/fentry that is saved in
3734b39181f7SSteven Rostedt (Google)  * the __mcount_loc section. These can be detected by having a
3735b39181f7SSteven Rostedt (Google)  * symbol offset of greater than FTRACE_MCOUNT_MAX_OFFSET, as the
3736b39181f7SSteven Rostedt (Google)  * symbol found by kallsyms is not the function that the mcount/fentry
3737b39181f7SSteven Rostedt (Google)  * is part of. The offset is much greater in these cases.
3738b39181f7SSteven Rostedt (Google)  *
3739b39181f7SSteven Rostedt (Google)  * Test the record to make sure that the ip points to a valid kallsyms
3740b39181f7SSteven Rostedt (Google)  * and if not, mark it disabled.
3741b39181f7SSteven Rostedt (Google)  */
3742b39181f7SSteven Rostedt (Google) static int test_for_valid_rec(struct dyn_ftrace *rec)
3743b39181f7SSteven Rostedt (Google) {
3744b39181f7SSteven Rostedt (Google) 	char str[KSYM_SYMBOL_LEN];
3745b39181f7SSteven Rostedt (Google) 	unsigned long offset;
3746b39181f7SSteven Rostedt (Google) 	const char *ret;
3747b39181f7SSteven Rostedt (Google) 
3748b39181f7SSteven Rostedt (Google) 	ret = kallsyms_lookup(rec->ip, NULL, &offset, NULL, str);
3749b39181f7SSteven Rostedt (Google) 
3750b39181f7SSteven Rostedt (Google) 	/* Weak functions can cause invalid addresses */
3751b39181f7SSteven Rostedt (Google) 	if (!ret || offset > FTRACE_MCOUNT_MAX_OFFSET) {
3752b39181f7SSteven Rostedt (Google) 		rec->flags |= FTRACE_FL_DISABLED;
3753b39181f7SSteven Rostedt (Google) 		return 0;
3754b39181f7SSteven Rostedt (Google) 	}
3755b39181f7SSteven Rostedt (Google) 	return 1;
3756b39181f7SSteven Rostedt (Google) }
3757b39181f7SSteven Rostedt (Google) 
3758b39181f7SSteven Rostedt (Google) static struct workqueue_struct *ftrace_check_wq __initdata;
3759b39181f7SSteven Rostedt (Google) static struct work_struct ftrace_check_work __initdata;
3760b39181f7SSteven Rostedt (Google) 
3761b39181f7SSteven Rostedt (Google) /*
3762b39181f7SSteven Rostedt (Google)  * Scan all the mcount/fentry entries to make sure they are valid.
3763b39181f7SSteven Rostedt (Google)  */
3764b39181f7SSteven Rostedt (Google) static __init void ftrace_check_work_func(struct work_struct *work)
3765b39181f7SSteven Rostedt (Google) {
3766b39181f7SSteven Rostedt (Google) 	struct ftrace_page *pg;
3767b39181f7SSteven Rostedt (Google) 	struct dyn_ftrace *rec;
3768b39181f7SSteven Rostedt (Google) 
3769b39181f7SSteven Rostedt (Google) 	mutex_lock(&ftrace_lock);
3770b39181f7SSteven Rostedt (Google) 	do_for_each_ftrace_rec(pg, rec) {
3771b39181f7SSteven Rostedt (Google) 		test_for_valid_rec(rec);
3772b39181f7SSteven Rostedt (Google) 	} while_for_each_ftrace_rec();
3773b39181f7SSteven Rostedt (Google) 	mutex_unlock(&ftrace_lock);
3774b39181f7SSteven Rostedt (Google) }
3775b39181f7SSteven Rostedt (Google) 
3776b39181f7SSteven Rostedt (Google) static int __init ftrace_check_for_weak_functions(void)
3777b39181f7SSteven Rostedt (Google) {
3778b39181f7SSteven Rostedt (Google) 	INIT_WORK(&ftrace_check_work, ftrace_check_work_func);
3779b39181f7SSteven Rostedt (Google) 
3780b39181f7SSteven Rostedt (Google) 	ftrace_check_wq = alloc_workqueue("ftrace_check_wq", WQ_UNBOUND, 0);
3781b39181f7SSteven Rostedt (Google) 
3782b39181f7SSteven Rostedt (Google) 	queue_work(ftrace_check_wq, &ftrace_check_work);
3783b39181f7SSteven Rostedt (Google) 	return 0;
3784b39181f7SSteven Rostedt (Google) }
3785b39181f7SSteven Rostedt (Google) 
3786b39181f7SSteven Rostedt (Google) static int __init ftrace_check_sync(void)
3787b39181f7SSteven Rostedt (Google) {
3788b39181f7SSteven Rostedt (Google) 	/* Make sure the ftrace_check updates are finished */
3789b39181f7SSteven Rostedt (Google) 	if (ftrace_check_wq)
3790b39181f7SSteven Rostedt (Google) 		destroy_workqueue(ftrace_check_wq);
3791b39181f7SSteven Rostedt (Google) 	return 0;
3792b39181f7SSteven Rostedt (Google) }
3793b39181f7SSteven Rostedt (Google) 
3794b39181f7SSteven Rostedt (Google) late_initcall_sync(ftrace_check_sync);
3795b39181f7SSteven Rostedt (Google) subsys_initcall(ftrace_check_for_weak_functions);
3796b39181f7SSteven Rostedt (Google) 
3797b39181f7SSteven Rostedt (Google) static int print_rec(struct seq_file *m, unsigned long ip)
3798b39181f7SSteven Rostedt (Google) {
3799b39181f7SSteven Rostedt (Google) 	unsigned long offset;
3800b39181f7SSteven Rostedt (Google) 	char str[KSYM_SYMBOL_LEN];
3801b39181f7SSteven Rostedt (Google) 	char *modname;
3802b39181f7SSteven Rostedt (Google) 	const char *ret;
3803b39181f7SSteven Rostedt (Google) 
3804b39181f7SSteven Rostedt (Google) 	ret = kallsyms_lookup(ip, NULL, &offset, &modname, str);
3805b39181f7SSteven Rostedt (Google) 	/* Weak functions can cause invalid addresses */
3806b39181f7SSteven Rostedt (Google) 	if (!ret || offset > FTRACE_MCOUNT_MAX_OFFSET) {
3807b39181f7SSteven Rostedt (Google) 		snprintf(str, KSYM_SYMBOL_LEN, "%s_%ld",
3808b39181f7SSteven Rostedt (Google) 			 FTRACE_INVALID_FUNCTION, offset);
3809b39181f7SSteven Rostedt (Google) 		ret = NULL;
3810b39181f7SSteven Rostedt (Google) 	}
3811b39181f7SSteven Rostedt (Google) 
3812b39181f7SSteven Rostedt (Google) 	seq_puts(m, str);
3813b39181f7SSteven Rostedt (Google) 	if (modname)
3814b39181f7SSteven Rostedt (Google) 		seq_printf(m, " [%s]", modname);
3815b39181f7SSteven Rostedt (Google) 	return ret == NULL ? -1 : 0;
3816b39181f7SSteven Rostedt (Google) }
3817b39181f7SSteven Rostedt (Google) #else
3818b39181f7SSteven Rostedt (Google) static inline int test_for_valid_rec(struct dyn_ftrace *rec)
3819b39181f7SSteven Rostedt (Google) {
3820b39181f7SSteven Rostedt (Google) 	return 1;
3821b39181f7SSteven Rostedt (Google) }
3822b39181f7SSteven Rostedt (Google) 
3823b39181f7SSteven Rostedt (Google) static inline int print_rec(struct seq_file *m, unsigned long ip)
3824b39181f7SSteven Rostedt (Google) {
3825b39181f7SSteven Rostedt (Google) 	seq_printf(m, "%ps", (void *)ip);
3826b39181f7SSteven Rostedt (Google) 	return 0;
3827b39181f7SSteven Rostedt (Google) }
3828b39181f7SSteven Rostedt (Google) #endif
3829b39181f7SSteven Rostedt (Google) 
38305072c59fSSteven Rostedt static int t_show(struct seq_file *m, void *v)
38315072c59fSSteven Rostedt {
38320c75a3edSSteven Rostedt 	struct ftrace_iterator *iter = m->private;
38334aeb6967SSteven Rostedt 	struct dyn_ftrace *rec;
38345072c59fSSteven Rostedt 
3835eee8ded1SSteven Rostedt (VMware) 	if (iter->flags & FTRACE_ITER_PROBE)
3836eee8ded1SSteven Rostedt (VMware) 		return t_probe_show(m, iter);
38378fc0c701SSteven Rostedt 
38385985ea8bSSteven Rostedt (VMware) 	if (iter->flags & FTRACE_ITER_MOD)
38395985ea8bSSteven Rostedt (VMware) 		return t_mod_show(m, iter);
38405985ea8bSSteven Rostedt (VMware) 
38410c75a3edSSteven Rostedt 	if (iter->flags & FTRACE_ITER_PRINTALL) {
38428c006cf7SNamhyung Kim 		if (iter->flags & FTRACE_ITER_NOTRACE)
3843fa6f0cc7SRasmus Villemoes 			seq_puts(m, "#### no functions disabled ####\n");
38448c006cf7SNamhyung Kim 		else
3845fa6f0cc7SRasmus Villemoes 			seq_puts(m, "#### all functions enabled ####\n");
38460c75a3edSSteven Rostedt 		return 0;
38470c75a3edSSteven Rostedt 	}
38480c75a3edSSteven Rostedt 
38494aeb6967SSteven Rostedt 	rec = iter->func;
38504aeb6967SSteven Rostedt 
38515072c59fSSteven Rostedt 	if (!rec)
38525072c59fSSteven Rostedt 		return 0;
38535072c59fSSteven Rostedt 
3854b39181f7SSteven Rostedt (Google) 	if (print_rec(m, rec->ip)) {
3855b39181f7SSteven Rostedt (Google) 		/* This should only happen when a rec is disabled */
3856b39181f7SSteven Rostedt (Google) 		WARN_ON_ONCE(!(rec->flags & FTRACE_FL_DISABLED));
3857b39181f7SSteven Rostedt (Google) 		seq_putc(m, '\n');
3858b39181f7SSteven Rostedt (Google) 		return 0;
3859b39181f7SSteven Rostedt (Google) 	}
3860b39181f7SSteven Rostedt (Google) 
38619674b2faSSteven Rostedt (Red Hat) 	if (iter->flags & FTRACE_ITER_ENABLED) {
3862030f4e1cSSteven Rostedt (Red Hat) 		struct ftrace_ops *ops;
386315d5b02cSSteven Rostedt (Red Hat) 
3864cbad0fb2SMark Rutland 		seq_printf(m, " (%ld)%s%s%s%s",
38650376bde1SSteven Rostedt (Red Hat) 			   ftrace_rec_count(rec),
3866f8b8be8aSMasami Hiramatsu 			   rec->flags & FTRACE_FL_REGS ? " R" : "  ",
3867763e34e7SSteven Rostedt (VMware) 			   rec->flags & FTRACE_FL_IPMODIFY ? " I" : "  ",
3868cbad0fb2SMark Rutland 			   rec->flags & FTRACE_FL_DIRECT ? " D" : "  ",
3869cbad0fb2SMark Rutland 			   rec->flags & FTRACE_FL_CALL_OPS ? " O" : "  ");
38709674b2faSSteven Rostedt (Red Hat) 		if (rec->flags & FTRACE_FL_TRAMP_EN) {
38715fecaa04SSteven Rostedt (Red Hat) 			ops = ftrace_find_tramp_ops_any(rec);
387239daa7b9SSteven Rostedt (Red Hat) 			if (ops) {
387339daa7b9SSteven Rostedt (Red Hat) 				do {
387439daa7b9SSteven Rostedt (Red Hat) 					seq_printf(m, "\ttramp: %pS (%pS)",
387539daa7b9SSteven Rostedt (Red Hat) 						   (void *)ops->trampoline,
387639daa7b9SSteven Rostedt (Red Hat) 						   (void *)ops->func);
3877030f4e1cSSteven Rostedt (Red Hat) 					add_trampoline_func(m, ops, rec);
387839daa7b9SSteven Rostedt (Red Hat) 					ops = ftrace_find_tramp_ops_next(rec, ops);
387939daa7b9SSteven Rostedt (Red Hat) 				} while (ops);
388039daa7b9SSteven Rostedt (Red Hat) 			} else
3881fa6f0cc7SRasmus Villemoes 				seq_puts(m, "\ttramp: ERROR!");
3882030f4e1cSSteven Rostedt (Red Hat) 		} else {
3883030f4e1cSSteven Rostedt (Red Hat) 			add_trampoline_func(m, NULL, rec);
38849674b2faSSteven Rostedt (Red Hat) 		}
3885cbad0fb2SMark Rutland 		if (rec->flags & FTRACE_FL_CALL_OPS_EN) {
3886cbad0fb2SMark Rutland 			ops = ftrace_find_unique_ops(rec);
3887cbad0fb2SMark Rutland 			if (ops) {
3888cbad0fb2SMark Rutland 				seq_printf(m, "\tops: %pS (%pS)",
3889cbad0fb2SMark Rutland 					   ops, ops->func);
3890cbad0fb2SMark Rutland 			} else {
3891cbad0fb2SMark Rutland 				seq_puts(m, "\tops: ERROR!");
3892cbad0fb2SMark Rutland 			}
3893cbad0fb2SMark Rutland 		}
3894763e34e7SSteven Rostedt (VMware) 		if (rec->flags & FTRACE_FL_DIRECT) {
3895763e34e7SSteven Rostedt (VMware) 			unsigned long direct;
3896763e34e7SSteven Rostedt (VMware) 
3897ff205766SAlexei Starovoitov 			direct = ftrace_find_rec_direct(rec->ip);
3898763e34e7SSteven Rostedt (VMware) 			if (direct)
3899763e34e7SSteven Rostedt (VMware) 				seq_printf(m, "\n\tdirect-->%pS", (void *)direct);
3900763e34e7SSteven Rostedt (VMware) 		}
39019674b2faSSteven Rostedt (Red Hat) 	}
39029674b2faSSteven Rostedt (Red Hat) 
3903fa6f0cc7SRasmus Villemoes 	seq_putc(m, '\n');
39045072c59fSSteven Rostedt 
39055072c59fSSteven Rostedt 	return 0;
39065072c59fSSteven Rostedt }
39075072c59fSSteven Rostedt 
390888e9d34cSJames Morris static const struct seq_operations show_ftrace_seq_ops = {
39095072c59fSSteven Rostedt 	.start = t_start,
39105072c59fSSteven Rostedt 	.next = t_next,
39115072c59fSSteven Rostedt 	.stop = t_stop,
39125072c59fSSteven Rostedt 	.show = t_show,
39135072c59fSSteven Rostedt };
39145072c59fSSteven Rostedt 
3915e309b41dSIngo Molnar static int
39165072c59fSSteven Rostedt ftrace_avail_open(struct inode *inode, struct file *file)
39175072c59fSSteven Rostedt {
39185072c59fSSteven Rostedt 	struct ftrace_iterator *iter;
391917911ff3SSteven Rostedt (VMware) 	int ret;
392017911ff3SSteven Rostedt (VMware) 
392117911ff3SSteven Rostedt (VMware) 	ret = security_locked_down(LOCKDOWN_TRACEFS);
392217911ff3SSteven Rostedt (VMware) 	if (ret)
392317911ff3SSteven Rostedt (VMware) 		return ret;
39245072c59fSSteven Rostedt 
39254eebcc81SSteven Rostedt 	if (unlikely(ftrace_disabled))
39264eebcc81SSteven Rostedt 		return -ENODEV;
39274eebcc81SSteven Rostedt 
392850e18b94SJiri Olsa 	iter = __seq_open_private(file, &show_ftrace_seq_ops, sizeof(*iter));
3929c1bc5919SSteven Rostedt (VMware) 	if (!iter)
3930c1bc5919SSteven Rostedt (VMware) 		return -ENOMEM;
3931c1bc5919SSteven Rostedt (VMware) 
39325072c59fSSteven Rostedt 	iter->pg = ftrace_pages_start;
3933fc13cb0cSSteven Rostedt 	iter->ops = &global_ops;
39345072c59fSSteven Rostedt 
3935c1bc5919SSteven Rostedt (VMware) 	return 0;
39365072c59fSSteven Rostedt }
39375072c59fSSteven Rostedt 
3938647bcd03SSteven Rostedt static int
3939647bcd03SSteven Rostedt ftrace_enabled_open(struct inode *inode, struct file *file)
3940647bcd03SSteven Rostedt {
3941647bcd03SSteven Rostedt 	struct ftrace_iterator *iter;
3942647bcd03SSteven Rostedt 
394317911ff3SSteven Rostedt (VMware) 	/*
394417911ff3SSteven Rostedt (VMware) 	 * This shows us what functions are currently being
394517911ff3SSteven Rostedt (VMware) 	 * traced and by what. Not sure if we want lockdown
394617911ff3SSteven Rostedt (VMware) 	 * to hide such critical information for an admin.
394717911ff3SSteven Rostedt (VMware) 	 * Although, perhaps it can show information we don't
394817911ff3SSteven Rostedt (VMware) 	 * want people to see, but if something is tracing
394917911ff3SSteven Rostedt (VMware) 	 * something, we probably want to know about it.
395017911ff3SSteven Rostedt (VMware) 	 */
395117911ff3SSteven Rostedt (VMware) 
395250e18b94SJiri Olsa 	iter = __seq_open_private(file, &show_ftrace_seq_ops, sizeof(*iter));
3953c1bc5919SSteven Rostedt (VMware) 	if (!iter)
3954c1bc5919SSteven Rostedt (VMware) 		return -ENOMEM;
3955c1bc5919SSteven Rostedt (VMware) 
3956647bcd03SSteven Rostedt 	iter->pg = ftrace_pages_start;
3957647bcd03SSteven Rostedt 	iter->flags = FTRACE_ITER_ENABLED;
3958fc13cb0cSSteven Rostedt 	iter->ops = &global_ops;
3959647bcd03SSteven Rostedt 
3960c1bc5919SSteven Rostedt (VMware) 	return 0;
3961647bcd03SSteven Rostedt }
3962647bcd03SSteven Rostedt 
3963fc13cb0cSSteven Rostedt /**
3964fc13cb0cSSteven Rostedt  * ftrace_regex_open - initialize function tracer filter files
3965fc13cb0cSSteven Rostedt  * @ops: The ftrace_ops that hold the hash filters
3966fc13cb0cSSteven Rostedt  * @flag: The type of filter to process
3967fc13cb0cSSteven Rostedt  * @inode: The inode, usually passed in to your open routine
3968fc13cb0cSSteven Rostedt  * @file: The file, usually passed in to your open routine
3969fc13cb0cSSteven Rostedt  *
3970fc13cb0cSSteven Rostedt  * ftrace_regex_open() initializes the filter files for the
3971fc13cb0cSSteven Rostedt  * @ops. Depending on @flag it may process the filter hash or
3972fc13cb0cSSteven Rostedt  * the notrace hash of @ops. With this called from the open
3973fc13cb0cSSteven Rostedt  * routine, you can use ftrace_filter_write() for the write
3974fc13cb0cSSteven Rostedt  * routine if @flag has FTRACE_ITER_FILTER set, or
3975fc13cb0cSSteven Rostedt  * ftrace_notrace_write() if @flag has FTRACE_ITER_NOTRACE set.
3976098c879eSSteven Rostedt (Red Hat)  * tracing_lseek() should be used as the lseek routine, and
3977fc13cb0cSSteven Rostedt  * release must call ftrace_regex_release().
3978fc13cb0cSSteven Rostedt  */
3979fc13cb0cSSteven Rostedt int
3980f45948e8SSteven Rostedt ftrace_regex_open(struct ftrace_ops *ops, int flag,
39811cf41dd7SSteven Rostedt 		  struct inode *inode, struct file *file)
39825072c59fSSteven Rostedt {
39835072c59fSSteven Rostedt 	struct ftrace_iterator *iter;
3984f45948e8SSteven Rostedt 	struct ftrace_hash *hash;
3985673feb9dSSteven Rostedt (VMware) 	struct list_head *mod_head;
3986673feb9dSSteven Rostedt (VMware) 	struct trace_array *tr = ops->private;
39879ef16693SSteven Rostedt (VMware) 	int ret = -ENOMEM;
39885072c59fSSteven Rostedt 
3989f04f24fbSMasami Hiramatsu 	ftrace_ops_init(ops);
3990f04f24fbSMasami Hiramatsu 
39914eebcc81SSteven Rostedt 	if (unlikely(ftrace_disabled))
39924eebcc81SSteven Rostedt 		return -ENODEV;
39934eebcc81SSteven Rostedt 
39948530dec6SSteven Rostedt (VMware) 	if (tracing_check_open_get_tr(tr))
39959ef16693SSteven Rostedt (VMware) 		return -ENODEV;
39969ef16693SSteven Rostedt (VMware) 
39975072c59fSSteven Rostedt 	iter = kzalloc(sizeof(*iter), GFP_KERNEL);
39985072c59fSSteven Rostedt 	if (!iter)
39999ef16693SSteven Rostedt (VMware) 		goto out;
40005072c59fSSteven Rostedt 
40019ef16693SSteven Rostedt (VMware) 	if (trace_parser_get_init(&iter->parser, FTRACE_BUFF_MAX))
40029ef16693SSteven Rostedt (VMware) 		goto out;
4003689fd8b6S[email protected] 
40043f2367baSMasami Hiramatsu 	iter->ops = ops;
40053f2367baSMasami Hiramatsu 	iter->flags = flag;
40065985ea8bSSteven Rostedt (VMware) 	iter->tr = tr;
40073f2367baSMasami Hiramatsu 
400833b7f99cSSteven Rostedt (Red Hat) 	mutex_lock(&ops->func_hash->regex_lock);
40093f2367baSMasami Hiramatsu 
4010673feb9dSSteven Rostedt (VMware) 	if (flag & FTRACE_ITER_NOTRACE) {
401133b7f99cSSteven Rostedt (Red Hat) 		hash = ops->func_hash->notrace_hash;
40125985ea8bSSteven Rostedt (VMware) 		mod_head = tr ? &tr->mod_notrace : NULL;
4013673feb9dSSteven Rostedt (VMware) 	} else {
401433b7f99cSSteven Rostedt (Red Hat) 		hash = ops->func_hash->filter_hash;
40155985ea8bSSteven Rostedt (VMware) 		mod_head = tr ? &tr->mod_trace : NULL;
4016673feb9dSSteven Rostedt (VMware) 	}
4017f45948e8SSteven Rostedt 
40185985ea8bSSteven Rostedt (VMware) 	iter->mod_list = mod_head;
40195985ea8bSSteven Rostedt (VMware) 
402033dc9b12SSteven Rostedt 	if (file->f_mode & FMODE_WRITE) {
4021ef2fbe16SNamhyung Kim 		const int size_bits = FTRACE_HASH_DEFAULT_BITS;
4022ef2fbe16SNamhyung Kim 
4023673feb9dSSteven Rostedt (VMware) 		if (file->f_flags & O_TRUNC) {
4024ef2fbe16SNamhyung Kim 			iter->hash = alloc_ftrace_hash(size_bits);
4025673feb9dSSteven Rostedt (VMware) 			clear_ftrace_mod_list(mod_head);
4026673feb9dSSteven Rostedt (VMware) 	        } else {
4027ef2fbe16SNamhyung Kim 			iter->hash = alloc_and_copy_ftrace_hash(size_bits, hash);
4028673feb9dSSteven Rostedt (VMware) 		}
4029ef2fbe16SNamhyung Kim 
403033dc9b12SSteven Rostedt 		if (!iter->hash) {
403133dc9b12SSteven Rostedt 			trace_parser_put(&iter->parser);
40323f2367baSMasami Hiramatsu 			goto out_unlock;
403333dc9b12SSteven Rostedt 		}
4034c20489daSSteven Rostedt (VMware) 	} else
4035c20489daSSteven Rostedt (VMware) 		iter->hash = hash;
40361cf41dd7SSteven Rostedt 
40379ef16693SSteven Rostedt (VMware) 	ret = 0;
40389ef16693SSteven Rostedt (VMware) 
40395072c59fSSteven Rostedt 	if (file->f_mode & FMODE_READ) {
40405072c59fSSteven Rostedt 		iter->pg = ftrace_pages_start;
40415072c59fSSteven Rostedt 
40425072c59fSSteven Rostedt 		ret = seq_open(file, &show_ftrace_seq_ops);
40435072c59fSSteven Rostedt 		if (!ret) {
40445072c59fSSteven Rostedt 			struct seq_file *m = file->private_data;
40455072c59fSSteven Rostedt 			m->private = iter;
404679fe249cSLi Zefan 		} else {
404733dc9b12SSteven Rostedt 			/* Failed */
404833dc9b12SSteven Rostedt 			free_ftrace_hash(iter->hash);
404979fe249cSLi Zefan 			trace_parser_put(&iter->parser);
405079fe249cSLi Zefan 		}
40515072c59fSSteven Rostedt 	} else
40525072c59fSSteven Rostedt 		file->private_data = iter;
40533f2367baSMasami Hiramatsu 
40543f2367baSMasami Hiramatsu  out_unlock:
405533b7f99cSSteven Rostedt (Red Hat) 	mutex_unlock(&ops->func_hash->regex_lock);
40565072c59fSSteven Rostedt 
40579ef16693SSteven Rostedt (VMware)  out:
40589ef16693SSteven Rostedt (VMware) 	if (ret) {
40599ef16693SSteven Rostedt (VMware) 		kfree(iter);
40609ef16693SSteven Rostedt (VMware) 		if (tr)
40619ef16693SSteven Rostedt (VMware) 			trace_array_put(tr);
40629ef16693SSteven Rostedt (VMware) 	}
40639ef16693SSteven Rostedt (VMware) 
40645072c59fSSteven Rostedt 	return ret;
40655072c59fSSteven Rostedt }
40665072c59fSSteven Rostedt 
406741c52c0dSSteven Rostedt static int
406841c52c0dSSteven Rostedt ftrace_filter_open(struct inode *inode, struct file *file)
406941c52c0dSSteven Rostedt {
4070e3b3e2e8SSteven Rostedt (Red Hat) 	struct ftrace_ops *ops = inode->i_private;
4071e3b3e2e8SSteven Rostedt (Red Hat) 
407217911ff3SSteven Rostedt (VMware) 	/* Checks for tracefs lockdown */
4073e3b3e2e8SSteven Rostedt (Red Hat) 	return ftrace_regex_open(ops,
4074eee8ded1SSteven Rostedt (VMware) 			FTRACE_ITER_FILTER | FTRACE_ITER_DO_PROBES,
40751cf41dd7SSteven Rostedt 			inode, file);
407641c52c0dSSteven Rostedt }
407741c52c0dSSteven Rostedt 
407841c52c0dSSteven Rostedt static int
407941c52c0dSSteven Rostedt ftrace_notrace_open(struct inode *inode, struct file *file)
408041c52c0dSSteven Rostedt {
4081e3b3e2e8SSteven Rostedt (Red Hat) 	struct ftrace_ops *ops = inode->i_private;
4082e3b3e2e8SSteven Rostedt (Red Hat) 
408317911ff3SSteven Rostedt (VMware) 	/* Checks for tracefs lockdown */
4084e3b3e2e8SSteven Rostedt (Red Hat) 	return ftrace_regex_open(ops, FTRACE_ITER_NOTRACE,
40851cf41dd7SSteven Rostedt 				 inode, file);
408641c52c0dSSteven Rostedt }
408741c52c0dSSteven Rostedt 
40883ba00929SDmitry Safonov /* Type for quick search ftrace basic regexes (globs) from filter_parse_regex */
40893ba00929SDmitry Safonov struct ftrace_glob {
40903ba00929SDmitry Safonov 	char *search;
40913ba00929SDmitry Safonov 	unsigned len;
40923ba00929SDmitry Safonov 	int type;
40933ba00929SDmitry Safonov };
40943ba00929SDmitry Safonov 
40957132e2d6SThiago Jung Bauermann /*
40967132e2d6SThiago Jung Bauermann  * If symbols in an architecture don't correspond exactly to the user-visible
40977132e2d6SThiago Jung Bauermann  * name of what they represent, it is possible to define this function to
40987132e2d6SThiago Jung Bauermann  * perform the necessary adjustments.
40997132e2d6SThiago Jung Bauermann */
41007132e2d6SThiago Jung Bauermann char * __weak arch_ftrace_match_adjust(char *str, const char *search)
41017132e2d6SThiago Jung Bauermann {
41027132e2d6SThiago Jung Bauermann 	return str;
41037132e2d6SThiago Jung Bauermann }
41047132e2d6SThiago Jung Bauermann 
41053ba00929SDmitry Safonov static int ftrace_match(char *str, struct ftrace_glob *g)
41069f4801e3SSteven Rostedt {
41079f4801e3SSteven Rostedt 	int matched = 0;
4108751e9983SLi Zefan 	int slen;
41099f4801e3SSteven Rostedt 
41107132e2d6SThiago Jung Bauermann 	str = arch_ftrace_match_adjust(str, g->search);
41117132e2d6SThiago Jung Bauermann 
41123ba00929SDmitry Safonov 	switch (g->type) {
41139f4801e3SSteven Rostedt 	case MATCH_FULL:
41143ba00929SDmitry Safonov 		if (strcmp(str, g->search) == 0)
41159f4801e3SSteven Rostedt 			matched = 1;
41169f4801e3SSteven Rostedt 		break;
41179f4801e3SSteven Rostedt 	case MATCH_FRONT_ONLY:
41183ba00929SDmitry Safonov 		if (strncmp(str, g->search, g->len) == 0)
41199f4801e3SSteven Rostedt 			matched = 1;
41209f4801e3SSteven Rostedt 		break;
41219f4801e3SSteven Rostedt 	case MATCH_MIDDLE_ONLY:
41223ba00929SDmitry Safonov 		if (strstr(str, g->search))
41239f4801e3SSteven Rostedt 			matched = 1;
41249f4801e3SSteven Rostedt 		break;
41259f4801e3SSteven Rostedt 	case MATCH_END_ONLY:
4126751e9983SLi Zefan 		slen = strlen(str);
41273ba00929SDmitry Safonov 		if (slen >= g->len &&
41283ba00929SDmitry Safonov 		    memcmp(str + slen - g->len, g->search, g->len) == 0)
41299f4801e3SSteven Rostedt 			matched = 1;
41309f4801e3SSteven Rostedt 		break;
413160f1d5e3SMasami Hiramatsu 	case MATCH_GLOB:
413260f1d5e3SMasami Hiramatsu 		if (glob_match(g->search, str))
413360f1d5e3SMasami Hiramatsu 			matched = 1;
413460f1d5e3SMasami Hiramatsu 		break;
41359f4801e3SSteven Rostedt 	}
41369f4801e3SSteven Rostedt 
41379f4801e3SSteven Rostedt 	return matched;
41389f4801e3SSteven Rostedt }
41399f4801e3SSteven Rostedt 
4140b448c4e3SSteven Rostedt static int
4141f0a3b154SDmitry Safonov enter_record(struct ftrace_hash *hash, struct dyn_ftrace *rec, int clear_filter)
414264e7c440SSteven Rostedt {
4143b448c4e3SSteven Rostedt 	struct ftrace_func_entry *entry;
4144b448c4e3SSteven Rostedt 	int ret = 0;
4145b448c4e3SSteven Rostedt 
41461cf41dd7SSteven Rostedt 	entry = ftrace_lookup_ip(hash, rec->ip);
4147f0a3b154SDmitry Safonov 	if (clear_filter) {
4148b448c4e3SSteven Rostedt 		/* Do nothing if it doesn't exist */
4149b448c4e3SSteven Rostedt 		if (!entry)
4150b448c4e3SSteven Rostedt 			return 0;
4151b448c4e3SSteven Rostedt 
415233dc9b12SSteven Rostedt 		free_hash_entry(hash, entry);
4153b448c4e3SSteven Rostedt 	} else {
4154b448c4e3SSteven Rostedt 		/* Do nothing if it exists */
4155b448c4e3SSteven Rostedt 		if (entry)
4156b448c4e3SSteven Rostedt 			return 0;
4157b448c4e3SSteven Rostedt 
4158b448c4e3SSteven Rostedt 		ret = add_hash_entry(hash, rec->ip);
4159b448c4e3SSteven Rostedt 	}
4160b448c4e3SSteven Rostedt 	return ret;
4161996e87beSSteven Rostedt }
4162996e87beSSteven Rostedt 
416364e7c440SSteven Rostedt static int
4164f79b3f33SSteven Rostedt (VMware) add_rec_by_index(struct ftrace_hash *hash, struct ftrace_glob *func_g,
4165f79b3f33SSteven Rostedt (VMware) 		 int clear_filter)
4166f79b3f33SSteven Rostedt (VMware) {
4167f79b3f33SSteven Rostedt (VMware) 	long index = simple_strtoul(func_g->search, NULL, 0);
4168f79b3f33SSteven Rostedt (VMware) 	struct ftrace_page *pg;
4169f79b3f33SSteven Rostedt (VMware) 	struct dyn_ftrace *rec;
4170f79b3f33SSteven Rostedt (VMware) 
4171f79b3f33SSteven Rostedt (VMware) 	/* The index starts at 1 */
4172f79b3f33SSteven Rostedt (VMware) 	if (--index < 0)
4173f79b3f33SSteven Rostedt (VMware) 		return 0;
4174f79b3f33SSteven Rostedt (VMware) 
4175f79b3f33SSteven Rostedt (VMware) 	do_for_each_ftrace_rec(pg, rec) {
4176f79b3f33SSteven Rostedt (VMware) 		if (pg->index <= index) {
4177f79b3f33SSteven Rostedt (VMware) 			index -= pg->index;
4178f79b3f33SSteven Rostedt (VMware) 			/* this is a double loop, break goes to the next page */
4179f79b3f33SSteven Rostedt (VMware) 			break;
4180f79b3f33SSteven Rostedt (VMware) 		}
4181f79b3f33SSteven Rostedt (VMware) 		rec = &pg->records[index];
4182f79b3f33SSteven Rostedt (VMware) 		enter_record(hash, rec, clear_filter);
4183f79b3f33SSteven Rostedt (VMware) 		return 1;
4184f79b3f33SSteven Rostedt (VMware) 	} while_for_each_ftrace_rec();
4185f79b3f33SSteven Rostedt (VMware) 	return 0;
4186f79b3f33SSteven Rostedt (VMware) }
4187f79b3f33SSteven Rostedt (VMware) 
4188b39181f7SSteven Rostedt (Google) #ifdef FTRACE_MCOUNT_MAX_OFFSET
4189b39181f7SSteven Rostedt (Google) static int lookup_ip(unsigned long ip, char **modname, char *str)
4190b39181f7SSteven Rostedt (Google) {
4191b39181f7SSteven Rostedt (Google) 	unsigned long offset;
4192b39181f7SSteven Rostedt (Google) 
4193b39181f7SSteven Rostedt (Google) 	kallsyms_lookup(ip, NULL, &offset, modname, str);
4194b39181f7SSteven Rostedt (Google) 	if (offset > FTRACE_MCOUNT_MAX_OFFSET)
4195b39181f7SSteven Rostedt (Google) 		return -1;
4196b39181f7SSteven Rostedt (Google) 	return 0;
4197b39181f7SSteven Rostedt (Google) }
4198b39181f7SSteven Rostedt (Google) #else
4199b39181f7SSteven Rostedt (Google) static int lookup_ip(unsigned long ip, char **modname, char *str)
4200b39181f7SSteven Rostedt (Google) {
4201b39181f7SSteven Rostedt (Google) 	kallsyms_lookup(ip, NULL, NULL, modname, str);
4202b39181f7SSteven Rostedt (Google) 	return 0;
4203b39181f7SSteven Rostedt (Google) }
4204b39181f7SSteven Rostedt (Google) #endif
4205b39181f7SSteven Rostedt (Google) 
4206f79b3f33SSteven Rostedt (VMware) static int
42070b507e1eSDmitry Safonov ftrace_match_record(struct dyn_ftrace *rec, struct ftrace_glob *func_g,
42080b507e1eSDmitry Safonov 		struct ftrace_glob *mod_g, int exclude_mod)
420964e7c440SSteven Rostedt {
421064e7c440SSteven Rostedt 	char str[KSYM_SYMBOL_LEN];
4211b9df92d2SSteven Rostedt 	char *modname;
421264e7c440SSteven Rostedt 
4213b39181f7SSteven Rostedt (Google) 	if (lookup_ip(rec->ip, &modname, str)) {
4214b39181f7SSteven Rostedt (Google) 		/* This should only happen when a rec is disabled */
4215b39181f7SSteven Rostedt (Google) 		WARN_ON_ONCE(system_state == SYSTEM_RUNNING &&
4216b39181f7SSteven Rostedt (Google) 			     !(rec->flags & FTRACE_FL_DISABLED));
4217b39181f7SSteven Rostedt (Google) 		return 0;
4218b39181f7SSteven Rostedt (Google) 	}
4219b9df92d2SSteven Rostedt 
42200b507e1eSDmitry Safonov 	if (mod_g) {
42210b507e1eSDmitry Safonov 		int mod_matches = (modname) ? ftrace_match(modname, mod_g) : 0;
42220b507e1eSDmitry Safonov 
42230b507e1eSDmitry Safonov 		/* blank module name to match all modules */
42240b507e1eSDmitry Safonov 		if (!mod_g->len) {
42250b507e1eSDmitry Safonov 			/* blank module globbing: modname xor exclude_mod */
422677c0eddeSSteven Rostedt (VMware) 			if (!exclude_mod != !modname)
42270b507e1eSDmitry Safonov 				goto func_match;
42280b507e1eSDmitry Safonov 			return 0;
42290b507e1eSDmitry Safonov 		}
42300b507e1eSDmitry Safonov 
423177c0eddeSSteven Rostedt (VMware) 		/*
423277c0eddeSSteven Rostedt (VMware) 		 * exclude_mod is set to trace everything but the given
423377c0eddeSSteven Rostedt (VMware) 		 * module. If it is set and the module matches, then
423477c0eddeSSteven Rostedt (VMware) 		 * return 0. If it is not set, and the module doesn't match
423577c0eddeSSteven Rostedt (VMware) 		 * also return 0. Otherwise, check the function to see if
423677c0eddeSSteven Rostedt (VMware) 		 * that matches.
423777c0eddeSSteven Rostedt (VMware) 		 */
423877c0eddeSSteven Rostedt (VMware) 		if (!mod_matches == !exclude_mod)
42390b507e1eSDmitry Safonov 			return 0;
42400b507e1eSDmitry Safonov func_match:
4241b9df92d2SSteven Rostedt 		/* blank search means to match all funcs in the mod */
42423ba00929SDmitry Safonov 		if (!func_g->len)
4243b9df92d2SSteven Rostedt 			return 1;
4244b9df92d2SSteven Rostedt 	}
4245b9df92d2SSteven Rostedt 
42463ba00929SDmitry Safonov 	return ftrace_match(str, func_g);
424764e7c440SSteven Rostedt }
424864e7c440SSteven Rostedt 
42491cf41dd7SSteven Rostedt static int
42503ba00929SDmitry Safonov match_records(struct ftrace_hash *hash, char *func, int len, char *mod)
42519f4801e3SSteven Rostedt {
42529f4801e3SSteven Rostedt 	struct ftrace_page *pg;
42539f4801e3SSteven Rostedt 	struct dyn_ftrace *rec;
42543ba00929SDmitry Safonov 	struct ftrace_glob func_g = { .type = MATCH_FULL };
42550b507e1eSDmitry Safonov 	struct ftrace_glob mod_g = { .type = MATCH_FULL };
42560b507e1eSDmitry Safonov 	struct ftrace_glob *mod_match = (mod) ? &mod_g : NULL;
42570b507e1eSDmitry Safonov 	int exclude_mod = 0;
4258311d16daSLi Zefan 	int found = 0;
4259b448c4e3SSteven Rostedt 	int ret;
42602e028c4fSDan Carpenter 	int clear_filter = 0;
42619f4801e3SSteven Rostedt 
42620b507e1eSDmitry Safonov 	if (func) {
42633ba00929SDmitry Safonov 		func_g.type = filter_parse_regex(func, len, &func_g.search,
42643ba00929SDmitry Safonov 						 &clear_filter);
42653ba00929SDmitry Safonov 		func_g.len = strlen(func_g.search);
4266b9df92d2SSteven Rostedt 	}
4267b9df92d2SSteven Rostedt 
42680b507e1eSDmitry Safonov 	if (mod) {
42690b507e1eSDmitry Safonov 		mod_g.type = filter_parse_regex(mod, strlen(mod),
42700b507e1eSDmitry Safonov 				&mod_g.search, &exclude_mod);
42710b507e1eSDmitry Safonov 		mod_g.len = strlen(mod_g.search);
4272b9df92d2SSteven Rostedt 	}
4273b9df92d2SSteven Rostedt 
427452baf119SSteven Rostedt 	mutex_lock(&ftrace_lock);
4275b9df92d2SSteven Rostedt 
4276b9df92d2SSteven Rostedt 	if (unlikely(ftrace_disabled))
4277b9df92d2SSteven Rostedt 		goto out_unlock;
4278b9df92d2SSteven Rostedt 
4279f79b3f33SSteven Rostedt (VMware) 	if (func_g.type == MATCH_INDEX) {
4280f79b3f33SSteven Rostedt (VMware) 		found = add_rec_by_index(hash, &func_g, clear_filter);
4281f79b3f33SSteven Rostedt (VMware) 		goto out_unlock;
4282f79b3f33SSteven Rostedt (VMware) 	}
4283f79b3f33SSteven Rostedt (VMware) 
4284265c831cSSteven Rostedt 	do_for_each_ftrace_rec(pg, rec) {
4285546fece4SSteven Rostedt (Red Hat) 
4286546fece4SSteven Rostedt (Red Hat) 		if (rec->flags & FTRACE_FL_DISABLED)
4287546fece4SSteven Rostedt (Red Hat) 			continue;
4288546fece4SSteven Rostedt (Red Hat) 
42890b507e1eSDmitry Safonov 		if (ftrace_match_record(rec, &func_g, mod_match, exclude_mod)) {
4290f0a3b154SDmitry Safonov 			ret = enter_record(hash, rec, clear_filter);
4291b448c4e3SSteven Rostedt 			if (ret < 0) {
4292b448c4e3SSteven Rostedt 				found = ret;
4293b448c4e3SSteven Rostedt 				goto out_unlock;
4294b448c4e3SSteven Rostedt 			}
4295311d16daSLi Zefan 			found = 1;
42965072c59fSSteven Rostedt 		}
4297d0b24b4eSGuilherme G. Piccoli 		cond_resched();
4298265c831cSSteven Rostedt 	} while_for_each_ftrace_rec();
4299b9df92d2SSteven Rostedt  out_unlock:
430052baf119SSteven Rostedt 	mutex_unlock(&ftrace_lock);
4301311d16daSLi Zefan 
4302311d16daSLi Zefan 	return found;
43035072c59fSSteven Rostedt }
43045072c59fSSteven Rostedt 
430564e7c440SSteven Rostedt static int
43061cf41dd7SSteven Rostedt ftrace_match_records(struct ftrace_hash *hash, char *buff, int len)
430764e7c440SSteven Rostedt {
4308f0a3b154SDmitry Safonov 	return match_records(hash, buff, len, NULL);
430964e7c440SSteven Rostedt }
431064e7c440SSteven Rostedt 
4311e16b35ddSSteven Rostedt (VMware) static void ftrace_ops_update_code(struct ftrace_ops *ops,
4312e16b35ddSSteven Rostedt (VMware) 				   struct ftrace_ops_hash *old_hash)
4313e16b35ddSSteven Rostedt (VMware) {
4314e16b35ddSSteven Rostedt (VMware) 	struct ftrace_ops *op;
4315e16b35ddSSteven Rostedt (VMware) 
4316e16b35ddSSteven Rostedt (VMware) 	if (!ftrace_enabled)
4317e16b35ddSSteven Rostedt (VMware) 		return;
4318e16b35ddSSteven Rostedt (VMware) 
4319e16b35ddSSteven Rostedt (VMware) 	if (ops->flags & FTRACE_OPS_FL_ENABLED) {
4320e16b35ddSSteven Rostedt (VMware) 		ftrace_run_modify_code(ops, FTRACE_UPDATE_CALLS, old_hash);
4321e16b35ddSSteven Rostedt (VMware) 		return;
4322e16b35ddSSteven Rostedt (VMware) 	}
4323e16b35ddSSteven Rostedt (VMware) 
4324e16b35ddSSteven Rostedt (VMware) 	/*
4325e16b35ddSSteven Rostedt (VMware) 	 * If this is the shared global_ops filter, then we need to
4326e16b35ddSSteven Rostedt (VMware) 	 * check if there is another ops that shares it, is enabled.
4327e16b35ddSSteven Rostedt (VMware) 	 * If so, we still need to run the modify code.
4328e16b35ddSSteven Rostedt (VMware) 	 */
4329e16b35ddSSteven Rostedt (VMware) 	if (ops->func_hash != &global_ops.local_hash)
4330e16b35ddSSteven Rostedt (VMware) 		return;
4331e16b35ddSSteven Rostedt (VMware) 
4332e16b35ddSSteven Rostedt (VMware) 	do_for_each_ftrace_op(op, ftrace_ops_list) {
4333e16b35ddSSteven Rostedt (VMware) 		if (op->func_hash == &global_ops.local_hash &&
4334e16b35ddSSteven Rostedt (VMware) 		    op->flags & FTRACE_OPS_FL_ENABLED) {
4335e16b35ddSSteven Rostedt (VMware) 			ftrace_run_modify_code(op, FTRACE_UPDATE_CALLS, old_hash);
4336e16b35ddSSteven Rostedt (VMware) 			/* Only need to do this once */
4337e16b35ddSSteven Rostedt (VMware) 			return;
4338e16b35ddSSteven Rostedt (VMware) 		}
4339e16b35ddSSteven Rostedt (VMware) 	} while_for_each_ftrace_op(op);
4340e16b35ddSSteven Rostedt (VMware) }
4341e16b35ddSSteven Rostedt (VMware) 
4342e16b35ddSSteven Rostedt (VMware) static int ftrace_hash_move_and_update_ops(struct ftrace_ops *ops,
4343e16b35ddSSteven Rostedt (VMware) 					   struct ftrace_hash **orig_hash,
4344e16b35ddSSteven Rostedt (VMware) 					   struct ftrace_hash *hash,
4345e16b35ddSSteven Rostedt (VMware) 					   int enable)
4346e16b35ddSSteven Rostedt (VMware) {
4347e16b35ddSSteven Rostedt (VMware) 	struct ftrace_ops_hash old_hash_ops;
4348e16b35ddSSteven Rostedt (VMware) 	struct ftrace_hash *old_hash;
4349e16b35ddSSteven Rostedt (VMware) 	int ret;
4350e16b35ddSSteven Rostedt (VMware) 
4351e16b35ddSSteven Rostedt (VMware) 	old_hash = *orig_hash;
4352e16b35ddSSteven Rostedt (VMware) 	old_hash_ops.filter_hash = ops->func_hash->filter_hash;
4353e16b35ddSSteven Rostedt (VMware) 	old_hash_ops.notrace_hash = ops->func_hash->notrace_hash;
4354e16b35ddSSteven Rostedt (VMware) 	ret = ftrace_hash_move(ops, enable, orig_hash, hash);
4355e16b35ddSSteven Rostedt (VMware) 	if (!ret) {
4356e16b35ddSSteven Rostedt (VMware) 		ftrace_ops_update_code(ops, &old_hash_ops);
4357e16b35ddSSteven Rostedt (VMware) 		free_ftrace_hash_rcu(old_hash);
4358e16b35ddSSteven Rostedt (VMware) 	}
4359e16b35ddSSteven Rostedt (VMware) 	return ret;
4360e16b35ddSSteven Rostedt (VMware) }
436164e7c440SSteven Rostedt 
4362673feb9dSSteven Rostedt (VMware) static bool module_exists(const char *module)
4363673feb9dSSteven Rostedt (VMware) {
4364673feb9dSSteven Rostedt (VMware) 	/* All modules have the symbol __this_module */
43650f5e5a3aSRasmus Villemoes 	static const char this_mod[] = "__this_module";
4366419e9fe5SSalvatore Mesoraca 	char modname[MAX_PARAM_PREFIX_LEN + sizeof(this_mod) + 2];
4367673feb9dSSteven Rostedt (VMware) 	unsigned long val;
4368673feb9dSSteven Rostedt (VMware) 	int n;
4369673feb9dSSteven Rostedt (VMware) 
4370419e9fe5SSalvatore Mesoraca 	n = snprintf(modname, sizeof(modname), "%s:%s", module, this_mod);
4371673feb9dSSteven Rostedt (VMware) 
4372419e9fe5SSalvatore Mesoraca 	if (n > sizeof(modname) - 1)
4373673feb9dSSteven Rostedt (VMware) 		return false;
4374673feb9dSSteven Rostedt (VMware) 
4375673feb9dSSteven Rostedt (VMware) 	val = module_kallsyms_lookup_name(modname);
4376673feb9dSSteven Rostedt (VMware) 	return val != 0;
4377673feb9dSSteven Rostedt (VMware) }
4378673feb9dSSteven Rostedt (VMware) 
4379673feb9dSSteven Rostedt (VMware) static int cache_mod(struct trace_array *tr,
4380673feb9dSSteven Rostedt (VMware) 		     const char *func, char *module, int enable)
4381673feb9dSSteven Rostedt (VMware) {
4382673feb9dSSteven Rostedt (VMware) 	struct ftrace_mod_load *ftrace_mod, *n;
4383673feb9dSSteven Rostedt (VMware) 	struct list_head *head = enable ? &tr->mod_trace : &tr->mod_notrace;
4384673feb9dSSteven Rostedt (VMware) 	int ret;
4385673feb9dSSteven Rostedt (VMware) 
4386673feb9dSSteven Rostedt (VMware) 	mutex_lock(&ftrace_lock);
4387673feb9dSSteven Rostedt (VMware) 
4388673feb9dSSteven Rostedt (VMware) 	/* We do not cache inverse filters */
4389673feb9dSSteven Rostedt (VMware) 	if (func[0] == '!') {
4390673feb9dSSteven Rostedt (VMware) 		func++;
4391673feb9dSSteven Rostedt (VMware) 		ret = -EINVAL;
4392673feb9dSSteven Rostedt (VMware) 
4393673feb9dSSteven Rostedt (VMware) 		/* Look to remove this hash */
4394673feb9dSSteven Rostedt (VMware) 		list_for_each_entry_safe(ftrace_mod, n, head, list) {
4395673feb9dSSteven Rostedt (VMware) 			if (strcmp(ftrace_mod->module, module) != 0)
4396673feb9dSSteven Rostedt (VMware) 				continue;
4397673feb9dSSteven Rostedt (VMware) 
4398673feb9dSSteven Rostedt (VMware) 			/* no func matches all */
439944925dffSDan Carpenter 			if (strcmp(func, "*") == 0 ||
4400673feb9dSSteven Rostedt (VMware) 			    (ftrace_mod->func &&
4401673feb9dSSteven Rostedt (VMware) 			     strcmp(ftrace_mod->func, func) == 0)) {
4402673feb9dSSteven Rostedt (VMware) 				ret = 0;
4403673feb9dSSteven Rostedt (VMware) 				free_ftrace_mod(ftrace_mod);
4404673feb9dSSteven Rostedt (VMware) 				continue;
4405673feb9dSSteven Rostedt (VMware) 			}
4406673feb9dSSteven Rostedt (VMware) 		}
4407673feb9dSSteven Rostedt (VMware) 		goto out;
4408673feb9dSSteven Rostedt (VMware) 	}
4409673feb9dSSteven Rostedt (VMware) 
4410673feb9dSSteven Rostedt (VMware) 	ret = -EINVAL;
4411673feb9dSSteven Rostedt (VMware) 	/* We only care about modules that have not been loaded yet */
4412673feb9dSSteven Rostedt (VMware) 	if (module_exists(module))
4413673feb9dSSteven Rostedt (VMware) 		goto out;
4414673feb9dSSteven Rostedt (VMware) 
4415673feb9dSSteven Rostedt (VMware) 	/* Save this string off, and execute it when the module is loaded */
4416673feb9dSSteven Rostedt (VMware) 	ret = ftrace_add_mod(tr, func, module, enable);
4417673feb9dSSteven Rostedt (VMware)  out:
4418673feb9dSSteven Rostedt (VMware) 	mutex_unlock(&ftrace_lock);
4419673feb9dSSteven Rostedt (VMware) 
4420673feb9dSSteven Rostedt (VMware) 	return ret;
4421673feb9dSSteven Rostedt (VMware) }
4422673feb9dSSteven Rostedt (VMware) 
4423d7fbf8dfSSteven Rostedt (VMware) static int
4424d7fbf8dfSSteven Rostedt (VMware) ftrace_set_regex(struct ftrace_ops *ops, unsigned char *buf, int len,
4425d7fbf8dfSSteven Rostedt (VMware) 		 int reset, int enable);
4426d7fbf8dfSSteven Rostedt (VMware) 
442769449bbdSArnd Bergmann #ifdef CONFIG_MODULES
4428d7fbf8dfSSteven Rostedt (VMware) static void process_mod_list(struct list_head *head, struct ftrace_ops *ops,
4429d7fbf8dfSSteven Rostedt (VMware) 			     char *mod, bool enable)
4430d7fbf8dfSSteven Rostedt (VMware) {
4431d7fbf8dfSSteven Rostedt (VMware) 	struct ftrace_mod_load *ftrace_mod, *n;
4432d7fbf8dfSSteven Rostedt (VMware) 	struct ftrace_hash **orig_hash, *new_hash;
4433d7fbf8dfSSteven Rostedt (VMware) 	LIST_HEAD(process_mods);
4434d7fbf8dfSSteven Rostedt (VMware) 	char *func;
4435d7fbf8dfSSteven Rostedt (VMware) 
4436d7fbf8dfSSteven Rostedt (VMware) 	mutex_lock(&ops->func_hash->regex_lock);
4437d7fbf8dfSSteven Rostedt (VMware) 
4438d7fbf8dfSSteven Rostedt (VMware) 	if (enable)
4439d7fbf8dfSSteven Rostedt (VMware) 		orig_hash = &ops->func_hash->filter_hash;
4440d7fbf8dfSSteven Rostedt (VMware) 	else
4441d7fbf8dfSSteven Rostedt (VMware) 		orig_hash = &ops->func_hash->notrace_hash;
4442d7fbf8dfSSteven Rostedt (VMware) 
4443d7fbf8dfSSteven Rostedt (VMware) 	new_hash = alloc_and_copy_ftrace_hash(FTRACE_HASH_DEFAULT_BITS,
4444d7fbf8dfSSteven Rostedt (VMware) 					      *orig_hash);
4445d7fbf8dfSSteven Rostedt (VMware) 	if (!new_hash)
44463b58a3c7SSteven Rostedt (VMware) 		goto out; /* warn? */
4447d7fbf8dfSSteven Rostedt (VMware) 
4448d7fbf8dfSSteven Rostedt (VMware) 	mutex_lock(&ftrace_lock);
4449d7fbf8dfSSteven Rostedt (VMware) 
4450d7fbf8dfSSteven Rostedt (VMware) 	list_for_each_entry_safe(ftrace_mod, n, head, list) {
4451d7fbf8dfSSteven Rostedt (VMware) 
4452d7fbf8dfSSteven Rostedt (VMware) 		if (strcmp(ftrace_mod->module, mod) != 0)
4453d7fbf8dfSSteven Rostedt (VMware) 			continue;
4454d7fbf8dfSSteven Rostedt (VMware) 
4455d7fbf8dfSSteven Rostedt (VMware) 		if (ftrace_mod->func)
4456d7fbf8dfSSteven Rostedt (VMware) 			func = kstrdup(ftrace_mod->func, GFP_KERNEL);
4457d7fbf8dfSSteven Rostedt (VMware) 		else
4458d7fbf8dfSSteven Rostedt (VMware) 			func = kstrdup("*", GFP_KERNEL);
4459d7fbf8dfSSteven Rostedt (VMware) 
4460d7fbf8dfSSteven Rostedt (VMware) 		if (!func) /* warn? */
4461d7fbf8dfSSteven Rostedt (VMware) 			continue;
4462d7fbf8dfSSteven Rostedt (VMware) 
44633ecda644SBaokun Li 		list_move(&ftrace_mod->list, &process_mods);
4464d7fbf8dfSSteven Rostedt (VMware) 
4465d7fbf8dfSSteven Rostedt (VMware) 		/* Use the newly allocated func, as it may be "*" */
4466d7fbf8dfSSteven Rostedt (VMware) 		kfree(ftrace_mod->func);
4467d7fbf8dfSSteven Rostedt (VMware) 		ftrace_mod->func = func;
4468d7fbf8dfSSteven Rostedt (VMware) 	}
4469d7fbf8dfSSteven Rostedt (VMware) 
4470d7fbf8dfSSteven Rostedt (VMware) 	mutex_unlock(&ftrace_lock);
4471d7fbf8dfSSteven Rostedt (VMware) 
4472d7fbf8dfSSteven Rostedt (VMware) 	list_for_each_entry_safe(ftrace_mod, n, &process_mods, list) {
4473d7fbf8dfSSteven Rostedt (VMware) 
4474d7fbf8dfSSteven Rostedt (VMware) 		func = ftrace_mod->func;
4475d7fbf8dfSSteven Rostedt (VMware) 
4476d7fbf8dfSSteven Rostedt (VMware) 		/* Grabs ftrace_lock, which is why we have this extra step */
4477d7fbf8dfSSteven Rostedt (VMware) 		match_records(new_hash, func, strlen(func), mod);
4478d7fbf8dfSSteven Rostedt (VMware) 		free_ftrace_mod(ftrace_mod);
4479d7fbf8dfSSteven Rostedt (VMware) 	}
4480d7fbf8dfSSteven Rostedt (VMware) 
44818c08f0d5SSteven Rostedt (VMware) 	if (enable && list_empty(head))
44828c08f0d5SSteven Rostedt (VMware) 		new_hash->flags &= ~FTRACE_HASH_FL_MOD;
44838c08f0d5SSteven Rostedt (VMware) 
4484d7fbf8dfSSteven Rostedt (VMware) 	mutex_lock(&ftrace_lock);
4485d7fbf8dfSSteven Rostedt (VMware) 
4486045e269cSAlex Shi 	ftrace_hash_move_and_update_ops(ops, orig_hash,
4487d7fbf8dfSSteven Rostedt (VMware) 					      new_hash, enable);
4488d7fbf8dfSSteven Rostedt (VMware) 	mutex_unlock(&ftrace_lock);
4489d7fbf8dfSSteven Rostedt (VMware) 
44903b58a3c7SSteven Rostedt (VMware)  out:
4491d7fbf8dfSSteven Rostedt (VMware) 	mutex_unlock(&ops->func_hash->regex_lock);
4492d7fbf8dfSSteven Rostedt (VMware) 
4493d7fbf8dfSSteven Rostedt (VMware) 	free_ftrace_hash(new_hash);
4494d7fbf8dfSSteven Rostedt (VMware) }
4495d7fbf8dfSSteven Rostedt (VMware) 
4496d7fbf8dfSSteven Rostedt (VMware) static void process_cached_mods(const char *mod_name)
4497d7fbf8dfSSteven Rostedt (VMware) {
4498d7fbf8dfSSteven Rostedt (VMware) 	struct trace_array *tr;
4499d7fbf8dfSSteven Rostedt (VMware) 	char *mod;
4500d7fbf8dfSSteven Rostedt (VMware) 
4501d7fbf8dfSSteven Rostedt (VMware) 	mod = kstrdup(mod_name, GFP_KERNEL);
4502d7fbf8dfSSteven Rostedt (VMware) 	if (!mod)
4503d7fbf8dfSSteven Rostedt (VMware) 		return;
4504d7fbf8dfSSteven Rostedt (VMware) 
4505d7fbf8dfSSteven Rostedt (VMware) 	mutex_lock(&trace_types_lock);
4506d7fbf8dfSSteven Rostedt (VMware) 	list_for_each_entry(tr, &ftrace_trace_arrays, list) {
4507d7fbf8dfSSteven Rostedt (VMware) 		if (!list_empty(&tr->mod_trace))
4508d7fbf8dfSSteven Rostedt (VMware) 			process_mod_list(&tr->mod_trace, tr->ops, mod, true);
4509d7fbf8dfSSteven Rostedt (VMware) 		if (!list_empty(&tr->mod_notrace))
4510d7fbf8dfSSteven Rostedt (VMware) 			process_mod_list(&tr->mod_notrace, tr->ops, mod, false);
4511d7fbf8dfSSteven Rostedt (VMware) 	}
4512d7fbf8dfSSteven Rostedt (VMware) 	mutex_unlock(&trace_types_lock);
4513d7fbf8dfSSteven Rostedt (VMware) 
4514d7fbf8dfSSteven Rostedt (VMware) 	kfree(mod);
4515d7fbf8dfSSteven Rostedt (VMware) }
451669449bbdSArnd Bergmann #endif
4517d7fbf8dfSSteven Rostedt (VMware) 
4518f6180773SSteven Rostedt /*
4519f6180773SSteven Rostedt  * We register the module command as a template to show others how
4520f6180773SSteven Rostedt  * to register the a command as well.
4521f6180773SSteven Rostedt  */
4522f6180773SSteven Rostedt 
4523f6180773SSteven Rostedt static int
452404ec7bb6SSteven Rostedt (VMware) ftrace_mod_callback(struct trace_array *tr, struct ftrace_hash *hash,
4525673feb9dSSteven Rostedt (VMware) 		    char *func_orig, char *cmd, char *module, int enable)
4526f6180773SSteven Rostedt {
4527673feb9dSSteven Rostedt (VMware) 	char *func;
45285e3949f0SDmitry Safonov 	int ret;
4529f6180773SSteven Rostedt 
4530673feb9dSSteven Rostedt (VMware) 	/* match_records() modifies func, and we need the original */
4531673feb9dSSteven Rostedt (VMware) 	func = kstrdup(func_orig, GFP_KERNEL);
4532673feb9dSSteven Rostedt (VMware) 	if (!func)
4533673feb9dSSteven Rostedt (VMware) 		return -ENOMEM;
4534673feb9dSSteven Rostedt (VMware) 
4535f6180773SSteven Rostedt 	/*
4536f6180773SSteven Rostedt 	 * cmd == 'mod' because we only registered this func
4537f6180773SSteven Rostedt 	 * for the 'mod' ftrace_func_command.
4538f6180773SSteven Rostedt 	 * But if you register one func with multiple commands,
4539f6180773SSteven Rostedt 	 * you can tell which command was used by the cmd
4540f6180773SSteven Rostedt 	 * parameter.
4541f6180773SSteven Rostedt 	 */
4542f0a3b154SDmitry Safonov 	ret = match_records(hash, func, strlen(func), module);
4543673feb9dSSteven Rostedt (VMware) 	kfree(func);
4544673feb9dSSteven Rostedt (VMware) 
4545b448c4e3SSteven Rostedt 	if (!ret)
4546673feb9dSSteven Rostedt (VMware) 		return cache_mod(tr, func_orig, module, enable);
4547b448c4e3SSteven Rostedt 	if (ret < 0)
4548b448c4e3SSteven Rostedt 		return ret;
4549f6180773SSteven Rostedt 	return 0;
4550f6180773SSteven Rostedt }
4551f6180773SSteven Rostedt 
4552f6180773SSteven Rostedt static struct ftrace_func_command ftrace_mod_cmd = {
4553f6180773SSteven Rostedt 	.name			= "mod",
4554f6180773SSteven Rostedt 	.func			= ftrace_mod_callback,
4555f6180773SSteven Rostedt };
4556f6180773SSteven Rostedt 
4557f6180773SSteven Rostedt static int __init ftrace_mod_cmd_init(void)
4558f6180773SSteven Rostedt {
4559f6180773SSteven Rostedt 	return register_ftrace_command(&ftrace_mod_cmd);
4560f6180773SSteven Rostedt }
45616f415672SSteven Rostedt core_initcall(ftrace_mod_cmd_init);
4562f6180773SSteven Rostedt 
45632f5f6ad9SSteven Rostedt static void function_trace_probe_call(unsigned long ip, unsigned long parent_ip,
4564d19ad077SSteven Rostedt (VMware) 				      struct ftrace_ops *op, struct ftrace_regs *fregs)
456559df055fSSteven Rostedt {
4566eee8ded1SSteven Rostedt (VMware) 	struct ftrace_probe_ops *probe_ops;
45677b60f3d8SSteven Rostedt (VMware) 	struct ftrace_func_probe *probe;
456859df055fSSteven Rostedt 
45697b60f3d8SSteven Rostedt (VMware) 	probe = container_of(op, struct ftrace_func_probe, ops);
45707b60f3d8SSteven Rostedt (VMware) 	probe_ops = probe->probe_ops;
457159df055fSSteven Rostedt 
457259df055fSSteven Rostedt 	/*
457359df055fSSteven Rostedt 	 * Disable preemption for these calls to prevent a RCU grace
457459df055fSSteven Rostedt 	 * period. This syncs the hash iteration and freeing of items
457559df055fSSteven Rostedt 	 * on the hash. rcu_read_lock is too dangerous here.
457659df055fSSteven Rostedt 	 */
45775168ae50SSteven Rostedt 	preempt_disable_notrace();
45786e444319SSteven Rostedt (VMware) 	probe_ops->func(ip, parent_ip, probe->tr, probe_ops, probe->data);
45795168ae50SSteven Rostedt 	preempt_enable_notrace();
458059df055fSSteven Rostedt }
458159df055fSSteven Rostedt 
458241794f19SSteven Rostedt (VMware) struct ftrace_func_map {
458341794f19SSteven Rostedt (VMware) 	struct ftrace_func_entry	entry;
458441794f19SSteven Rostedt (VMware) 	void				*data;
458559df055fSSteven Rostedt };
458659df055fSSteven Rostedt 
458741794f19SSteven Rostedt (VMware) struct ftrace_func_mapper {
458841794f19SSteven Rostedt (VMware) 	struct ftrace_hash		hash;
458941794f19SSteven Rostedt (VMware) };
459059df055fSSteven Rostedt 
459141794f19SSteven Rostedt (VMware) /**
459241794f19SSteven Rostedt (VMware)  * allocate_ftrace_func_mapper - allocate a new ftrace_func_mapper
459341794f19SSteven Rostedt (VMware)  *
459441794f19SSteven Rostedt (VMware)  * Returns a ftrace_func_mapper descriptor that can be used to map ips to data.
459541794f19SSteven Rostedt (VMware)  */
459641794f19SSteven Rostedt (VMware) struct ftrace_func_mapper *allocate_ftrace_func_mapper(void)
459759df055fSSteven Rostedt {
4598e1df4cb6SSteven Rostedt (Red Hat) 	struct ftrace_hash *hash;
459959df055fSSteven Rostedt 
460041794f19SSteven Rostedt (VMware) 	/*
460141794f19SSteven Rostedt (VMware) 	 * The mapper is simply a ftrace_hash, but since the entries
460241794f19SSteven Rostedt (VMware) 	 * in the hash are not ftrace_func_entry type, we define it
460341794f19SSteven Rostedt (VMware) 	 * as a separate structure.
460441794f19SSteven Rostedt (VMware) 	 */
460541794f19SSteven Rostedt (VMware) 	hash = alloc_ftrace_hash(FTRACE_HASH_DEFAULT_BITS);
460641794f19SSteven Rostedt (VMware) 	return (struct ftrace_func_mapper *)hash;
4607e1df4cb6SSteven Rostedt (Red Hat) }
4608e1df4cb6SSteven Rostedt (Red Hat) 
460941794f19SSteven Rostedt (VMware) /**
461041794f19SSteven Rostedt (VMware)  * ftrace_func_mapper_find_ip - Find some data mapped to an ip
461141794f19SSteven Rostedt (VMware)  * @mapper: The mapper that has the ip maps
461241794f19SSteven Rostedt (VMware)  * @ip: the instruction pointer to find the data for
461341794f19SSteven Rostedt (VMware)  *
461441794f19SSteven Rostedt (VMware)  * Returns the data mapped to @ip if found otherwise NULL. The return
461541794f19SSteven Rostedt (VMware)  * is actually the address of the mapper data pointer. The address is
461641794f19SSteven Rostedt (VMware)  * returned for use cases where the data is no bigger than a long, and
461741794f19SSteven Rostedt (VMware)  * the user can use the data pointer as its data instead of having to
461841794f19SSteven Rostedt (VMware)  * allocate more memory for the reference.
461941794f19SSteven Rostedt (VMware)  */
462041794f19SSteven Rostedt (VMware) void **ftrace_func_mapper_find_ip(struct ftrace_func_mapper *mapper,
462141794f19SSteven Rostedt (VMware) 				  unsigned long ip)
462241794f19SSteven Rostedt (VMware) {
462341794f19SSteven Rostedt (VMware) 	struct ftrace_func_entry *entry;
462441794f19SSteven Rostedt (VMware) 	struct ftrace_func_map *map;
462541794f19SSteven Rostedt (VMware) 
462641794f19SSteven Rostedt (VMware) 	entry = ftrace_lookup_ip(&mapper->hash, ip);
462741794f19SSteven Rostedt (VMware) 	if (!entry)
462841794f19SSteven Rostedt (VMware) 		return NULL;
462941794f19SSteven Rostedt (VMware) 
463041794f19SSteven Rostedt (VMware) 	map = (struct ftrace_func_map *)entry;
463141794f19SSteven Rostedt (VMware) 	return &map->data;
4632e1df4cb6SSteven Rostedt (Red Hat) }
463345a4a237SSteven Rostedt 
463441794f19SSteven Rostedt (VMware) /**
463541794f19SSteven Rostedt (VMware)  * ftrace_func_mapper_add_ip - Map some data to an ip
463641794f19SSteven Rostedt (VMware)  * @mapper: The mapper that has the ip maps
463741794f19SSteven Rostedt (VMware)  * @ip: The instruction pointer address to map @data to
463841794f19SSteven Rostedt (VMware)  * @data: The data to map to @ip
463941794f19SSteven Rostedt (VMware)  *
4640fdda88d3SQiujun Huang  * Returns 0 on success otherwise an error.
464141794f19SSteven Rostedt (VMware)  */
464241794f19SSteven Rostedt (VMware) int ftrace_func_mapper_add_ip(struct ftrace_func_mapper *mapper,
464341794f19SSteven Rostedt (VMware) 			      unsigned long ip, void *data)
464441794f19SSteven Rostedt (VMware) {
464541794f19SSteven Rostedt (VMware) 	struct ftrace_func_entry *entry;
464641794f19SSteven Rostedt (VMware) 	struct ftrace_func_map *map;
464741794f19SSteven Rostedt (VMware) 
464841794f19SSteven Rostedt (VMware) 	entry = ftrace_lookup_ip(&mapper->hash, ip);
464941794f19SSteven Rostedt (VMware) 	if (entry)
465041794f19SSteven Rostedt (VMware) 		return -EBUSY;
465141794f19SSteven Rostedt (VMware) 
465241794f19SSteven Rostedt (VMware) 	map = kmalloc(sizeof(*map), GFP_KERNEL);
465341794f19SSteven Rostedt (VMware) 	if (!map)
465441794f19SSteven Rostedt (VMware) 		return -ENOMEM;
465541794f19SSteven Rostedt (VMware) 
465641794f19SSteven Rostedt (VMware) 	map->entry.ip = ip;
465741794f19SSteven Rostedt (VMware) 	map->data = data;
465841794f19SSteven Rostedt (VMware) 
465941794f19SSteven Rostedt (VMware) 	__add_hash_entry(&mapper->hash, &map->entry);
466041794f19SSteven Rostedt (VMware) 
466141794f19SSteven Rostedt (VMware) 	return 0;
466241794f19SSteven Rostedt (VMware) }
466341794f19SSteven Rostedt (VMware) 
466441794f19SSteven Rostedt (VMware) /**
466541794f19SSteven Rostedt (VMware)  * ftrace_func_mapper_remove_ip - Remove an ip from the mapping
466641794f19SSteven Rostedt (VMware)  * @mapper: The mapper that has the ip maps
466741794f19SSteven Rostedt (VMware)  * @ip: The instruction pointer address to remove the data from
466841794f19SSteven Rostedt (VMware)  *
466941794f19SSteven Rostedt (VMware)  * Returns the data if it is found, otherwise NULL.
467041794f19SSteven Rostedt (VMware)  * Note, if the data pointer is used as the data itself, (see
467141794f19SSteven Rostedt (VMware)  * ftrace_func_mapper_find_ip(), then the return value may be meaningless,
467241794f19SSteven Rostedt (VMware)  * if the data pointer was set to zero.
467341794f19SSteven Rostedt (VMware)  */
467441794f19SSteven Rostedt (VMware) void *ftrace_func_mapper_remove_ip(struct ftrace_func_mapper *mapper,
467541794f19SSteven Rostedt (VMware) 				   unsigned long ip)
467641794f19SSteven Rostedt (VMware) {
467741794f19SSteven Rostedt (VMware) 	struct ftrace_func_entry *entry;
467841794f19SSteven Rostedt (VMware) 	struct ftrace_func_map *map;
467941794f19SSteven Rostedt (VMware) 	void *data;
468041794f19SSteven Rostedt (VMware) 
468141794f19SSteven Rostedt (VMware) 	entry = ftrace_lookup_ip(&mapper->hash, ip);
468241794f19SSteven Rostedt (VMware) 	if (!entry)
468341794f19SSteven Rostedt (VMware) 		return NULL;
468441794f19SSteven Rostedt (VMware) 
468541794f19SSteven Rostedt (VMware) 	map = (struct ftrace_func_map *)entry;
468641794f19SSteven Rostedt (VMware) 	data = map->data;
468741794f19SSteven Rostedt (VMware) 
468841794f19SSteven Rostedt (VMware) 	remove_hash_entry(&mapper->hash, entry);
468941794f19SSteven Rostedt (VMware) 	kfree(entry);
469041794f19SSteven Rostedt (VMware) 
469141794f19SSteven Rostedt (VMware) 	return data;
469241794f19SSteven Rostedt (VMware) }
469341794f19SSteven Rostedt (VMware) 
469441794f19SSteven Rostedt (VMware) /**
469541794f19SSteven Rostedt (VMware)  * free_ftrace_func_mapper - free a mapping of ips and data
469641794f19SSteven Rostedt (VMware)  * @mapper: The mapper that has the ip maps
469741794f19SSteven Rostedt (VMware)  * @free_func: A function to be called on each data item.
469841794f19SSteven Rostedt (VMware)  *
469941794f19SSteven Rostedt (VMware)  * This is used to free the function mapper. The @free_func is optional
470041794f19SSteven Rostedt (VMware)  * and can be used if the data needs to be freed as well.
470141794f19SSteven Rostedt (VMware)  */
470241794f19SSteven Rostedt (VMware) void free_ftrace_func_mapper(struct ftrace_func_mapper *mapper,
470341794f19SSteven Rostedt (VMware) 			     ftrace_mapper_func free_func)
470441794f19SSteven Rostedt (VMware) {
470541794f19SSteven Rostedt (VMware) 	struct ftrace_func_entry *entry;
470641794f19SSteven Rostedt (VMware) 	struct ftrace_func_map *map;
470741794f19SSteven Rostedt (VMware) 	struct hlist_head *hhd;
470804e03d9aSWei Li 	int size, i;
470904e03d9aSWei Li 
471004e03d9aSWei Li 	if (!mapper)
471104e03d9aSWei Li 		return;
471241794f19SSteven Rostedt (VMware) 
471341794f19SSteven Rostedt (VMware) 	if (free_func && mapper->hash.count) {
471404e03d9aSWei Li 		size = 1 << mapper->hash.size_bits;
471541794f19SSteven Rostedt (VMware) 		for (i = 0; i < size; i++) {
471641794f19SSteven Rostedt (VMware) 			hhd = &mapper->hash.buckets[i];
471741794f19SSteven Rostedt (VMware) 			hlist_for_each_entry(entry, hhd, hlist) {
471841794f19SSteven Rostedt (VMware) 				map = (struct ftrace_func_map *)entry;
471941794f19SSteven Rostedt (VMware) 				free_func(map);
472041794f19SSteven Rostedt (VMware) 			}
472141794f19SSteven Rostedt (VMware) 		}
472241794f19SSteven Rostedt (VMware) 	}
472341794f19SSteven Rostedt (VMware) 	free_ftrace_hash(&mapper->hash);
472441794f19SSteven Rostedt (VMware) }
472541794f19SSteven Rostedt (VMware) 
47267b60f3d8SSteven Rostedt (VMware) static void release_probe(struct ftrace_func_probe *probe)
47277b60f3d8SSteven Rostedt (VMware) {
47287b60f3d8SSteven Rostedt (VMware) 	struct ftrace_probe_ops *probe_ops;
47297b60f3d8SSteven Rostedt (VMware) 
47305ae0bf59SSteven Rostedt (Red Hat) 	mutex_lock(&ftrace_lock);
47315ae0bf59SSteven Rostedt (Red Hat) 
47327b60f3d8SSteven Rostedt (VMware) 	WARN_ON(probe->ref <= 0);
473359df055fSSteven Rostedt 
47347b60f3d8SSteven Rostedt (VMware) 	/* Subtract the ref that was used to protect this instance */
47357b60f3d8SSteven Rostedt (VMware) 	probe->ref--;
4736546fece4SSteven Rostedt (Red Hat) 
47377b60f3d8SSteven Rostedt (VMware) 	if (!probe->ref) {
47387b60f3d8SSteven Rostedt (VMware) 		probe_ops = probe->probe_ops;
47396e444319SSteven Rostedt (VMware) 		/*
47406e444319SSteven Rostedt (VMware) 		 * Sending zero as ip tells probe_ops to free
47416e444319SSteven Rostedt (VMware) 		 * the probe->data itself
47426e444319SSteven Rostedt (VMware) 		 */
47436e444319SSteven Rostedt (VMware) 		if (probe_ops->free)
47446e444319SSteven Rostedt (VMware) 			probe_ops->free(probe_ops, probe->tr, 0, probe->data);
47457b60f3d8SSteven Rostedt (VMware) 		list_del(&probe->list);
47467b60f3d8SSteven Rostedt (VMware) 		kfree(probe);
47477b60f3d8SSteven Rostedt (VMware) 	}
47487b60f3d8SSteven Rostedt (VMware) 	mutex_unlock(&ftrace_lock);
474959df055fSSteven Rostedt }
475059df055fSSteven Rostedt 
47517b60f3d8SSteven Rostedt (VMware) static void acquire_probe_locked(struct ftrace_func_probe *probe)
47527b60f3d8SSteven Rostedt (VMware) {
47537b60f3d8SSteven Rostedt (VMware) 	/*
47547b60f3d8SSteven Rostedt (VMware) 	 * Add one ref to keep it from being freed when releasing the
47557b60f3d8SSteven Rostedt (VMware) 	 * ftrace_lock mutex.
47567b60f3d8SSteven Rostedt (VMware) 	 */
47577b60f3d8SSteven Rostedt (VMware) 	probe->ref++;
47587b60f3d8SSteven Rostedt (VMware) }
475959df055fSSteven Rostedt 
476059df055fSSteven Rostedt int
476104ec7bb6SSteven Rostedt (VMware) register_ftrace_function_probe(char *glob, struct trace_array *tr,
47627b60f3d8SSteven Rostedt (VMware) 			       struct ftrace_probe_ops *probe_ops,
47637b60f3d8SSteven Rostedt (VMware) 			       void *data)
476459df055fSSteven Rostedt {
4765ba27d855SJakob Koschel 	struct ftrace_func_probe *probe = NULL, *iter;
47661ec3a81aSSteven Rostedt (VMware) 	struct ftrace_func_entry *entry;
47671ec3a81aSSteven Rostedt (VMware) 	struct ftrace_hash **orig_hash;
47681ec3a81aSSteven Rostedt (VMware) 	struct ftrace_hash *old_hash;
476959df055fSSteven Rostedt 	struct ftrace_hash *hash;
477059df055fSSteven Rostedt 	int count = 0;
47711ec3a81aSSteven Rostedt (VMware) 	int size;
477259df055fSSteven Rostedt 	int ret;
47731ec3a81aSSteven Rostedt (VMware) 	int i;
477459df055fSSteven Rostedt 
477504ec7bb6SSteven Rostedt (VMware) 	if (WARN_ON(!tr))
477604ec7bb6SSteven Rostedt (VMware) 		return -EINVAL;
477704ec7bb6SSteven Rostedt (VMware) 
47781ec3a81aSSteven Rostedt (VMware) 	/* We do not support '!' for function probes */
47791ec3a81aSSteven Rostedt (VMware) 	if (WARN_ON(glob[0] == '!'))
478059df055fSSteven Rostedt 		return -EINVAL;
478159df055fSSteven Rostedt 
47827b60f3d8SSteven Rostedt (VMware) 
47837b60f3d8SSteven Rostedt (VMware) 	mutex_lock(&ftrace_lock);
47847b60f3d8SSteven Rostedt (VMware) 	/* Check if the probe_ops is already registered */
4785ba27d855SJakob Koschel 	list_for_each_entry(iter, &tr->func_probes, list) {
4786ba27d855SJakob Koschel 		if (iter->probe_ops == probe_ops) {
4787ba27d855SJakob Koschel 			probe = iter;
47887b60f3d8SSteven Rostedt (VMware) 			break;
47897b60f3d8SSteven Rostedt (VMware) 		}
4790ba27d855SJakob Koschel 	}
4791ba27d855SJakob Koschel 	if (!probe) {
47927b60f3d8SSteven Rostedt (VMware) 		probe = kzalloc(sizeof(*probe), GFP_KERNEL);
47937b60f3d8SSteven Rostedt (VMware) 		if (!probe) {
47947b60f3d8SSteven Rostedt (VMware) 			mutex_unlock(&ftrace_lock);
47957b60f3d8SSteven Rostedt (VMware) 			return -ENOMEM;
47967b60f3d8SSteven Rostedt (VMware) 		}
47977b60f3d8SSteven Rostedt (VMware) 		probe->probe_ops = probe_ops;
47987b60f3d8SSteven Rostedt (VMware) 		probe->ops.func = function_trace_probe_call;
47997b60f3d8SSteven Rostedt (VMware) 		probe->tr = tr;
48007b60f3d8SSteven Rostedt (VMware) 		ftrace_ops_init(&probe->ops);
48017b60f3d8SSteven Rostedt (VMware) 		list_add(&probe->list, &tr->func_probes);
48021ec3a81aSSteven Rostedt (VMware) 	}
480359df055fSSteven Rostedt 
48047b60f3d8SSteven Rostedt (VMware) 	acquire_probe_locked(probe);
480559df055fSSteven Rostedt 
48067b60f3d8SSteven Rostedt (VMware) 	mutex_unlock(&ftrace_lock);
48077b60f3d8SSteven Rostedt (VMware) 
4808372e0d01SSteven Rostedt (VMware) 	/*
4809372e0d01SSteven Rostedt (VMware) 	 * Note, there's a small window here that the func_hash->filter_hash
4810fdda88d3SQiujun Huang 	 * may be NULL or empty. Need to be careful when reading the loop.
4811372e0d01SSteven Rostedt (VMware) 	 */
48127b60f3d8SSteven Rostedt (VMware) 	mutex_lock(&probe->ops.func_hash->regex_lock);
48137b60f3d8SSteven Rostedt (VMware) 
48147b60f3d8SSteven Rostedt (VMware) 	orig_hash = &probe->ops.func_hash->filter_hash;
48151ec3a81aSSteven Rostedt (VMware) 	old_hash = *orig_hash;
481659df055fSSteven Rostedt 	hash = alloc_and_copy_ftrace_hash(FTRACE_HASH_DEFAULT_BITS, old_hash);
48171ec3a81aSSteven Rostedt (VMware) 
48185b0022ddSNaveen N. Rao 	if (!hash) {
48195b0022ddSNaveen N. Rao 		ret = -ENOMEM;
48205b0022ddSNaveen N. Rao 		goto out;
48215b0022ddSNaveen N. Rao 	}
48225b0022ddSNaveen N. Rao 
48231ec3a81aSSteven Rostedt (VMware) 	ret = ftrace_match_records(hash, glob, strlen(glob));
48241ec3a81aSSteven Rostedt (VMware) 
48251ec3a81aSSteven Rostedt (VMware) 	/* Nothing found? */
48261ec3a81aSSteven Rostedt (VMware) 	if (!ret)
48271ec3a81aSSteven Rostedt (VMware) 		ret = -EINVAL;
48281ec3a81aSSteven Rostedt (VMware) 
48291ec3a81aSSteven Rostedt (VMware) 	if (ret < 0)
483059df055fSSteven Rostedt 		goto out;
483159df055fSSteven Rostedt 
48321ec3a81aSSteven Rostedt (VMware) 	size = 1 << hash->size_bits;
48331ec3a81aSSteven Rostedt (VMware) 	for (i = 0; i < size; i++) {
48341ec3a81aSSteven Rostedt (VMware) 		hlist_for_each_entry(entry, &hash->buckets[i], hlist) {
48351ec3a81aSSteven Rostedt (VMware) 			if (ftrace_lookup_ip(old_hash, entry->ip))
483659df055fSSteven Rostedt 				continue;
483759df055fSSteven Rostedt 			/*
483859df055fSSteven Rostedt 			 * The caller might want to do something special
483959df055fSSteven Rostedt 			 * for each function we find. We call the callback
484059df055fSSteven Rostedt 			 * to give the caller an opportunity to do so.
484159df055fSSteven Rostedt 			 */
48427b60f3d8SSteven Rostedt (VMware) 			if (probe_ops->init) {
48437b60f3d8SSteven Rostedt (VMware) 				ret = probe_ops->init(probe_ops, tr,
48446e444319SSteven Rostedt (VMware) 						      entry->ip, data,
48456e444319SSteven Rostedt (VMware) 						      &probe->data);
48466e444319SSteven Rostedt (VMware) 				if (ret < 0) {
48476e444319SSteven Rostedt (VMware) 					if (probe_ops->free && count)
48486e444319SSteven Rostedt (VMware) 						probe_ops->free(probe_ops, tr,
48496e444319SSteven Rostedt (VMware) 								0, probe->data);
48506e444319SSteven Rostedt (VMware) 					probe->data = NULL;
4851eee8ded1SSteven Rostedt (VMware) 					goto out;
48521ec3a81aSSteven Rostedt (VMware) 				}
48536e444319SSteven Rostedt (VMware) 			}
48541ec3a81aSSteven Rostedt (VMware) 			count++;
485559df055fSSteven Rostedt 		}
485659df055fSSteven Rostedt 	}
485759df055fSSteven Rostedt 
48581ec3a81aSSteven Rostedt (VMware) 	mutex_lock(&ftrace_lock);
48591ec3a81aSSteven Rostedt (VMware) 
48607b60f3d8SSteven Rostedt (VMware) 	if (!count) {
48617b60f3d8SSteven Rostedt (VMware) 		/* Nothing was added? */
48627b60f3d8SSteven Rostedt (VMware) 		ret = -EINVAL;
4863e1df4cb6SSteven Rostedt (Red Hat) 		goto out_unlock;
4864e1df4cb6SSteven Rostedt (Red Hat) 	}
4865e1df4cb6SSteven Rostedt (Red Hat) 
48667b60f3d8SSteven Rostedt (VMware) 	ret = ftrace_hash_move_and_update_ops(&probe->ops, orig_hash,
48671ec3a81aSSteven Rostedt (VMware) 					      hash, 1);
48681ec3a81aSSteven Rostedt (VMware) 	if (ret < 0)
48698d70725eSSteven Rostedt (VMware) 		goto err_unlock;
487059df055fSSteven Rostedt 
48717b60f3d8SSteven Rostedt (VMware) 	/* One ref for each new function traced */
48727b60f3d8SSteven Rostedt (VMware) 	probe->ref += count;
487359df055fSSteven Rostedt 
48747b60f3d8SSteven Rostedt (VMware) 	if (!(probe->ops.flags & FTRACE_OPS_FL_ENABLED))
48757b60f3d8SSteven Rostedt (VMware) 		ret = ftrace_startup(&probe->ops, 0);
4876e1df4cb6SSteven Rostedt (Red Hat) 
487759df055fSSteven Rostedt  out_unlock:
48785ae0bf59SSteven Rostedt (Red Hat) 	mutex_unlock(&ftrace_lock);
487959df055fSSteven Rostedt 
488059df055fSSteven Rostedt 	if (!ret)
48811ec3a81aSSteven Rostedt (VMware) 		ret = count;
48825ae0bf59SSteven Rostedt (Red Hat)  out:
48837b60f3d8SSteven Rostedt (VMware) 	mutex_unlock(&probe->ops.func_hash->regex_lock);
4884e1df4cb6SSteven Rostedt (Red Hat) 	free_ftrace_hash(hash);
488559df055fSSteven Rostedt 
48867b60f3d8SSteven Rostedt (VMware) 	release_probe(probe);
48877b60f3d8SSteven Rostedt (VMware) 
48881ec3a81aSSteven Rostedt (VMware) 	return ret;
48898d70725eSSteven Rostedt (VMware) 
48908d70725eSSteven Rostedt (VMware)  err_unlock:
48917b60f3d8SSteven Rostedt (VMware) 	if (!probe_ops->free || !count)
48928d70725eSSteven Rostedt (VMware) 		goto out_unlock;
48938d70725eSSteven Rostedt (VMware) 
48948d70725eSSteven Rostedt (VMware) 	/* Failed to do the move, need to call the free functions */
48958d70725eSSteven Rostedt (VMware) 	for (i = 0; i < size; i++) {
48968d70725eSSteven Rostedt (VMware) 		hlist_for_each_entry(entry, &hash->buckets[i], hlist) {
48978d70725eSSteven Rostedt (VMware) 			if (ftrace_lookup_ip(old_hash, entry->ip))
48988d70725eSSteven Rostedt (VMware) 				continue;
48996e444319SSteven Rostedt (VMware) 			probe_ops->free(probe_ops, tr, entry->ip, probe->data);
49008d70725eSSteven Rostedt (VMware) 		}
49018d70725eSSteven Rostedt (VMware) 	}
49028d70725eSSteven Rostedt (VMware) 	goto out_unlock;
490359df055fSSteven Rostedt }
490459df055fSSteven Rostedt 
4905d3d532d7SSteven Rostedt (VMware) int
49067b60f3d8SSteven Rostedt (VMware) unregister_ftrace_function_probe_func(char *glob, struct trace_array *tr,
49077b60f3d8SSteven Rostedt (VMware) 				      struct ftrace_probe_ops *probe_ops)
490859df055fSSteven Rostedt {
4909ba27d855SJakob Koschel 	struct ftrace_func_probe *probe = NULL, *iter;
491082cc4fc2SSteven Rostedt (VMware) 	struct ftrace_ops_hash old_hash_ops;
4911eee8ded1SSteven Rostedt (VMware) 	struct ftrace_func_entry *entry;
49123ba00929SDmitry Safonov 	struct ftrace_glob func_g;
49131ec3a81aSSteven Rostedt (VMware) 	struct ftrace_hash **orig_hash;
49141ec3a81aSSteven Rostedt (VMware) 	struct ftrace_hash *old_hash;
49151ec3a81aSSteven Rostedt (VMware) 	struct ftrace_hash *hash = NULL;
4916b67bfe0dSSasha Levin 	struct hlist_node *tmp;
4917eee8ded1SSteven Rostedt (VMware) 	struct hlist_head hhd;
491859df055fSSteven Rostedt 	char str[KSYM_SYMBOL_LEN];
49197b60f3d8SSteven Rostedt (VMware) 	int count = 0;
49207b60f3d8SSteven Rostedt (VMware) 	int i, ret = -ENODEV;
4921eee8ded1SSteven Rostedt (VMware) 	int size;
492259df055fSSteven Rostedt 
4923cbab567cSNaveen N. Rao 	if (!glob || !strlen(glob) || !strcmp(glob, "*"))
49243ba00929SDmitry Safonov 		func_g.search = NULL;
4925cbab567cSNaveen N. Rao 	else {
492659df055fSSteven Rostedt 		int not;
492759df055fSSteven Rostedt 
49283ba00929SDmitry Safonov 		func_g.type = filter_parse_regex(glob, strlen(glob),
49293ba00929SDmitry Safonov 						 &func_g.search, &not);
49303ba00929SDmitry Safonov 		func_g.len = strlen(func_g.search);
493159df055fSSteven Rostedt 
4932b6887d79SSteven Rostedt 		/* we do not support '!' for function probes */
493359df055fSSteven Rostedt 		if (WARN_ON(not))
4934d3d532d7SSteven Rostedt (VMware) 			return -EINVAL;
493559df055fSSteven Rostedt 	}
493659df055fSSteven Rostedt 
49377b60f3d8SSteven Rostedt (VMware) 	mutex_lock(&ftrace_lock);
49387b60f3d8SSteven Rostedt (VMware) 	/* Check if the probe_ops is already registered */
4939ba27d855SJakob Koschel 	list_for_each_entry(iter, &tr->func_probes, list) {
4940ba27d855SJakob Koschel 		if (iter->probe_ops == probe_ops) {
4941ba27d855SJakob Koschel 			probe = iter;
49427b60f3d8SSteven Rostedt (VMware) 			break;
49437b60f3d8SSteven Rostedt (VMware) 		}
4944ba27d855SJakob Koschel 	}
4945ba27d855SJakob Koschel 	if (!probe)
49467b60f3d8SSteven Rostedt (VMware) 		goto err_unlock_ftrace;
49471ec3a81aSSteven Rostedt (VMware) 
49481ec3a81aSSteven Rostedt (VMware) 	ret = -EINVAL;
49497b60f3d8SSteven Rostedt (VMware) 	if (!(probe->ops.flags & FTRACE_OPS_FL_INITIALIZED))
49507b60f3d8SSteven Rostedt (VMware) 		goto err_unlock_ftrace;
49517b60f3d8SSteven Rostedt (VMware) 
49527b60f3d8SSteven Rostedt (VMware) 	acquire_probe_locked(probe);
49537b60f3d8SSteven Rostedt (VMware) 
49547b60f3d8SSteven Rostedt (VMware) 	mutex_unlock(&ftrace_lock);
49557b60f3d8SSteven Rostedt (VMware) 
49567b60f3d8SSteven Rostedt (VMware) 	mutex_lock(&probe->ops.func_hash->regex_lock);
49577b60f3d8SSteven Rostedt (VMware) 
49587b60f3d8SSteven Rostedt (VMware) 	orig_hash = &probe->ops.func_hash->filter_hash;
49597b60f3d8SSteven Rostedt (VMware) 	old_hash = *orig_hash;
49607b60f3d8SSteven Rostedt (VMware) 
49611ec3a81aSSteven Rostedt (VMware) 	if (ftrace_hash_empty(old_hash))
49621ec3a81aSSteven Rostedt (VMware) 		goto out_unlock;
4963e1df4cb6SSteven Rostedt (Red Hat) 
496482cc4fc2SSteven Rostedt (VMware) 	old_hash_ops.filter_hash = old_hash;
496582cc4fc2SSteven Rostedt (VMware) 	/* Probes only have filters */
496682cc4fc2SSteven Rostedt (VMware) 	old_hash_ops.notrace_hash = NULL;
496782cc4fc2SSteven Rostedt (VMware) 
4968d3d532d7SSteven Rostedt (VMware) 	ret = -ENOMEM;
49691ec3a81aSSteven Rostedt (VMware) 	hash = alloc_and_copy_ftrace_hash(FTRACE_HASH_DEFAULT_BITS, old_hash);
4970e1df4cb6SSteven Rostedt (Red Hat) 	if (!hash)
4971e1df4cb6SSteven Rostedt (Red Hat) 		goto out_unlock;
4972e1df4cb6SSteven Rostedt (Red Hat) 
4973eee8ded1SSteven Rostedt (VMware) 	INIT_HLIST_HEAD(&hhd);
49747818b388SSteven Rostedt (Red Hat) 
4975eee8ded1SSteven Rostedt (VMware) 	size = 1 << hash->size_bits;
4976eee8ded1SSteven Rostedt (VMware) 	for (i = 0; i < size; i++) {
4977eee8ded1SSteven Rostedt (VMware) 		hlist_for_each_entry_safe(entry, tmp, &hash->buckets[i], hlist) {
497859df055fSSteven Rostedt 
49793ba00929SDmitry Safonov 			if (func_g.search) {
498059df055fSSteven Rostedt 				kallsyms_lookup(entry->ip, NULL, NULL,
498159df055fSSteven Rostedt 						NULL, str);
49823ba00929SDmitry Safonov 				if (!ftrace_match(str, &func_g))
498359df055fSSteven Rostedt 					continue;
498459df055fSSteven Rostedt 			}
49857b60f3d8SSteven Rostedt (VMware) 			count++;
4986eee8ded1SSteven Rostedt (VMware) 			remove_hash_entry(hash, entry);
4987eee8ded1SSteven Rostedt (VMware) 			hlist_add_head(&entry->hlist, &hhd);
498859df055fSSteven Rostedt 		}
498959df055fSSteven Rostedt 	}
4990d3d532d7SSteven Rostedt (VMware) 
4991d3d532d7SSteven Rostedt (VMware) 	/* Nothing found? */
49927b60f3d8SSteven Rostedt (VMware) 	if (!count) {
4993d3d532d7SSteven Rostedt (VMware) 		ret = -EINVAL;
4994d3d532d7SSteven Rostedt (VMware) 		goto out_unlock;
4995d3d532d7SSteven Rostedt (VMware) 	}
4996d3d532d7SSteven Rostedt (VMware) 
49973f2367baSMasami Hiramatsu 	mutex_lock(&ftrace_lock);
49981ec3a81aSSteven Rostedt (VMware) 
49997b60f3d8SSteven Rostedt (VMware) 	WARN_ON(probe->ref < count);
5000eee8ded1SSteven Rostedt (VMware) 
50017b60f3d8SSteven Rostedt (VMware) 	probe->ref -= count;
50021ec3a81aSSteven Rostedt (VMware) 
50037b60f3d8SSteven Rostedt (VMware) 	if (ftrace_hash_empty(hash))
50047b60f3d8SSteven Rostedt (VMware) 		ftrace_shutdown(&probe->ops, 0);
50057b60f3d8SSteven Rostedt (VMware) 
50067b60f3d8SSteven Rostedt (VMware) 	ret = ftrace_hash_move_and_update_ops(&probe->ops, orig_hash,
50071ec3a81aSSteven Rostedt (VMware) 					      hash, 1);
500882cc4fc2SSteven Rostedt (VMware) 
500982cc4fc2SSteven Rostedt (VMware) 	/* still need to update the function call sites */
50101ec3a81aSSteven Rostedt (VMware) 	if (ftrace_enabled && !ftrace_hash_empty(hash))
50117b60f3d8SSteven Rostedt (VMware) 		ftrace_run_modify_code(&probe->ops, FTRACE_UPDATE_CALLS,
501282cc4fc2SSteven Rostedt (VMware) 				       &old_hash_ops);
501374401729SPaul E. McKenney 	synchronize_rcu();
50143296fc4eSSteven Rostedt (Red Hat) 
5015eee8ded1SSteven Rostedt (VMware) 	hlist_for_each_entry_safe(entry, tmp, &hhd, hlist) {
5016eee8ded1SSteven Rostedt (VMware) 		hlist_del(&entry->hlist);
50177b60f3d8SSteven Rostedt (VMware) 		if (probe_ops->free)
50186e444319SSteven Rostedt (VMware) 			probe_ops->free(probe_ops, tr, entry->ip, probe->data);
5019eee8ded1SSteven Rostedt (VMware) 		kfree(entry);
50207818b388SSteven Rostedt (Red Hat) 	}
50213f2367baSMasami Hiramatsu 	mutex_unlock(&ftrace_lock);
50227818b388SSteven Rostedt (Red Hat) 
5023e1df4cb6SSteven Rostedt (Red Hat)  out_unlock:
50247b60f3d8SSteven Rostedt (VMware) 	mutex_unlock(&probe->ops.func_hash->regex_lock);
5025e1df4cb6SSteven Rostedt (Red Hat) 	free_ftrace_hash(hash);
502659df055fSSteven Rostedt 
50277b60f3d8SSteven Rostedt (VMware) 	release_probe(probe);
502859df055fSSteven Rostedt 
50297b60f3d8SSteven Rostedt (VMware) 	return ret;
503059df055fSSteven Rostedt 
50317b60f3d8SSteven Rostedt (VMware)  err_unlock_ftrace:
50327b60f3d8SSteven Rostedt (VMware) 	mutex_unlock(&ftrace_lock);
5033d3d532d7SSteven Rostedt (VMware) 	return ret;
503459df055fSSteven Rostedt }
503559df055fSSteven Rostedt 
5036a0e6369eSNaveen N. Rao void clear_ftrace_function_probes(struct trace_array *tr)
5037a0e6369eSNaveen N. Rao {
5038a0e6369eSNaveen N. Rao 	struct ftrace_func_probe *probe, *n;
5039a0e6369eSNaveen N. Rao 
5040a0e6369eSNaveen N. Rao 	list_for_each_entry_safe(probe, n, &tr->func_probes, list)
5041a0e6369eSNaveen N. Rao 		unregister_ftrace_function_probe_func(NULL, tr, probe->probe_ops);
5042a0e6369eSNaveen N. Rao }
5043a0e6369eSNaveen N. Rao 
5044f6180773SSteven Rostedt static LIST_HEAD(ftrace_commands);
5045f6180773SSteven Rostedt static DEFINE_MUTEX(ftrace_cmd_mutex);
5046f6180773SSteven Rostedt 
504738de93abSTom Zanussi /*
504838de93abSTom Zanussi  * Currently we only register ftrace commands from __init, so mark this
504938de93abSTom Zanussi  * __init too.
505038de93abSTom Zanussi  */
505138de93abSTom Zanussi __init int register_ftrace_command(struct ftrace_func_command *cmd)
5052f6180773SSteven Rostedt {
5053f6180773SSteven Rostedt 	struct ftrace_func_command *p;
5054f6180773SSteven Rostedt 	int ret = 0;
5055f6180773SSteven Rostedt 
5056f6180773SSteven Rostedt 	mutex_lock(&ftrace_cmd_mutex);
5057f6180773SSteven Rostedt 	list_for_each_entry(p, &ftrace_commands, list) {
5058f6180773SSteven Rostedt 		if (strcmp(cmd->name, p->name) == 0) {
5059f6180773SSteven Rostedt 			ret = -EBUSY;
5060f6180773SSteven Rostedt 			goto out_unlock;
5061f6180773SSteven Rostedt 		}
5062f6180773SSteven Rostedt 	}
5063f6180773SSteven Rostedt 	list_add(&cmd->list, &ftrace_commands);
5064f6180773SSteven Rostedt  out_unlock:
5065f6180773SSteven Rostedt 	mutex_unlock(&ftrace_cmd_mutex);
5066f6180773SSteven Rostedt 
5067f6180773SSteven Rostedt 	return ret;
5068f6180773SSteven Rostedt }
5069f6180773SSteven Rostedt 
507038de93abSTom Zanussi /*
507138de93abSTom Zanussi  * Currently we only unregister ftrace commands from __init, so mark
507238de93abSTom Zanussi  * this __init too.
507338de93abSTom Zanussi  */
507438de93abSTom Zanussi __init int unregister_ftrace_command(struct ftrace_func_command *cmd)
5075f6180773SSteven Rostedt {
5076f6180773SSteven Rostedt 	struct ftrace_func_command *p, *n;
5077f6180773SSteven Rostedt 	int ret = -ENODEV;
5078f6180773SSteven Rostedt 
5079f6180773SSteven Rostedt 	mutex_lock(&ftrace_cmd_mutex);
5080f6180773SSteven Rostedt 	list_for_each_entry_safe(p, n, &ftrace_commands, list) {
5081f6180773SSteven Rostedt 		if (strcmp(cmd->name, p->name) == 0) {
5082f6180773SSteven Rostedt 			ret = 0;
5083f6180773SSteven Rostedt 			list_del_init(&p->list);
5084f6180773SSteven Rostedt 			goto out_unlock;
5085f6180773SSteven Rostedt 		}
5086f6180773SSteven Rostedt 	}
5087f6180773SSteven Rostedt  out_unlock:
5088f6180773SSteven Rostedt 	mutex_unlock(&ftrace_cmd_mutex);
5089f6180773SSteven Rostedt 
5090f6180773SSteven Rostedt 	return ret;
5091f6180773SSteven Rostedt }
5092f6180773SSteven Rostedt 
509304ec7bb6SSteven Rostedt (VMware) static int ftrace_process_regex(struct ftrace_iterator *iter,
509433dc9b12SSteven Rostedt 				char *buff, int len, int enable)
509564e7c440SSteven Rostedt {
509604ec7bb6SSteven Rostedt (VMware) 	struct ftrace_hash *hash = iter->hash;
5097d2afd57aSSteven Rostedt (VMware) 	struct trace_array *tr = iter->ops->private;
5098f6180773SSteven Rostedt 	char *func, *command, *next = buff;
50996a24a244SSteven Rostedt 	struct ftrace_func_command *p;
51000aff1c0cSGuoWen Li 	int ret = -EINVAL;
510164e7c440SSteven Rostedt 
510264e7c440SSteven Rostedt 	func = strsep(&next, ":");
510364e7c440SSteven Rostedt 
510464e7c440SSteven Rostedt 	if (!next) {
51051cf41dd7SSteven Rostedt 		ret = ftrace_match_records(hash, func, len);
5106b448c4e3SSteven Rostedt 		if (!ret)
5107b448c4e3SSteven Rostedt 			ret = -EINVAL;
5108b448c4e3SSteven Rostedt 		if (ret < 0)
5109311d16daSLi Zefan 			return ret;
5110b448c4e3SSteven Rostedt 		return 0;
511164e7c440SSteven Rostedt 	}
511264e7c440SSteven Rostedt 
5113f6180773SSteven Rostedt 	/* command found */
511464e7c440SSteven Rostedt 
511564e7c440SSteven Rostedt 	command = strsep(&next, ":");
511664e7c440SSteven Rostedt 
5117f6180773SSteven Rostedt 	mutex_lock(&ftrace_cmd_mutex);
5118f6180773SSteven Rostedt 	list_for_each_entry(p, &ftrace_commands, list) {
5119f6180773SSteven Rostedt 		if (strcmp(p->name, command) == 0) {
512004ec7bb6SSteven Rostedt (VMware) 			ret = p->func(tr, hash, func, command, next, enable);
5121f6180773SSteven Rostedt 			goto out_unlock;
512264e7c440SSteven Rostedt 		}
5123f6180773SSteven Rostedt 	}
5124f6180773SSteven Rostedt  out_unlock:
5125f6180773SSteven Rostedt 	mutex_unlock(&ftrace_cmd_mutex);
512664e7c440SSteven Rostedt 
5127f6180773SSteven Rostedt 	return ret;
512864e7c440SSteven Rostedt }
512964e7c440SSteven Rostedt 
5130e309b41dSIngo Molnar static ssize_t
513141c52c0dSSteven Rostedt ftrace_regex_write(struct file *file, const char __user *ubuf,
513241c52c0dSSteven Rostedt 		   size_t cnt, loff_t *ppos, int enable)
51335072c59fSSteven Rostedt {
51345072c59fSSteven Rostedt 	struct ftrace_iterator *iter;
5135689fd8b6S[email protected] 	struct trace_parser *parser;
5136689fd8b6S[email protected] 	ssize_t ret, read;
51375072c59fSSteven Rostedt 
51384ba7978eSLi Zefan 	if (!cnt)
51395072c59fSSteven Rostedt 		return 0;
51405072c59fSSteven Rostedt 
51415072c59fSSteven Rostedt 	if (file->f_mode & FMODE_READ) {
51425072c59fSSteven Rostedt 		struct seq_file *m = file->private_data;
51435072c59fSSteven Rostedt 		iter = m->private;
51445072c59fSSteven Rostedt 	} else
51455072c59fSSteven Rostedt 		iter = file->private_data;
51465072c59fSSteven Rostedt 
5147f04f24fbSMasami Hiramatsu 	if (unlikely(ftrace_disabled))
51483f2367baSMasami Hiramatsu 		return -ENODEV;
51493f2367baSMasami Hiramatsu 
51503f2367baSMasami Hiramatsu 	/* iter->hash is a local copy, so we don't need regex_lock */
5151f04f24fbSMasami Hiramatsu 
5152689fd8b6S[email protected] 	parser = &iter->parser;
5153689fd8b6S[email protected] 	read = trace_get_user(parser, ubuf, cnt, ppos);
51545072c59fSSteven Rostedt 
51554ba7978eSLi Zefan 	if (read >= 0 && trace_parser_loaded(parser) &&
5156689fd8b6S[email protected] 	    !trace_parser_cont(parser)) {
515704ec7bb6SSteven Rostedt (VMware) 		ret = ftrace_process_regex(iter, parser->buffer,
5158689fd8b6S[email protected] 					   parser->idx, enable);
5159313254a9SLi Zefan 		trace_parser_clear(parser);
51607c088b51SSteven Rostedt (Red Hat) 		if (ret < 0)
51613f2367baSMasami Hiramatsu 			goto out;
51625072c59fSSteven Rostedt 	}
51635072c59fSSteven Rostedt 
51645072c59fSSteven Rostedt 	ret = read;
51653f2367baSMasami Hiramatsu  out:
51665072c59fSSteven Rostedt 	return ret;
51675072c59fSSteven Rostedt }
51685072c59fSSteven Rostedt 
5169fc13cb0cSSteven Rostedt ssize_t
517041c52c0dSSteven Rostedt ftrace_filter_write(struct file *file, const char __user *ubuf,
517141c52c0dSSteven Rostedt 		    size_t cnt, loff_t *ppos)
517241c52c0dSSteven Rostedt {
517341c52c0dSSteven Rostedt 	return ftrace_regex_write(file, ubuf, cnt, ppos, 1);
517441c52c0dSSteven Rostedt }
517541c52c0dSSteven Rostedt 
5176fc13cb0cSSteven Rostedt ssize_t
517741c52c0dSSteven Rostedt ftrace_notrace_write(struct file *file, const char __user *ubuf,
517841c52c0dSSteven Rostedt 		     size_t cnt, loff_t *ppos)
517941c52c0dSSteven Rostedt {
518041c52c0dSSteven Rostedt 	return ftrace_regex_write(file, ubuf, cnt, ppos, 0);
518141c52c0dSSteven Rostedt }
518241c52c0dSSteven Rostedt 
518333dc9b12SSteven Rostedt static int
51844f554e95SJiri Olsa __ftrace_match_addr(struct ftrace_hash *hash, unsigned long ip, int remove)
5185647664eaSMasami Hiramatsu {
5186647664eaSMasami Hiramatsu 	struct ftrace_func_entry *entry;
5187647664eaSMasami Hiramatsu 
5188aebfd125SPeter Zijlstra 	ip = ftrace_location(ip);
5189aebfd125SPeter Zijlstra 	if (!ip)
5190647664eaSMasami Hiramatsu 		return -EINVAL;
5191647664eaSMasami Hiramatsu 
5192647664eaSMasami Hiramatsu 	if (remove) {
5193647664eaSMasami Hiramatsu 		entry = ftrace_lookup_ip(hash, ip);
5194647664eaSMasami Hiramatsu 		if (!entry)
5195647664eaSMasami Hiramatsu 			return -ENOENT;
5196647664eaSMasami Hiramatsu 		free_hash_entry(hash, entry);
5197647664eaSMasami Hiramatsu 		return 0;
5198647664eaSMasami Hiramatsu 	}
5199647664eaSMasami Hiramatsu 
5200647664eaSMasami Hiramatsu 	return add_hash_entry(hash, ip);
5201647664eaSMasami Hiramatsu }
5202647664eaSMasami Hiramatsu 
5203647664eaSMasami Hiramatsu static int
52044f554e95SJiri Olsa ftrace_match_addr(struct ftrace_hash *hash, unsigned long *ips,
52054f554e95SJiri Olsa 		  unsigned int cnt, int remove)
52064f554e95SJiri Olsa {
52074f554e95SJiri Olsa 	unsigned int i;
52084f554e95SJiri Olsa 	int err;
52094f554e95SJiri Olsa 
52104f554e95SJiri Olsa 	for (i = 0; i < cnt; i++) {
52114f554e95SJiri Olsa 		err = __ftrace_match_addr(hash, ips[i], remove);
52124f554e95SJiri Olsa 		if (err) {
52134f554e95SJiri Olsa 			/*
52144f554e95SJiri Olsa 			 * This expects the @hash is a temporary hash and if this
52154f554e95SJiri Olsa 			 * fails the caller must free the @hash.
52164f554e95SJiri Olsa 			 */
52174f554e95SJiri Olsa 			return err;
52184f554e95SJiri Olsa 		}
52194f554e95SJiri Olsa 	}
52204f554e95SJiri Olsa 	return 0;
52214f554e95SJiri Olsa }
52224f554e95SJiri Olsa 
52234f554e95SJiri Olsa static int
5224647664eaSMasami Hiramatsu ftrace_set_hash(struct ftrace_ops *ops, unsigned char *buf, int len,
52254f554e95SJiri Olsa 		unsigned long *ips, unsigned int cnt,
52264f554e95SJiri Olsa 		int remove, int reset, int enable)
522741c52c0dSSteven Rostedt {
522833dc9b12SSteven Rostedt 	struct ftrace_hash **orig_hash;
5229f45948e8SSteven Rostedt 	struct ftrace_hash *hash;
523033dc9b12SSteven Rostedt 	int ret;
5231f45948e8SSteven Rostedt 
523241c52c0dSSteven Rostedt 	if (unlikely(ftrace_disabled))
523333dc9b12SSteven Rostedt 		return -ENODEV;
523441c52c0dSSteven Rostedt 
523533b7f99cSSteven Rostedt (Red Hat) 	mutex_lock(&ops->func_hash->regex_lock);
52363f2367baSMasami Hiramatsu 
5237f45948e8SSteven Rostedt 	if (enable)
523833b7f99cSSteven Rostedt (Red Hat) 		orig_hash = &ops->func_hash->filter_hash;
5239f45948e8SSteven Rostedt 	else
524033b7f99cSSteven Rostedt (Red Hat) 		orig_hash = &ops->func_hash->notrace_hash;
524133dc9b12SSteven Rostedt 
5242b972cc58SWang Nan 	if (reset)
5243b972cc58SWang Nan 		hash = alloc_ftrace_hash(FTRACE_HASH_DEFAULT_BITS);
5244b972cc58SWang Nan 	else
524533dc9b12SSteven Rostedt 		hash = alloc_and_copy_ftrace_hash(FTRACE_HASH_DEFAULT_BITS, *orig_hash);
5246b972cc58SWang Nan 
52473f2367baSMasami Hiramatsu 	if (!hash) {
52483f2367baSMasami Hiramatsu 		ret = -ENOMEM;
52493f2367baSMasami Hiramatsu 		goto out_regex_unlock;
52503f2367baSMasami Hiramatsu 	}
5251f45948e8SSteven Rostedt 
5252ac483c44SJiri Olsa 	if (buf && !ftrace_match_records(hash, buf, len)) {
5253ac483c44SJiri Olsa 		ret = -EINVAL;
5254ac483c44SJiri Olsa 		goto out_regex_unlock;
5255ac483c44SJiri Olsa 	}
52564f554e95SJiri Olsa 	if (ips) {
52574f554e95SJiri Olsa 		ret = ftrace_match_addr(hash, ips, cnt, remove);
5258647664eaSMasami Hiramatsu 		if (ret < 0)
5259647664eaSMasami Hiramatsu 			goto out_regex_unlock;
5260647664eaSMasami Hiramatsu 	}
526133dc9b12SSteven Rostedt 
526233dc9b12SSteven Rostedt 	mutex_lock(&ftrace_lock);
5263e16b35ddSSteven Rostedt (VMware) 	ret = ftrace_hash_move_and_update_ops(ops, orig_hash, hash, enable);
526433dc9b12SSteven Rostedt 	mutex_unlock(&ftrace_lock);
526533dc9b12SSteven Rostedt 
5266ac483c44SJiri Olsa  out_regex_unlock:
526733b7f99cSSteven Rostedt (Red Hat) 	mutex_unlock(&ops->func_hash->regex_lock);
526833dc9b12SSteven Rostedt 
526933dc9b12SSteven Rostedt 	free_ftrace_hash(hash);
527033dc9b12SSteven Rostedt 	return ret;
527141c52c0dSSteven Rostedt }
527241c52c0dSSteven Rostedt 
5273647664eaSMasami Hiramatsu static int
52744f554e95SJiri Olsa ftrace_set_addr(struct ftrace_ops *ops, unsigned long *ips, unsigned int cnt,
52754f554e95SJiri Olsa 		int remove, int reset, int enable)
5276647664eaSMasami Hiramatsu {
52774f554e95SJiri Olsa 	return ftrace_set_hash(ops, NULL, 0, ips, cnt, remove, reset, enable);
5278647664eaSMasami Hiramatsu }
5279647664eaSMasami Hiramatsu 
5280763e34e7SSteven Rostedt (VMware) #ifdef CONFIG_DYNAMIC_FTRACE_WITH_DIRECT_CALLS
5281013bf0daSSteven Rostedt (VMware) 
5282013bf0daSSteven Rostedt (VMware) struct ftrace_direct_func {
5283013bf0daSSteven Rostedt (VMware) 	struct list_head	next;
5284013bf0daSSteven Rostedt (VMware) 	unsigned long		addr;
5285013bf0daSSteven Rostedt (VMware) 	int			count;
5286013bf0daSSteven Rostedt (VMware) };
5287013bf0daSSteven Rostedt (VMware) 
5288013bf0daSSteven Rostedt (VMware) static LIST_HEAD(ftrace_direct_funcs);
5289013bf0daSSteven Rostedt (VMware) 
529053cd885bSSong Liu static int register_ftrace_function_nolock(struct ftrace_ops *ops);
529153cd885bSSong Liu 
529253cd885bSSong Liu #define MULTI_FLAGS (FTRACE_OPS_FL_DIRECT | FTRACE_OPS_FL_SAVE_REGS)
5293f64dd462SJiri Olsa 
5294f64dd462SJiri Olsa static int check_direct_multi(struct ftrace_ops *ops)
5295f64dd462SJiri Olsa {
5296f64dd462SJiri Olsa 	if (!(ops->flags & FTRACE_OPS_FL_INITIALIZED))
5297f64dd462SJiri Olsa 		return -EINVAL;
5298f64dd462SJiri Olsa 	if ((ops->flags & MULTI_FLAGS) != MULTI_FLAGS)
5299f64dd462SJiri Olsa 		return -EINVAL;
5300f64dd462SJiri Olsa 	return 0;
5301f64dd462SJiri Olsa }
5302f64dd462SJiri Olsa 
5303f64dd462SJiri Olsa static void remove_direct_functions_hash(struct ftrace_hash *hash, unsigned long addr)
5304f64dd462SJiri Olsa {
5305f64dd462SJiri Olsa 	struct ftrace_func_entry *entry, *del;
5306f64dd462SJiri Olsa 	int size, i;
5307f64dd462SJiri Olsa 
5308f64dd462SJiri Olsa 	size = 1 << hash->size_bits;
5309f64dd462SJiri Olsa 	for (i = 0; i < size; i++) {
5310f64dd462SJiri Olsa 		hlist_for_each_entry(entry, &hash->buckets[i], hlist) {
5311f64dd462SJiri Olsa 			del = __ftrace_lookup_ip(direct_functions, entry->ip);
5312f64dd462SJiri Olsa 			if (del && del->direct == addr) {
5313f64dd462SJiri Olsa 				remove_hash_entry(direct_functions, del);
5314f64dd462SJiri Olsa 				kfree(del);
5315f64dd462SJiri Olsa 			}
5316f64dd462SJiri Olsa 		}
5317f64dd462SJiri Olsa 	}
5318f64dd462SJiri Olsa }
5319f64dd462SJiri Olsa 
5320f64dd462SJiri Olsa /**
5321*da8bdfbdSFlorent Revest  * register_ftrace_direct - Call a custom trampoline directly
5322f64dd462SJiri Olsa  * for multiple functions registered in @ops
5323f64dd462SJiri Olsa  * @ops: The address of the struct ftrace_ops object
5324f64dd462SJiri Olsa  * @addr: The address of the trampoline to call at @ops functions
5325f64dd462SJiri Olsa  *
5326f64dd462SJiri Olsa  * This is used to connect a direct calls to @addr from the nop locations
5327f64dd462SJiri Olsa  * of the functions registered in @ops (with by ftrace_set_filter_ip
5328f64dd462SJiri Olsa  * function).
5329f64dd462SJiri Olsa  *
5330f64dd462SJiri Olsa  * The location that it calls (@addr) must be able to handle a direct call,
5331f64dd462SJiri Olsa  * and save the parameters of the function being traced, and restore them
5332f64dd462SJiri Olsa  * (or inject new ones if needed), before returning.
5333f64dd462SJiri Olsa  *
5334f64dd462SJiri Olsa  * Returns:
5335f64dd462SJiri Olsa  *  0 on success
5336f64dd462SJiri Olsa  *  -EINVAL  - The @ops object was already registered with this call or
5337f64dd462SJiri Olsa  *             when there are no functions in @ops object.
5338f64dd462SJiri Olsa  *  -EBUSY   - Another direct function is already attached (there can be only one)
5339f64dd462SJiri Olsa  *  -ENODEV  - @ip does not point to a ftrace nop location (or not supported)
5340f64dd462SJiri Olsa  *  -ENOMEM  - There was an allocation failure.
5341f64dd462SJiri Olsa  */
5342*da8bdfbdSFlorent Revest int register_ftrace_direct(struct ftrace_ops *ops, unsigned long addr)
5343f64dd462SJiri Olsa {
5344f64dd462SJiri Olsa 	struct ftrace_hash *hash, *free_hash = NULL;
5345f64dd462SJiri Olsa 	struct ftrace_func_entry *entry, *new;
5346f64dd462SJiri Olsa 	int err = -EBUSY, size, i;
5347f64dd462SJiri Olsa 
5348f64dd462SJiri Olsa 	if (ops->func || ops->trampoline)
5349f64dd462SJiri Olsa 		return -EINVAL;
5350f64dd462SJiri Olsa 	if (!(ops->flags & FTRACE_OPS_FL_INITIALIZED))
5351f64dd462SJiri Olsa 		return -EINVAL;
5352f64dd462SJiri Olsa 	if (ops->flags & FTRACE_OPS_FL_ENABLED)
5353f64dd462SJiri Olsa 		return -EINVAL;
5354f64dd462SJiri Olsa 
5355f64dd462SJiri Olsa 	hash = ops->func_hash->filter_hash;
5356f64dd462SJiri Olsa 	if (ftrace_hash_empty(hash))
5357f64dd462SJiri Olsa 		return -EINVAL;
5358f64dd462SJiri Olsa 
5359f64dd462SJiri Olsa 	mutex_lock(&direct_mutex);
5360f64dd462SJiri Olsa 
5361f64dd462SJiri Olsa 	/* Make sure requested entries are not already registered.. */
5362f64dd462SJiri Olsa 	size = 1 << hash->size_bits;
5363f64dd462SJiri Olsa 	for (i = 0; i < size; i++) {
5364f64dd462SJiri Olsa 		hlist_for_each_entry(entry, &hash->buckets[i], hlist) {
5365f64dd462SJiri Olsa 			if (ftrace_find_rec_direct(entry->ip))
5366f64dd462SJiri Olsa 				goto out_unlock;
5367f64dd462SJiri Olsa 		}
5368f64dd462SJiri Olsa 	}
5369f64dd462SJiri Olsa 
5370f64dd462SJiri Olsa 	/* ... and insert them to direct_functions hash. */
5371f64dd462SJiri Olsa 	err = -ENOMEM;
5372f64dd462SJiri Olsa 	for (i = 0; i < size; i++) {
5373f64dd462SJiri Olsa 		hlist_for_each_entry(entry, &hash->buckets[i], hlist) {
5374f64dd462SJiri Olsa 			new = ftrace_add_rec_direct(entry->ip, addr, &free_hash);
5375f64dd462SJiri Olsa 			if (!new)
5376f64dd462SJiri Olsa 				goto out_remove;
5377f64dd462SJiri Olsa 			entry->direct = addr;
5378f64dd462SJiri Olsa 		}
5379f64dd462SJiri Olsa 	}
5380f64dd462SJiri Olsa 
5381f64dd462SJiri Olsa 	ops->func = call_direct_funcs;
5382f64dd462SJiri Olsa 	ops->flags = MULTI_FLAGS;
5383f64dd462SJiri Olsa 	ops->trampoline = FTRACE_REGS_ADDR;
5384f64dd462SJiri Olsa 
538553cd885bSSong Liu 	err = register_ftrace_function_nolock(ops);
5386f64dd462SJiri Olsa 
5387f64dd462SJiri Olsa  out_remove:
5388f64dd462SJiri Olsa 	if (err)
5389f64dd462SJiri Olsa 		remove_direct_functions_hash(hash, addr);
5390f64dd462SJiri Olsa 
5391f64dd462SJiri Olsa  out_unlock:
5392f64dd462SJiri Olsa 	mutex_unlock(&direct_mutex);
5393f64dd462SJiri Olsa 
5394f64dd462SJiri Olsa 	if (free_hash) {
5395f64dd462SJiri Olsa 		synchronize_rcu_tasks();
5396f64dd462SJiri Olsa 		free_ftrace_hash(free_hash);
5397f64dd462SJiri Olsa 	}
5398f64dd462SJiri Olsa 	return err;
5399f64dd462SJiri Olsa }
5400*da8bdfbdSFlorent Revest EXPORT_SYMBOL_GPL(register_ftrace_direct);
5401f64dd462SJiri Olsa 
5402f64dd462SJiri Olsa /**
5403*da8bdfbdSFlorent Revest  * unregister_ftrace_direct - Remove calls to custom trampoline
5404*da8bdfbdSFlorent Revest  * previously registered by register_ftrace_direct for @ops object.
5405f64dd462SJiri Olsa  * @ops: The address of the struct ftrace_ops object
5406f64dd462SJiri Olsa  *
5407f64dd462SJiri Olsa  * This is used to remove a direct calls to @addr from the nop locations
5408f64dd462SJiri Olsa  * of the functions registered in @ops (with by ftrace_set_filter_ip
5409f64dd462SJiri Olsa  * function).
5410f64dd462SJiri Olsa  *
5411f64dd462SJiri Olsa  * Returns:
5412f64dd462SJiri Olsa  *  0 on success
5413f64dd462SJiri Olsa  *  -EINVAL - The @ops object was not properly registered.
5414f64dd462SJiri Olsa  */
5415*da8bdfbdSFlorent Revest int unregister_ftrace_direct(struct ftrace_ops *ops, unsigned long addr,
541659495740SFlorent Revest 			     bool free_filters)
5417f64dd462SJiri Olsa {
5418f64dd462SJiri Olsa 	struct ftrace_hash *hash = ops->func_hash->filter_hash;
5419f64dd462SJiri Olsa 	int err;
5420f64dd462SJiri Olsa 
5421f64dd462SJiri Olsa 	if (check_direct_multi(ops))
5422f64dd462SJiri Olsa 		return -EINVAL;
5423f64dd462SJiri Olsa 	if (!(ops->flags & FTRACE_OPS_FL_ENABLED))
5424f64dd462SJiri Olsa 		return -EINVAL;
5425f64dd462SJiri Olsa 
5426f64dd462SJiri Olsa 	mutex_lock(&direct_mutex);
5427f64dd462SJiri Olsa 	err = unregister_ftrace_function(ops);
5428f64dd462SJiri Olsa 	remove_direct_functions_hash(hash, addr);
5429f64dd462SJiri Olsa 	mutex_unlock(&direct_mutex);
5430fea3ffa4SJiri Olsa 
5431fea3ffa4SJiri Olsa 	/* cleanup for possible another register call */
5432fea3ffa4SJiri Olsa 	ops->func = NULL;
5433fea3ffa4SJiri Olsa 	ops->trampoline = 0;
543459495740SFlorent Revest 
543559495740SFlorent Revest 	if (free_filters)
543659495740SFlorent Revest 		ftrace_free_filter(ops);
5437f64dd462SJiri Olsa 	return err;
5438f64dd462SJiri Olsa }
5439*da8bdfbdSFlorent Revest EXPORT_SYMBOL_GPL(unregister_ftrace_direct);
5440ccf5a89eSJiri Olsa 
5441f96f644aSSong Liu static int
5442*da8bdfbdSFlorent Revest __modify_ftrace_direct(struct ftrace_ops *ops, unsigned long addr)
5443ccf5a89eSJiri Olsa {
5444ed292718SSteven Rostedt (VMware) 	struct ftrace_hash *hash;
5445ccf5a89eSJiri Olsa 	struct ftrace_func_entry *entry, *iter;
5446ed292718SSteven Rostedt (VMware) 	static struct ftrace_ops tmp_ops = {
5447ed292718SSteven Rostedt (VMware) 		.func		= ftrace_stub,
5448ed292718SSteven Rostedt (VMware) 		.flags		= FTRACE_OPS_FL_STUB,
5449ed292718SSteven Rostedt (VMware) 	};
5450ccf5a89eSJiri Olsa 	int i, size;
5451ccf5a89eSJiri Olsa 	int err;
5452ccf5a89eSJiri Olsa 
5453f96f644aSSong Liu 	lockdep_assert_held_once(&direct_mutex);
5454ed292718SSteven Rostedt (VMware) 
5455ed292718SSteven Rostedt (VMware) 	/* Enable the tmp_ops to have the same functions as the direct ops */
5456ed292718SSteven Rostedt (VMware) 	ftrace_ops_init(&tmp_ops);
5457ed292718SSteven Rostedt (VMware) 	tmp_ops.func_hash = ops->func_hash;
5458ed292718SSteven Rostedt (VMware) 
545953cd885bSSong Liu 	err = register_ftrace_function_nolock(&tmp_ops);
5460ed292718SSteven Rostedt (VMware) 	if (err)
5461f96f644aSSong Liu 		return err;
5462ccf5a89eSJiri Olsa 
5463ccf5a89eSJiri Olsa 	/*
5464ed292718SSteven Rostedt (VMware) 	 * Now the ftrace_ops_list_func() is called to do the direct callers.
5465ed292718SSteven Rostedt (VMware) 	 * We can safely change the direct functions attached to each entry.
5466ccf5a89eSJiri Olsa 	 */
5467ed292718SSteven Rostedt (VMware) 	mutex_lock(&ftrace_lock);
5468ccf5a89eSJiri Olsa 
5469ed292718SSteven Rostedt (VMware) 	hash = ops->func_hash->filter_hash;
5470ccf5a89eSJiri Olsa 	size = 1 << hash->size_bits;
5471ccf5a89eSJiri Olsa 	for (i = 0; i < size; i++) {
5472ccf5a89eSJiri Olsa 		hlist_for_each_entry(iter, &hash->buckets[i], hlist) {
5473ccf5a89eSJiri Olsa 			entry = __ftrace_lookup_ip(direct_functions, iter->ip);
5474ccf5a89eSJiri Olsa 			if (!entry)
5475ccf5a89eSJiri Olsa 				continue;
5476ccf5a89eSJiri Olsa 			entry->direct = addr;
5477ccf5a89eSJiri Olsa 		}
5478ccf5a89eSJiri Olsa 	}
5479ccf5a89eSJiri Olsa 
54802e6e9058SJiri Olsa 	mutex_unlock(&ftrace_lock);
54812e6e9058SJiri Olsa 
5482ed292718SSteven Rostedt (VMware) 	/* Removing the tmp_ops will add the updated direct callers to the functions */
5483ed292718SSteven Rostedt (VMware) 	unregister_ftrace_function(&tmp_ops);
5484ccf5a89eSJiri Olsa 
5485f96f644aSSong Liu 	return err;
5486f96f644aSSong Liu }
5487f96f644aSSong Liu 
5488f96f644aSSong Liu /**
5489*da8bdfbdSFlorent Revest  * modify_ftrace_direct_nolock - Modify an existing direct 'multi' call
5490f96f644aSSong Liu  * to call something else
5491f96f644aSSong Liu  * @ops: The address of the struct ftrace_ops object
5492f96f644aSSong Liu  * @addr: The address of the new trampoline to call at @ops functions
5493f96f644aSSong Liu  *
5494f96f644aSSong Liu  * This is used to unregister currently registered direct caller and
5495f96f644aSSong Liu  * register new one @addr on functions registered in @ops object.
5496f96f644aSSong Liu  *
5497f96f644aSSong Liu  * Note there's window between ftrace_shutdown and ftrace_startup calls
5498f96f644aSSong Liu  * where there will be no callbacks called.
5499f96f644aSSong Liu  *
5500f96f644aSSong Liu  * Caller should already have direct_mutex locked, so we don't lock
5501f96f644aSSong Liu  * direct_mutex here.
5502f96f644aSSong Liu  *
5503f96f644aSSong Liu  * Returns: zero on success. Non zero on error, which includes:
5504f96f644aSSong Liu  *  -EINVAL - The @ops object was not properly registered.
5505f96f644aSSong Liu  */
5506*da8bdfbdSFlorent Revest int modify_ftrace_direct_nolock(struct ftrace_ops *ops, unsigned long addr)
5507f96f644aSSong Liu {
5508f96f644aSSong Liu 	if (check_direct_multi(ops))
5509f96f644aSSong Liu 		return -EINVAL;
5510f96f644aSSong Liu 	if (!(ops->flags & FTRACE_OPS_FL_ENABLED))
5511f96f644aSSong Liu 		return -EINVAL;
5512f96f644aSSong Liu 
5513*da8bdfbdSFlorent Revest 	return __modify_ftrace_direct(ops, addr);
5514f96f644aSSong Liu }
5515*da8bdfbdSFlorent Revest EXPORT_SYMBOL_GPL(modify_ftrace_direct_nolock);
5516f96f644aSSong Liu 
5517f96f644aSSong Liu /**
5518*da8bdfbdSFlorent Revest  * modify_ftrace_direct - Modify an existing direct 'multi' call
5519f96f644aSSong Liu  * to call something else
5520f96f644aSSong Liu  * @ops: The address of the struct ftrace_ops object
5521f96f644aSSong Liu  * @addr: The address of the new trampoline to call at @ops functions
5522f96f644aSSong Liu  *
5523f96f644aSSong Liu  * This is used to unregister currently registered direct caller and
5524f96f644aSSong Liu  * register new one @addr on functions registered in @ops object.
5525f96f644aSSong Liu  *
5526f96f644aSSong Liu  * Note there's window between ftrace_shutdown and ftrace_startup calls
5527f96f644aSSong Liu  * where there will be no callbacks called.
5528f96f644aSSong Liu  *
5529f96f644aSSong Liu  * Returns: zero on success. Non zero on error, which includes:
5530f96f644aSSong Liu  *  -EINVAL - The @ops object was not properly registered.
5531f96f644aSSong Liu  */
5532*da8bdfbdSFlorent Revest int modify_ftrace_direct(struct ftrace_ops *ops, unsigned long addr)
5533f96f644aSSong Liu {
5534f96f644aSSong Liu 	int err;
5535f96f644aSSong Liu 
5536f96f644aSSong Liu 	if (check_direct_multi(ops))
5537f96f644aSSong Liu 		return -EINVAL;
5538f96f644aSSong Liu 	if (!(ops->flags & FTRACE_OPS_FL_ENABLED))
5539f96f644aSSong Liu 		return -EINVAL;
5540f96f644aSSong Liu 
5541f96f644aSSong Liu 	mutex_lock(&direct_mutex);
5542*da8bdfbdSFlorent Revest 	err = __modify_ftrace_direct(ops, addr);
5543ccf5a89eSJiri Olsa 	mutex_unlock(&direct_mutex);
5544ccf5a89eSJiri Olsa 	return err;
5545ccf5a89eSJiri Olsa }
5546*da8bdfbdSFlorent Revest EXPORT_SYMBOL_GPL(modify_ftrace_direct);
5547763e34e7SSteven Rostedt (VMware) #endif /* CONFIG_DYNAMIC_FTRACE_WITH_DIRECT_CALLS */
5548763e34e7SSteven Rostedt (VMware) 
5549647664eaSMasami Hiramatsu /**
5550647664eaSMasami Hiramatsu  * ftrace_set_filter_ip - set a function to filter on in ftrace by address
5551647664eaSMasami Hiramatsu  * @ops - the ops to set the filter with
5552647664eaSMasami Hiramatsu  * @ip - the address to add to or remove from the filter.
5553647664eaSMasami Hiramatsu  * @remove - non zero to remove the ip from the filter
5554647664eaSMasami Hiramatsu  * @reset - non zero to reset all filters before applying this filter.
5555647664eaSMasami Hiramatsu  *
5556647664eaSMasami Hiramatsu  * Filters denote which functions should be enabled when tracing is enabled
5557f2cc020dSIngo Molnar  * If @ip is NULL, it fails to update filter.
55588be9fbd5SMark Rutland  *
55598be9fbd5SMark Rutland  * This can allocate memory which must be freed before @ops can be freed,
55608be9fbd5SMark Rutland  * either by removing each filtered addr or by using
55618be9fbd5SMark Rutland  * ftrace_free_filter(@ops).
5562647664eaSMasami Hiramatsu  */
5563647664eaSMasami Hiramatsu int ftrace_set_filter_ip(struct ftrace_ops *ops, unsigned long ip,
5564647664eaSMasami Hiramatsu 			 int remove, int reset)
5565647664eaSMasami Hiramatsu {
5566f04f24fbSMasami Hiramatsu 	ftrace_ops_init(ops);
55674f554e95SJiri Olsa 	return ftrace_set_addr(ops, &ip, 1, remove, reset, 1);
5568647664eaSMasami Hiramatsu }
5569647664eaSMasami Hiramatsu EXPORT_SYMBOL_GPL(ftrace_set_filter_ip);
5570647664eaSMasami Hiramatsu 
5571d032ae89SJoel Fernandes /**
55724f554e95SJiri Olsa  * ftrace_set_filter_ips - set functions to filter on in ftrace by addresses
55734f554e95SJiri Olsa  * @ops - the ops to set the filter with
55744f554e95SJiri Olsa  * @ips - the array of addresses to add to or remove from the filter.
55754f554e95SJiri Olsa  * @cnt - the number of addresses in @ips
55764f554e95SJiri Olsa  * @remove - non zero to remove ips from the filter
55774f554e95SJiri Olsa  * @reset - non zero to reset all filters before applying this filter.
55784f554e95SJiri Olsa  *
55794f554e95SJiri Olsa  * Filters denote which functions should be enabled when tracing is enabled
55804f554e95SJiri Olsa  * If @ips array or any ip specified within is NULL , it fails to update filter.
55818be9fbd5SMark Rutland  *
55828be9fbd5SMark Rutland  * This can allocate memory which must be freed before @ops can be freed,
55838be9fbd5SMark Rutland  * either by removing each filtered addr or by using
55848be9fbd5SMark Rutland  * ftrace_free_filter(@ops).
55854f554e95SJiri Olsa */
55864f554e95SJiri Olsa int ftrace_set_filter_ips(struct ftrace_ops *ops, unsigned long *ips,
55874f554e95SJiri Olsa 			  unsigned int cnt, int remove, int reset)
55884f554e95SJiri Olsa {
55894f554e95SJiri Olsa 	ftrace_ops_init(ops);
55904f554e95SJiri Olsa 	return ftrace_set_addr(ops, ips, cnt, remove, reset, 1);
55914f554e95SJiri Olsa }
55924f554e95SJiri Olsa EXPORT_SYMBOL_GPL(ftrace_set_filter_ips);
55934f554e95SJiri Olsa 
55944f554e95SJiri Olsa /**
5595d032ae89SJoel Fernandes  * ftrace_ops_set_global_filter - setup ops to use global filters
5596d032ae89SJoel Fernandes  * @ops - the ops which will use the global filters
5597d032ae89SJoel Fernandes  *
5598d032ae89SJoel Fernandes  * ftrace users who need global function trace filtering should call this.
5599d032ae89SJoel Fernandes  * It can set the global filter only if ops were not initialized before.
5600d032ae89SJoel Fernandes  */
5601d032ae89SJoel Fernandes void ftrace_ops_set_global_filter(struct ftrace_ops *ops)
5602d032ae89SJoel Fernandes {
5603d032ae89SJoel Fernandes 	if (ops->flags & FTRACE_OPS_FL_INITIALIZED)
5604d032ae89SJoel Fernandes 		return;
5605d032ae89SJoel Fernandes 
5606d032ae89SJoel Fernandes 	ftrace_ops_init(ops);
5607d032ae89SJoel Fernandes 	ops->func_hash = &global_ops.local_hash;
5608d032ae89SJoel Fernandes }
5609d032ae89SJoel Fernandes EXPORT_SYMBOL_GPL(ftrace_ops_set_global_filter);
5610d032ae89SJoel Fernandes 
5611647664eaSMasami Hiramatsu static int
5612647664eaSMasami Hiramatsu ftrace_set_regex(struct ftrace_ops *ops, unsigned char *buf, int len,
5613647664eaSMasami Hiramatsu 		 int reset, int enable)
5614647664eaSMasami Hiramatsu {
56154f554e95SJiri Olsa 	return ftrace_set_hash(ops, buf, len, NULL, 0, 0, reset, enable);
5616647664eaSMasami Hiramatsu }
5617647664eaSMasami Hiramatsu 
561877a2b37dSSteven Rostedt /**
561977a2b37dSSteven Rostedt  * ftrace_set_filter - set a function to filter on in ftrace
5620936e074bSSteven Rostedt  * @ops - the ops to set the filter with
562177a2b37dSSteven Rostedt  * @buf - the string that holds the function filter text.
562277a2b37dSSteven Rostedt  * @len - the length of the string.
562377a2b37dSSteven Rostedt  * @reset - non zero to reset all filters before applying this filter.
562477a2b37dSSteven Rostedt  *
562577a2b37dSSteven Rostedt  * Filters denote which functions should be enabled when tracing is enabled.
562677a2b37dSSteven Rostedt  * If @buf is NULL and reset is set, all functions will be enabled for tracing.
56278be9fbd5SMark Rutland  *
56288be9fbd5SMark Rutland  * This can allocate memory which must be freed before @ops can be freed,
56298be9fbd5SMark Rutland  * either by removing each filtered addr or by using
56308be9fbd5SMark Rutland  * ftrace_free_filter(@ops).
563177a2b37dSSteven Rostedt  */
5632ac483c44SJiri Olsa int ftrace_set_filter(struct ftrace_ops *ops, unsigned char *buf,
5633936e074bSSteven Rostedt 		       int len, int reset)
563477a2b37dSSteven Rostedt {
5635f04f24fbSMasami Hiramatsu 	ftrace_ops_init(ops);
5636ac483c44SJiri Olsa 	return ftrace_set_regex(ops, buf, len, reset, 1);
563741c52c0dSSteven Rostedt }
5638936e074bSSteven Rostedt EXPORT_SYMBOL_GPL(ftrace_set_filter);
56394eebcc81SSteven Rostedt 
564041c52c0dSSteven Rostedt /**
564141c52c0dSSteven Rostedt  * ftrace_set_notrace - set a function to not trace in ftrace
5642936e074bSSteven Rostedt  * @ops - the ops to set the notrace filter with
564341c52c0dSSteven Rostedt  * @buf - the string that holds the function notrace text.
564441c52c0dSSteven Rostedt  * @len - the length of the string.
564541c52c0dSSteven Rostedt  * @reset - non zero to reset all filters before applying this filter.
564641c52c0dSSteven Rostedt  *
564741c52c0dSSteven Rostedt  * Notrace Filters denote which functions should not be enabled when tracing
564841c52c0dSSteven Rostedt  * is enabled. If @buf is NULL and reset is set, all functions will be enabled
564941c52c0dSSteven Rostedt  * for tracing.
56508be9fbd5SMark Rutland  *
56518be9fbd5SMark Rutland  * This can allocate memory which must be freed before @ops can be freed,
56528be9fbd5SMark Rutland  * either by removing each filtered addr or by using
56538be9fbd5SMark Rutland  * ftrace_free_filter(@ops).
565441c52c0dSSteven Rostedt  */
5655ac483c44SJiri Olsa int ftrace_set_notrace(struct ftrace_ops *ops, unsigned char *buf,
5656936e074bSSteven Rostedt 			int len, int reset)
5657936e074bSSteven Rostedt {
5658f04f24fbSMasami Hiramatsu 	ftrace_ops_init(ops);
5659ac483c44SJiri Olsa 	return ftrace_set_regex(ops, buf, len, reset, 0);
5660936e074bSSteven Rostedt }
5661936e074bSSteven Rostedt EXPORT_SYMBOL_GPL(ftrace_set_notrace);
5662936e074bSSteven Rostedt /**
56638d1b065dSJiaxing Wang  * ftrace_set_global_filter - set a function to filter on with global tracers
5664936e074bSSteven Rostedt  * @buf - the string that holds the function filter text.
5665936e074bSSteven Rostedt  * @len - the length of the string.
5666936e074bSSteven Rostedt  * @reset - non zero to reset all filters before applying this filter.
5667936e074bSSteven Rostedt  *
5668936e074bSSteven Rostedt  * Filters denote which functions should be enabled when tracing is enabled.
5669936e074bSSteven Rostedt  * If @buf is NULL and reset is set, all functions will be enabled for tracing.
5670936e074bSSteven Rostedt  */
5671936e074bSSteven Rostedt void ftrace_set_global_filter(unsigned char *buf, int len, int reset)
5672936e074bSSteven Rostedt {
5673936e074bSSteven Rostedt 	ftrace_set_regex(&global_ops, buf, len, reset, 1);
5674936e074bSSteven Rostedt }
5675936e074bSSteven Rostedt EXPORT_SYMBOL_GPL(ftrace_set_global_filter);
5676936e074bSSteven Rostedt 
5677936e074bSSteven Rostedt /**
56788d1b065dSJiaxing Wang  * ftrace_set_global_notrace - set a function to not trace with global tracers
5679936e074bSSteven Rostedt  * @buf - the string that holds the function notrace text.
5680936e074bSSteven Rostedt  * @len - the length of the string.
5681936e074bSSteven Rostedt  * @reset - non zero to reset all filters before applying this filter.
5682936e074bSSteven Rostedt  *
5683936e074bSSteven Rostedt  * Notrace Filters denote which functions should not be enabled when tracing
5684936e074bSSteven Rostedt  * is enabled. If @buf is NULL and reset is set, all functions will be enabled
5685936e074bSSteven Rostedt  * for tracing.
5686936e074bSSteven Rostedt  */
5687936e074bSSteven Rostedt void ftrace_set_global_notrace(unsigned char *buf, int len, int reset)
568841c52c0dSSteven Rostedt {
5689f45948e8SSteven Rostedt 	ftrace_set_regex(&global_ops, buf, len, reset, 0);
569077a2b37dSSteven Rostedt }
5691936e074bSSteven Rostedt EXPORT_SYMBOL_GPL(ftrace_set_global_notrace);
569277a2b37dSSteven Rostedt 
56932af15d6aSSteven Rostedt /*
56942af15d6aSSteven Rostedt  * command line interface to allow users to set filters on boot up.
56952af15d6aSSteven Rostedt  */
56962af15d6aSSteven Rostedt #define FTRACE_FILTER_SIZE		COMMAND_LINE_SIZE
56972af15d6aSSteven Rostedt static char ftrace_notrace_buf[FTRACE_FILTER_SIZE] __initdata;
56982af15d6aSSteven Rostedt static char ftrace_filter_buf[FTRACE_FILTER_SIZE] __initdata;
56992af15d6aSSteven Rostedt 
5700f1ed7c74SSteven Rostedt (Red Hat) /* Used by function selftest to not test if filter is set */
5701f1ed7c74SSteven Rostedt (Red Hat) bool ftrace_filter_param __initdata;
5702f1ed7c74SSteven Rostedt (Red Hat) 
57032af15d6aSSteven Rostedt static int __init set_ftrace_notrace(char *str)
57042af15d6aSSteven Rostedt {
5705f1ed7c74SSteven Rostedt (Red Hat) 	ftrace_filter_param = true;
570675761cc1SChen Gang 	strlcpy(ftrace_notrace_buf, str, FTRACE_FILTER_SIZE);
57072af15d6aSSteven Rostedt 	return 1;
57082af15d6aSSteven Rostedt }
57092af15d6aSSteven Rostedt __setup("ftrace_notrace=", set_ftrace_notrace);
57102af15d6aSSteven Rostedt 
57112af15d6aSSteven Rostedt static int __init set_ftrace_filter(char *str)
57122af15d6aSSteven Rostedt {
5713f1ed7c74SSteven Rostedt (Red Hat) 	ftrace_filter_param = true;
571475761cc1SChen Gang 	strlcpy(ftrace_filter_buf, str, FTRACE_FILTER_SIZE);
57152af15d6aSSteven Rostedt 	return 1;
57162af15d6aSSteven Rostedt }
57172af15d6aSSteven Rostedt __setup("ftrace_filter=", set_ftrace_filter);
57182af15d6aSSteven Rostedt 
5719369bc18fSStefan Assmann #ifdef CONFIG_FUNCTION_GRAPH_TRACER
5720f6060f46SLai Jiangshan static char ftrace_graph_buf[FTRACE_FILTER_SIZE] __initdata;
57210d7d9a16SNamhyung Kim static char ftrace_graph_notrace_buf[FTRACE_FILTER_SIZE] __initdata;
5722b9b0c831SNamhyung Kim static int ftrace_graph_set_hash(struct ftrace_hash *hash, char *buffer);
5723801c29fdSSteven Rostedt 
5724369bc18fSStefan Assmann static int __init set_graph_function(char *str)
5725369bc18fSStefan Assmann {
572606f43d66SFrederic Weisbecker 	strlcpy(ftrace_graph_buf, str, FTRACE_FILTER_SIZE);
5727369bc18fSStefan Assmann 	return 1;
5728369bc18fSStefan Assmann }
5729369bc18fSStefan Assmann __setup("ftrace_graph_filter=", set_graph_function);
5730369bc18fSStefan Assmann 
57310d7d9a16SNamhyung Kim static int __init set_graph_notrace_function(char *str)
57320d7d9a16SNamhyung Kim {
57330d7d9a16SNamhyung Kim 	strlcpy(ftrace_graph_notrace_buf, str, FTRACE_FILTER_SIZE);
57340d7d9a16SNamhyung Kim 	return 1;
57350d7d9a16SNamhyung Kim }
57360d7d9a16SNamhyung Kim __setup("ftrace_graph_notrace=", set_graph_notrace_function);
57370d7d9a16SNamhyung Kim 
573865a50c65STodd Brandt static int __init set_graph_max_depth_function(char *str)
573965a50c65STodd Brandt {
574065a50c65STodd Brandt 	if (!str)
574165a50c65STodd Brandt 		return 0;
574265a50c65STodd Brandt 	fgraph_max_depth = simple_strtoul(str, NULL, 0);
574365a50c65STodd Brandt 	return 1;
574465a50c65STodd Brandt }
574565a50c65STodd Brandt __setup("ftrace_graph_max_depth=", set_graph_max_depth_function);
574665a50c65STodd Brandt 
57470d7d9a16SNamhyung Kim static void __init set_ftrace_early_graph(char *buf, int enable)
5748369bc18fSStefan Assmann {
5749369bc18fSStefan Assmann 	int ret;
5750369bc18fSStefan Assmann 	char *func;
5751b9b0c831SNamhyung Kim 	struct ftrace_hash *hash;
57520d7d9a16SNamhyung Kim 
575392ad18ecSSteven Rostedt (VMware) 	hash = alloc_ftrace_hash(FTRACE_HASH_DEFAULT_BITS);
575424589e3aSSteven Rostedt (VMware) 	if (MEM_FAIL(!hash, "Failed to allocate hash\n"))
575592ad18ecSSteven Rostedt (VMware) 		return;
5756369bc18fSStefan Assmann 
5757369bc18fSStefan Assmann 	while (buf) {
5758369bc18fSStefan Assmann 		func = strsep(&buf, ",");
5759369bc18fSStefan Assmann 		/* we allow only one expression at a time */
5760b9b0c831SNamhyung Kim 		ret = ftrace_graph_set_hash(hash, func);
5761369bc18fSStefan Assmann 		if (ret)
5762369bc18fSStefan Assmann 			printk(KERN_DEBUG "ftrace: function %s not "
5763369bc18fSStefan Assmann 					  "traceable\n", func);
5764369bc18fSStefan Assmann 	}
576592ad18ecSSteven Rostedt (VMware) 
576692ad18ecSSteven Rostedt (VMware) 	if (enable)
576792ad18ecSSteven Rostedt (VMware) 		ftrace_graph_hash = hash;
576892ad18ecSSteven Rostedt (VMware) 	else
576992ad18ecSSteven Rostedt (VMware) 		ftrace_graph_notrace_hash = hash;
5770369bc18fSStefan Assmann }
5771369bc18fSStefan Assmann #endif /* CONFIG_FUNCTION_GRAPH_TRACER */
5772369bc18fSStefan Assmann 
57732a85a37fSSteven Rostedt void __init
57742a85a37fSSteven Rostedt ftrace_set_early_filter(struct ftrace_ops *ops, char *buf, int enable)
57752af15d6aSSteven Rostedt {
57762af15d6aSSteven Rostedt 	char *func;
57772af15d6aSSteven Rostedt 
5778f04f24fbSMasami Hiramatsu 	ftrace_ops_init(ops);
5779f04f24fbSMasami Hiramatsu 
57802af15d6aSSteven Rostedt 	while (buf) {
57812af15d6aSSteven Rostedt 		func = strsep(&buf, ",");
5782f45948e8SSteven Rostedt 		ftrace_set_regex(ops, func, strlen(func), 0, enable);
57832af15d6aSSteven Rostedt 	}
57842af15d6aSSteven Rostedt }
57852af15d6aSSteven Rostedt 
57862af15d6aSSteven Rostedt static void __init set_ftrace_early_filters(void)
57872af15d6aSSteven Rostedt {
57882af15d6aSSteven Rostedt 	if (ftrace_filter_buf[0])
57892a85a37fSSteven Rostedt 		ftrace_set_early_filter(&global_ops, ftrace_filter_buf, 1);
57902af15d6aSSteven Rostedt 	if (ftrace_notrace_buf[0])
57912a85a37fSSteven Rostedt 		ftrace_set_early_filter(&global_ops, ftrace_notrace_buf, 0);
5792369bc18fSStefan Assmann #ifdef CONFIG_FUNCTION_GRAPH_TRACER
5793369bc18fSStefan Assmann 	if (ftrace_graph_buf[0])
57940d7d9a16SNamhyung Kim 		set_ftrace_early_graph(ftrace_graph_buf, 1);
57950d7d9a16SNamhyung Kim 	if (ftrace_graph_notrace_buf[0])
57960d7d9a16SNamhyung Kim 		set_ftrace_early_graph(ftrace_graph_notrace_buf, 0);
5797369bc18fSStefan Assmann #endif /* CONFIG_FUNCTION_GRAPH_TRACER */
57982af15d6aSSteven Rostedt }
57992af15d6aSSteven Rostedt 
5800fc13cb0cSSteven Rostedt int ftrace_regex_release(struct inode *inode, struct file *file)
58015072c59fSSteven Rostedt {
58025072c59fSSteven Rostedt 	struct seq_file *m = (struct seq_file *)file->private_data;
58035072c59fSSteven Rostedt 	struct ftrace_iterator *iter;
580433dc9b12SSteven Rostedt 	struct ftrace_hash **orig_hash;
5805689fd8b6S[email protected] 	struct trace_parser *parser;
5806ed926f9bSSteven Rostedt 	int filter_hash;
58075072c59fSSteven Rostedt 
58085072c59fSSteven Rostedt 	if (file->f_mode & FMODE_READ) {
58095072c59fSSteven Rostedt 		iter = m->private;
58105072c59fSSteven Rostedt 		seq_release(inode, file);
58115072c59fSSteven Rostedt 	} else
58125072c59fSSteven Rostedt 		iter = file->private_data;
58135072c59fSSteven Rostedt 
5814689fd8b6S[email protected] 	parser = &iter->parser;
5815689fd8b6S[email protected] 	if (trace_parser_loaded(parser)) {
58168c9af478SSteven Rostedt (VMware) 		int enable = !(iter->flags & FTRACE_ITER_NOTRACE);
58178c9af478SSteven Rostedt (VMware) 
58188c9af478SSteven Rostedt (VMware) 		ftrace_process_regex(iter, parser->buffer,
58198c9af478SSteven Rostedt (VMware) 				     parser->idx, enable);
58205072c59fSSteven Rostedt 	}
58215072c59fSSteven Rostedt 
5822058e297dSSteven Rostedt 	trace_parser_put(parser);
5823058e297dSSteven Rostedt 
582433b7f99cSSteven Rostedt (Red Hat) 	mutex_lock(&iter->ops->func_hash->regex_lock);
58253f2367baSMasami Hiramatsu 
5826058e297dSSteven Rostedt 	if (file->f_mode & FMODE_WRITE) {
5827ed926f9bSSteven Rostedt 		filter_hash = !!(iter->flags & FTRACE_ITER_FILTER);
5828ed926f9bSSteven Rostedt 
58298c08f0d5SSteven Rostedt (VMware) 		if (filter_hash) {
583033b7f99cSSteven Rostedt (Red Hat) 			orig_hash = &iter->ops->func_hash->filter_hash;
58310ce0638eSZheng Yejian 			if (iter->tr) {
58320ce0638eSZheng Yejian 				if (list_empty(&iter->tr->mod_trace))
58330ce0638eSZheng Yejian 					iter->hash->flags &= ~FTRACE_HASH_FL_MOD;
58340ce0638eSZheng Yejian 				else
58358c08f0d5SSteven Rostedt (VMware) 					iter->hash->flags |= FTRACE_HASH_FL_MOD;
58360ce0638eSZheng Yejian 			}
58378c08f0d5SSteven Rostedt (VMware) 		} else
583833b7f99cSSteven Rostedt (Red Hat) 			orig_hash = &iter->ops->func_hash->notrace_hash;
583933dc9b12SSteven Rostedt 
5840e6ea44e9SSteven Rostedt 		mutex_lock(&ftrace_lock);
5841045e269cSAlex Shi 		ftrace_hash_move_and_update_ops(iter->ops, orig_hash,
5842e16b35ddSSteven Rostedt (VMware) 						      iter->hash, filter_hash);
5843e6ea44e9SSteven Rostedt 		mutex_unlock(&ftrace_lock);
5844c20489daSSteven Rostedt (VMware) 	} else {
5845c20489daSSteven Rostedt (VMware) 		/* For read only, the hash is the ops hash */
5846c20489daSSteven Rostedt (VMware) 		iter->hash = NULL;
5847058e297dSSteven Rostedt 	}
58483f2367baSMasami Hiramatsu 
584933b7f99cSSteven Rostedt (Red Hat) 	mutex_unlock(&iter->ops->func_hash->regex_lock);
585033dc9b12SSteven Rostedt 	free_ftrace_hash(iter->hash);
58519ef16693SSteven Rostedt (VMware) 	if (iter->tr)
58529ef16693SSteven Rostedt (VMware) 		trace_array_put(iter->tr);
585333dc9b12SSteven Rostedt 	kfree(iter);
5854689fd8b6S[email protected] 
58555072c59fSSteven Rostedt 	return 0;
58565072c59fSSteven Rostedt }
58575072c59fSSteven Rostedt 
58585e2336a0SSteven Rostedt static const struct file_operations ftrace_avail_fops = {
58595072c59fSSteven Rostedt 	.open = ftrace_avail_open,
58605072c59fSSteven Rostedt 	.read = seq_read,
58615072c59fSSteven Rostedt 	.llseek = seq_lseek,
58623be04b47SLi Zefan 	.release = seq_release_private,
58635072c59fSSteven Rostedt };
58645072c59fSSteven Rostedt 
5865647bcd03SSteven Rostedt static const struct file_operations ftrace_enabled_fops = {
5866647bcd03SSteven Rostedt 	.open = ftrace_enabled_open,
5867647bcd03SSteven Rostedt 	.read = seq_read,
5868647bcd03SSteven Rostedt 	.llseek = seq_lseek,
5869647bcd03SSteven Rostedt 	.release = seq_release_private,
5870647bcd03SSteven Rostedt };
5871647bcd03SSteven Rostedt 
58725e2336a0SSteven Rostedt static const struct file_operations ftrace_filter_fops = {
58735072c59fSSteven Rostedt 	.open = ftrace_filter_open,
5874850a80cfSLai Jiangshan 	.read = seq_read,
58755072c59fSSteven Rostedt 	.write = ftrace_filter_write,
5876098c879eSSteven Rostedt (Red Hat) 	.llseek = tracing_lseek,
58771cf41dd7SSteven Rostedt 	.release = ftrace_regex_release,
58785072c59fSSteven Rostedt };
58795072c59fSSteven Rostedt 
58805e2336a0SSteven Rostedt static const struct file_operations ftrace_notrace_fops = {
588141c52c0dSSteven Rostedt 	.open = ftrace_notrace_open,
5882850a80cfSLai Jiangshan 	.read = seq_read,
588341c52c0dSSteven Rostedt 	.write = ftrace_notrace_write,
5884098c879eSSteven Rostedt (Red Hat) 	.llseek = tracing_lseek,
58851cf41dd7SSteven Rostedt 	.release = ftrace_regex_release,
588641c52c0dSSteven Rostedt };
588741c52c0dSSteven Rostedt 
5888ea4e2bc4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
5889ea4e2bc4SSteven Rostedt 
5890ea4e2bc4SSteven Rostedt static DEFINE_MUTEX(graph_lock);
5891ea4e2bc4SSteven Rostedt 
589224a9729fSAmol Grover struct ftrace_hash __rcu *ftrace_graph_hash = EMPTY_HASH;
5893fd0e6852SAmol Grover struct ftrace_hash __rcu *ftrace_graph_notrace_hash = EMPTY_HASH;
5894b9b0c831SNamhyung Kim 
5895b9b0c831SNamhyung Kim enum graph_filter_type {
5896b9b0c831SNamhyung Kim 	GRAPH_FILTER_NOTRACE	= 0,
5897b9b0c831SNamhyung Kim 	GRAPH_FILTER_FUNCTION,
5898b9b0c831SNamhyung Kim };
5899ea4e2bc4SSteven Rostedt 
5900555fc781SSteven Rostedt (VMware) #define FTRACE_GRAPH_EMPTY	((void *)1)
5901555fc781SSteven Rostedt (VMware) 
5902faf982a6SNamhyung Kim struct ftrace_graph_data {
5903b9b0c831SNamhyung Kim 	struct ftrace_hash		*hash;
5904b9b0c831SNamhyung Kim 	struct ftrace_func_entry	*entry;
5905b9b0c831SNamhyung Kim 	int				idx;   /* for hash table iteration */
5906b9b0c831SNamhyung Kim 	enum graph_filter_type		type;
5907b9b0c831SNamhyung Kim 	struct ftrace_hash		*new_hash;
5908faf982a6SNamhyung Kim 	const struct seq_operations	*seq_ops;
5909e704eff3SSteven Rostedt (VMware) 	struct trace_parser		parser;
5910faf982a6SNamhyung Kim };
5911faf982a6SNamhyung Kim 
5912ea4e2bc4SSteven Rostedt static void *
591385951842SLi Zefan __g_next(struct seq_file *m, loff_t *pos)
5914ea4e2bc4SSteven Rostedt {
5915faf982a6SNamhyung Kim 	struct ftrace_graph_data *fgd = m->private;
5916b9b0c831SNamhyung Kim 	struct ftrace_func_entry *entry = fgd->entry;
5917b9b0c831SNamhyung Kim 	struct hlist_head *head;
5918b9b0c831SNamhyung Kim 	int i, idx = fgd->idx;
5919faf982a6SNamhyung Kim 
5920b9b0c831SNamhyung Kim 	if (*pos >= fgd->hash->count)
5921ea4e2bc4SSteven Rostedt 		return NULL;
5922b9b0c831SNamhyung Kim 
5923b9b0c831SNamhyung Kim 	if (entry) {
5924b9b0c831SNamhyung Kim 		hlist_for_each_entry_continue(entry, hlist) {
5925b9b0c831SNamhyung Kim 			fgd->entry = entry;
5926b9b0c831SNamhyung Kim 			return entry;
5927b9b0c831SNamhyung Kim 		}
5928b9b0c831SNamhyung Kim 
5929b9b0c831SNamhyung Kim 		idx++;
5930b9b0c831SNamhyung Kim 	}
5931b9b0c831SNamhyung Kim 
5932b9b0c831SNamhyung Kim 	for (i = idx; i < 1 << fgd->hash->size_bits; i++) {
5933b9b0c831SNamhyung Kim 		head = &fgd->hash->buckets[i];
5934b9b0c831SNamhyung Kim 		hlist_for_each_entry(entry, head, hlist) {
5935b9b0c831SNamhyung Kim 			fgd->entry = entry;
5936b9b0c831SNamhyung Kim 			fgd->idx = i;
5937b9b0c831SNamhyung Kim 			return entry;
5938b9b0c831SNamhyung Kim 		}
5939b9b0c831SNamhyung Kim 	}
5940b9b0c831SNamhyung Kim 	return NULL;
594185951842SLi Zefan }
5942ea4e2bc4SSteven Rostedt 
594385951842SLi Zefan static void *
594485951842SLi Zefan g_next(struct seq_file *m, void *v, loff_t *pos)
594585951842SLi Zefan {
594685951842SLi Zefan 	(*pos)++;
594785951842SLi Zefan 	return __g_next(m, pos);
5948ea4e2bc4SSteven Rostedt }
5949ea4e2bc4SSteven Rostedt 
5950ea4e2bc4SSteven Rostedt static void *g_start(struct seq_file *m, loff_t *pos)
5951ea4e2bc4SSteven Rostedt {
5952faf982a6SNamhyung Kim 	struct ftrace_graph_data *fgd = m->private;
5953faf982a6SNamhyung Kim 
5954ea4e2bc4SSteven Rostedt 	mutex_lock(&graph_lock);
5955ea4e2bc4SSteven Rostedt 
5956649b988bSSteven Rostedt (VMware) 	if (fgd->type == GRAPH_FILTER_FUNCTION)
5957649b988bSSteven Rostedt (VMware) 		fgd->hash = rcu_dereference_protected(ftrace_graph_hash,
5958649b988bSSteven Rostedt (VMware) 					lockdep_is_held(&graph_lock));
5959649b988bSSteven Rostedt (VMware) 	else
5960649b988bSSteven Rostedt (VMware) 		fgd->hash = rcu_dereference_protected(ftrace_graph_notrace_hash,
5961649b988bSSteven Rostedt (VMware) 					lockdep_is_held(&graph_lock));
5962649b988bSSteven Rostedt (VMware) 
5963f9349a8fSFrederic Weisbecker 	/* Nothing, tell g_show to print all functions are enabled */
5964b9b0c831SNamhyung Kim 	if (ftrace_hash_empty(fgd->hash) && !*pos)
5965555fc781SSteven Rostedt (VMware) 		return FTRACE_GRAPH_EMPTY;
5966f9349a8fSFrederic Weisbecker 
5967b9b0c831SNamhyung Kim 	fgd->idx = 0;
5968b9b0c831SNamhyung Kim 	fgd->entry = NULL;
596985951842SLi Zefan 	return __g_next(m, pos);
5970ea4e2bc4SSteven Rostedt }
5971ea4e2bc4SSteven Rostedt 
5972ea4e2bc4SSteven Rostedt static void g_stop(struct seq_file *m, void *p)
5973ea4e2bc4SSteven Rostedt {
5974ea4e2bc4SSteven Rostedt 	mutex_unlock(&graph_lock);
5975ea4e2bc4SSteven Rostedt }
5976ea4e2bc4SSteven Rostedt 
5977ea4e2bc4SSteven Rostedt static int g_show(struct seq_file *m, void *v)
5978ea4e2bc4SSteven Rostedt {
5979b9b0c831SNamhyung Kim 	struct ftrace_func_entry *entry = v;
5980ea4e2bc4SSteven Rostedt 
5981b9b0c831SNamhyung Kim 	if (!entry)
5982ea4e2bc4SSteven Rostedt 		return 0;
5983ea4e2bc4SSteven Rostedt 
5984555fc781SSteven Rostedt (VMware) 	if (entry == FTRACE_GRAPH_EMPTY) {
5985280d1429SNamhyung Kim 		struct ftrace_graph_data *fgd = m->private;
5986280d1429SNamhyung Kim 
5987b9b0c831SNamhyung Kim 		if (fgd->type == GRAPH_FILTER_FUNCTION)
5988fa6f0cc7SRasmus Villemoes 			seq_puts(m, "#### all functions enabled ####\n");
5989280d1429SNamhyung Kim 		else
5990fa6f0cc7SRasmus Villemoes 			seq_puts(m, "#### no functions disabled ####\n");
5991f9349a8fSFrederic Weisbecker 		return 0;
5992f9349a8fSFrederic Weisbecker 	}
5993f9349a8fSFrederic Weisbecker 
5994b9b0c831SNamhyung Kim 	seq_printf(m, "%ps\n", (void *)entry->ip);
5995ea4e2bc4SSteven Rostedt 
5996ea4e2bc4SSteven Rostedt 	return 0;
5997ea4e2bc4SSteven Rostedt }
5998ea4e2bc4SSteven Rostedt 
599988e9d34cSJames Morris static const struct seq_operations ftrace_graph_seq_ops = {
6000ea4e2bc4SSteven Rostedt 	.start = g_start,
6001ea4e2bc4SSteven Rostedt 	.next = g_next,
6002ea4e2bc4SSteven Rostedt 	.stop = g_stop,
6003ea4e2bc4SSteven Rostedt 	.show = g_show,
6004ea4e2bc4SSteven Rostedt };
6005ea4e2bc4SSteven Rostedt 
6006ea4e2bc4SSteven Rostedt static int
6007faf982a6SNamhyung Kim __ftrace_graph_open(struct inode *inode, struct file *file,
6008faf982a6SNamhyung Kim 		    struct ftrace_graph_data *fgd)
6009ea4e2bc4SSteven Rostedt {
601017911ff3SSteven Rostedt (VMware) 	int ret;
6011b9b0c831SNamhyung Kim 	struct ftrace_hash *new_hash = NULL;
6012ea4e2bc4SSteven Rostedt 
601317911ff3SSteven Rostedt (VMware) 	ret = security_locked_down(LOCKDOWN_TRACEFS);
601417911ff3SSteven Rostedt (VMware) 	if (ret)
601517911ff3SSteven Rostedt (VMware) 		return ret;
601617911ff3SSteven Rostedt (VMware) 
6017b9b0c831SNamhyung Kim 	if (file->f_mode & FMODE_WRITE) {
6018b9b0c831SNamhyung Kim 		const int size_bits = FTRACE_HASH_DEFAULT_BITS;
6019b9b0c831SNamhyung Kim 
6020e704eff3SSteven Rostedt (VMware) 		if (trace_parser_get_init(&fgd->parser, FTRACE_BUFF_MAX))
6021e704eff3SSteven Rostedt (VMware) 			return -ENOMEM;
6022e704eff3SSteven Rostedt (VMware) 
6023b9b0c831SNamhyung Kim 		if (file->f_flags & O_TRUNC)
6024b9b0c831SNamhyung Kim 			new_hash = alloc_ftrace_hash(size_bits);
6025b9b0c831SNamhyung Kim 		else
6026b9b0c831SNamhyung Kim 			new_hash = alloc_and_copy_ftrace_hash(size_bits,
6027b9b0c831SNamhyung Kim 							      fgd->hash);
6028b9b0c831SNamhyung Kim 		if (!new_hash) {
6029b9b0c831SNamhyung Kim 			ret = -ENOMEM;
6030b9b0c831SNamhyung Kim 			goto out;
6031ea4e2bc4SSteven Rostedt 		}
6032b9b0c831SNamhyung Kim 	}
6033ea4e2bc4SSteven Rostedt 
6034faf982a6SNamhyung Kim 	if (file->f_mode & FMODE_READ) {
6035b9b0c831SNamhyung Kim 		ret = seq_open(file, &ftrace_graph_seq_ops);
6036faf982a6SNamhyung Kim 		if (!ret) {
6037faf982a6SNamhyung Kim 			struct seq_file *m = file->private_data;
6038faf982a6SNamhyung Kim 			m->private = fgd;
6039b9b0c831SNamhyung Kim 		} else {
6040b9b0c831SNamhyung Kim 			/* Failed */
6041b9b0c831SNamhyung Kim 			free_ftrace_hash(new_hash);
6042b9b0c831SNamhyung Kim 			new_hash = NULL;
6043faf982a6SNamhyung Kim 		}
6044faf982a6SNamhyung Kim 	} else
6045faf982a6SNamhyung Kim 		file->private_data = fgd;
6046a4ec5e0cSLi Zefan 
6047b9b0c831SNamhyung Kim out:
6048e704eff3SSteven Rostedt (VMware) 	if (ret < 0 && file->f_mode & FMODE_WRITE)
6049e704eff3SSteven Rostedt (VMware) 		trace_parser_put(&fgd->parser);
6050e704eff3SSteven Rostedt (VMware) 
6051b9b0c831SNamhyung Kim 	fgd->new_hash = new_hash;
6052649b988bSSteven Rostedt (VMware) 
6053649b988bSSteven Rostedt (VMware) 	/*
6054649b988bSSteven Rostedt (VMware) 	 * All uses of fgd->hash must be taken with the graph_lock
6055649b988bSSteven Rostedt (VMware) 	 * held. The graph_lock is going to be released, so force
6056649b988bSSteven Rostedt (VMware) 	 * fgd->hash to be reinitialized when it is taken again.
6057649b988bSSteven Rostedt (VMware) 	 */
6058649b988bSSteven Rostedt (VMware) 	fgd->hash = NULL;
6059649b988bSSteven Rostedt (VMware) 
6060ea4e2bc4SSteven Rostedt 	return ret;
6061ea4e2bc4SSteven Rostedt }
6062ea4e2bc4SSteven Rostedt 
6063ea4e2bc4SSteven Rostedt static int
6064faf982a6SNamhyung Kim ftrace_graph_open(struct inode *inode, struct file *file)
6065faf982a6SNamhyung Kim {
6066faf982a6SNamhyung Kim 	struct ftrace_graph_data *fgd;
6067b9b0c831SNamhyung Kim 	int ret;
6068faf982a6SNamhyung Kim 
6069faf982a6SNamhyung Kim 	if (unlikely(ftrace_disabled))
6070faf982a6SNamhyung Kim 		return -ENODEV;
6071faf982a6SNamhyung Kim 
6072faf982a6SNamhyung Kim 	fgd = kmalloc(sizeof(*fgd), GFP_KERNEL);
6073faf982a6SNamhyung Kim 	if (fgd == NULL)
6074faf982a6SNamhyung Kim 		return -ENOMEM;
6075faf982a6SNamhyung Kim 
6076b9b0c831SNamhyung Kim 	mutex_lock(&graph_lock);
6077b9b0c831SNamhyung Kim 
6078649b988bSSteven Rostedt (VMware) 	fgd->hash = rcu_dereference_protected(ftrace_graph_hash,
6079649b988bSSteven Rostedt (VMware) 					lockdep_is_held(&graph_lock));
6080b9b0c831SNamhyung Kim 	fgd->type = GRAPH_FILTER_FUNCTION;
6081faf982a6SNamhyung Kim 	fgd->seq_ops = &ftrace_graph_seq_ops;
6082faf982a6SNamhyung Kim 
6083b9b0c831SNamhyung Kim 	ret = __ftrace_graph_open(inode, file, fgd);
6084b9b0c831SNamhyung Kim 	if (ret < 0)
6085b9b0c831SNamhyung Kim 		kfree(fgd);
6086b9b0c831SNamhyung Kim 
6087b9b0c831SNamhyung Kim 	mutex_unlock(&graph_lock);
6088b9b0c831SNamhyung Kim 	return ret;
6089faf982a6SNamhyung Kim }
6090faf982a6SNamhyung Kim 
6091faf982a6SNamhyung Kim static int
609229ad23b0SNamhyung Kim ftrace_graph_notrace_open(struct inode *inode, struct file *file)
609329ad23b0SNamhyung Kim {
609429ad23b0SNamhyung Kim 	struct ftrace_graph_data *fgd;
6095b9b0c831SNamhyung Kim 	int ret;
609629ad23b0SNamhyung Kim 
609729ad23b0SNamhyung Kim 	if (unlikely(ftrace_disabled))
609829ad23b0SNamhyung Kim 		return -ENODEV;
609929ad23b0SNamhyung Kim 
610029ad23b0SNamhyung Kim 	fgd = kmalloc(sizeof(*fgd), GFP_KERNEL);
610129ad23b0SNamhyung Kim 	if (fgd == NULL)
610229ad23b0SNamhyung Kim 		return -ENOMEM;
610329ad23b0SNamhyung Kim 
6104b9b0c831SNamhyung Kim 	mutex_lock(&graph_lock);
6105b9b0c831SNamhyung Kim 
6106649b988bSSteven Rostedt (VMware) 	fgd->hash = rcu_dereference_protected(ftrace_graph_notrace_hash,
6107649b988bSSteven Rostedt (VMware) 					lockdep_is_held(&graph_lock));
6108b9b0c831SNamhyung Kim 	fgd->type = GRAPH_FILTER_NOTRACE;
610929ad23b0SNamhyung Kim 	fgd->seq_ops = &ftrace_graph_seq_ops;
611029ad23b0SNamhyung Kim 
6111b9b0c831SNamhyung Kim 	ret = __ftrace_graph_open(inode, file, fgd);
6112b9b0c831SNamhyung Kim 	if (ret < 0)
6113b9b0c831SNamhyung Kim 		kfree(fgd);
6114b9b0c831SNamhyung Kim 
6115b9b0c831SNamhyung Kim 	mutex_unlock(&graph_lock);
6116b9b0c831SNamhyung Kim 	return ret;
611729ad23b0SNamhyung Kim }
611829ad23b0SNamhyung Kim 
611929ad23b0SNamhyung Kim static int
612087827111SLi Zefan ftrace_graph_release(struct inode *inode, struct file *file)
612187827111SLi Zefan {
6122b9b0c831SNamhyung Kim 	struct ftrace_graph_data *fgd;
6123e704eff3SSteven Rostedt (VMware) 	struct ftrace_hash *old_hash, *new_hash;
6124e704eff3SSteven Rostedt (VMware) 	struct trace_parser *parser;
6125e704eff3SSteven Rostedt (VMware) 	int ret = 0;
6126b9b0c831SNamhyung Kim 
6127faf982a6SNamhyung Kim 	if (file->f_mode & FMODE_READ) {
6128faf982a6SNamhyung Kim 		struct seq_file *m = file->private_data;
6129faf982a6SNamhyung Kim 
6130b9b0c831SNamhyung Kim 		fgd = m->private;
613187827111SLi Zefan 		seq_release(inode, file);
6132faf982a6SNamhyung Kim 	} else {
6133b9b0c831SNamhyung Kim 		fgd = file->private_data;
6134faf982a6SNamhyung Kim 	}
6135faf982a6SNamhyung Kim 
6136e704eff3SSteven Rostedt (VMware) 
6137e704eff3SSteven Rostedt (VMware) 	if (file->f_mode & FMODE_WRITE) {
6138e704eff3SSteven Rostedt (VMware) 
6139e704eff3SSteven Rostedt (VMware) 		parser = &fgd->parser;
6140e704eff3SSteven Rostedt (VMware) 
6141e704eff3SSteven Rostedt (VMware) 		if (trace_parser_loaded((parser))) {
6142e704eff3SSteven Rostedt (VMware) 			ret = ftrace_graph_set_hash(fgd->new_hash,
6143e704eff3SSteven Rostedt (VMware) 						    parser->buffer);
6144e704eff3SSteven Rostedt (VMware) 		}
6145e704eff3SSteven Rostedt (VMware) 
6146e704eff3SSteven Rostedt (VMware) 		trace_parser_put(parser);
6147e704eff3SSteven Rostedt (VMware) 
6148e704eff3SSteven Rostedt (VMware) 		new_hash = __ftrace_hash_move(fgd->new_hash);
6149e704eff3SSteven Rostedt (VMware) 		if (!new_hash) {
6150e704eff3SSteven Rostedt (VMware) 			ret = -ENOMEM;
6151e704eff3SSteven Rostedt (VMware) 			goto out;
6152e704eff3SSteven Rostedt (VMware) 		}
6153e704eff3SSteven Rostedt (VMware) 
6154e704eff3SSteven Rostedt (VMware) 		mutex_lock(&graph_lock);
6155e704eff3SSteven Rostedt (VMware) 
6156e704eff3SSteven Rostedt (VMware) 		if (fgd->type == GRAPH_FILTER_FUNCTION) {
6157e704eff3SSteven Rostedt (VMware) 			old_hash = rcu_dereference_protected(ftrace_graph_hash,
6158e704eff3SSteven Rostedt (VMware) 					lockdep_is_held(&graph_lock));
6159e704eff3SSteven Rostedt (VMware) 			rcu_assign_pointer(ftrace_graph_hash, new_hash);
6160e704eff3SSteven Rostedt (VMware) 		} else {
6161e704eff3SSteven Rostedt (VMware) 			old_hash = rcu_dereference_protected(ftrace_graph_notrace_hash,
6162e704eff3SSteven Rostedt (VMware) 					lockdep_is_held(&graph_lock));
6163e704eff3SSteven Rostedt (VMware) 			rcu_assign_pointer(ftrace_graph_notrace_hash, new_hash);
6164e704eff3SSteven Rostedt (VMware) 		}
6165e704eff3SSteven Rostedt (VMware) 
6166e704eff3SSteven Rostedt (VMware) 		mutex_unlock(&graph_lock);
6167e704eff3SSteven Rostedt (VMware) 
616854a16ff6SSteven Rostedt (VMware) 		/*
616954a16ff6SSteven Rostedt (VMware) 		 * We need to do a hard force of sched synchronization.
617054a16ff6SSteven Rostedt (VMware) 		 * This is because we use preempt_disable() to do RCU, but
617154a16ff6SSteven Rostedt (VMware) 		 * the function tracers can be called where RCU is not watching
617254a16ff6SSteven Rostedt (VMware) 		 * (like before user_exit()). We can not rely on the RCU
617354a16ff6SSteven Rostedt (VMware) 		 * infrastructure to do the synchronization, thus we must do it
617454a16ff6SSteven Rostedt (VMware) 		 * ourselves.
617554a16ff6SSteven Rostedt (VMware) 		 */
617668e83498SNicolas Saenz Julienne 		if (old_hash != EMPTY_HASH)
6177e5a971d7SPaul E. McKenney 			synchronize_rcu_tasks_rude();
6178e704eff3SSteven Rostedt (VMware) 
6179e704eff3SSteven Rostedt (VMware) 		free_ftrace_hash(old_hash);
6180e704eff3SSteven Rostedt (VMware) 	}
6181e704eff3SSteven Rostedt (VMware) 
6182e704eff3SSteven Rostedt (VMware)  out:
6183f9797c2fSLuis Henriques 	free_ftrace_hash(fgd->new_hash);
6184b9b0c831SNamhyung Kim 	kfree(fgd);
6185b9b0c831SNamhyung Kim 
6186e704eff3SSteven Rostedt (VMware) 	return ret;
618787827111SLi Zefan }
618887827111SLi Zefan 
618987827111SLi Zefan static int
6190b9b0c831SNamhyung Kim ftrace_graph_set_hash(struct ftrace_hash *hash, char *buffer)
6191ea4e2bc4SSteven Rostedt {
61923ba00929SDmitry Safonov 	struct ftrace_glob func_g;
6193ea4e2bc4SSteven Rostedt 	struct dyn_ftrace *rec;
6194ea4e2bc4SSteven Rostedt 	struct ftrace_page *pg;
6195b9b0c831SNamhyung Kim 	struct ftrace_func_entry *entry;
6196c7c6b1feSLi Zefan 	int fail = 1;
61973ba00929SDmitry Safonov 	int not;
6198ea4e2bc4SSteven Rostedt 
6199f9349a8fSFrederic Weisbecker 	/* decode regex */
62003ba00929SDmitry Safonov 	func_g.type = filter_parse_regex(buffer, strlen(buffer),
62013ba00929SDmitry Safonov 					 &func_g.search, &not);
6202f9349a8fSFrederic Weisbecker 
62033ba00929SDmitry Safonov 	func_g.len = strlen(func_g.search);
6204f9349a8fSFrederic Weisbecker 
620552baf119SSteven Rostedt 	mutex_lock(&ftrace_lock);
620645a4a237SSteven Rostedt 
620745a4a237SSteven Rostedt 	if (unlikely(ftrace_disabled)) {
620845a4a237SSteven Rostedt 		mutex_unlock(&ftrace_lock);
620945a4a237SSteven Rostedt 		return -ENODEV;
621045a4a237SSteven Rostedt 	}
621145a4a237SSteven Rostedt 
6212265c831cSSteven Rostedt 	do_for_each_ftrace_rec(pg, rec) {
6213ea4e2bc4SSteven Rostedt 
6214546fece4SSteven Rostedt (Red Hat) 		if (rec->flags & FTRACE_FL_DISABLED)
6215546fece4SSteven Rostedt (Red Hat) 			continue;
6216546fece4SSteven Rostedt (Red Hat) 
62170b507e1eSDmitry Safonov 		if (ftrace_match_record(rec, &func_g, NULL, 0)) {
6218b9b0c831SNamhyung Kim 			entry = ftrace_lookup_ip(hash, rec->ip);
6219c7c6b1feSLi Zefan 
6220c7c6b1feSLi Zefan 			if (!not) {
6221c7c6b1feSLi Zefan 				fail = 0;
6222b9b0c831SNamhyung Kim 
6223b9b0c831SNamhyung Kim 				if (entry)
6224b9b0c831SNamhyung Kim 					continue;
6225b9b0c831SNamhyung Kim 				if (add_hash_entry(hash, rec->ip) < 0)
6226c7c6b1feSLi Zefan 					goto out;
6227c7c6b1feSLi Zefan 			} else {
6228b9b0c831SNamhyung Kim 				if (entry) {
6229b9b0c831SNamhyung Kim 					free_hash_entry(hash, entry);
6230c7c6b1feSLi Zefan 					fail = 0;
6231c7c6b1feSLi Zefan 				}
6232c7c6b1feSLi Zefan 			}
6233f9349a8fSFrederic Weisbecker 		}
6234265c831cSSteven Rostedt 	} while_for_each_ftrace_rec();
6235c7c6b1feSLi Zefan out:
623652baf119SSteven Rostedt 	mutex_unlock(&ftrace_lock);
6237ea4e2bc4SSteven Rostedt 
6238c7c6b1feSLi Zefan 	if (fail)
6239c7c6b1feSLi Zefan 		return -EINVAL;
6240c7c6b1feSLi Zefan 
6241c7c6b1feSLi Zefan 	return 0;
6242ea4e2bc4SSteven Rostedt }
6243ea4e2bc4SSteven Rostedt 
6244ea4e2bc4SSteven Rostedt static ssize_t
6245ea4e2bc4SSteven Rostedt ftrace_graph_write(struct file *file, const char __user *ubuf,
6246ea4e2bc4SSteven Rostedt 		   size_t cnt, loff_t *ppos)
6247ea4e2bc4SSteven Rostedt {
62486a10108bSNamhyung Kim 	ssize_t read, ret = 0;
6249faf982a6SNamhyung Kim 	struct ftrace_graph_data *fgd = file->private_data;
6250e704eff3SSteven Rostedt (VMware) 	struct trace_parser *parser;
6251ea4e2bc4SSteven Rostedt 
6252c7c6b1feSLi Zefan 	if (!cnt)
6253ea4e2bc4SSteven Rostedt 		return 0;
6254ea4e2bc4SSteven Rostedt 
6255ae98d27aSSteven Rostedt (VMware) 	/* Read mode uses seq functions */
6256ae98d27aSSteven Rostedt (VMware) 	if (file->f_mode & FMODE_READ) {
6257ae98d27aSSteven Rostedt (VMware) 		struct seq_file *m = file->private_data;
6258ae98d27aSSteven Rostedt (VMware) 		fgd = m->private;
6259ae98d27aSSteven Rostedt (VMware) 	}
6260ae98d27aSSteven Rostedt (VMware) 
6261e704eff3SSteven Rostedt (VMware) 	parser = &fgd->parser;
6262689fd8b6S[email protected] 
6263e704eff3SSteven Rostedt (VMware) 	read = trace_get_user(parser, ubuf, cnt, ppos);
6264ea4e2bc4SSteven Rostedt 
6265e704eff3SSteven Rostedt (VMware) 	if (read >= 0 && trace_parser_loaded(parser) &&
6266e704eff3SSteven Rostedt (VMware) 	    !trace_parser_cont(parser)) {
62676a10108bSNamhyung Kim 
6268b9b0c831SNamhyung Kim 		ret = ftrace_graph_set_hash(fgd->new_hash,
6269e704eff3SSteven Rostedt (VMware) 					    parser->buffer);
6270e704eff3SSteven Rostedt (VMware) 		trace_parser_clear(parser);
6271689fd8b6S[email protected] 	}
6272ea4e2bc4SSteven Rostedt 
62736a10108bSNamhyung Kim 	if (!ret)
6274ea4e2bc4SSteven Rostedt 		ret = read;
62751eb90f13SLi Zefan 
6276ea4e2bc4SSteven Rostedt 	return ret;
6277ea4e2bc4SSteven Rostedt }
6278ea4e2bc4SSteven Rostedt 
6279ea4e2bc4SSteven Rostedt static const struct file_operations ftrace_graph_fops = {
6280ea4e2bc4SSteven Rostedt 	.open		= ftrace_graph_open,
6281850a80cfSLai Jiangshan 	.read		= seq_read,
6282ea4e2bc4SSteven Rostedt 	.write		= ftrace_graph_write,
6283098c879eSSteven Rostedt (Red Hat) 	.llseek		= tracing_lseek,
628487827111SLi Zefan 	.release	= ftrace_graph_release,
6285ea4e2bc4SSteven Rostedt };
628629ad23b0SNamhyung Kim 
628729ad23b0SNamhyung Kim static const struct file_operations ftrace_graph_notrace_fops = {
628829ad23b0SNamhyung Kim 	.open		= ftrace_graph_notrace_open,
628929ad23b0SNamhyung Kim 	.read		= seq_read,
629029ad23b0SNamhyung Kim 	.write		= ftrace_graph_write,
6291098c879eSSteven Rostedt (Red Hat) 	.llseek		= tracing_lseek,
629229ad23b0SNamhyung Kim 	.release	= ftrace_graph_release,
629329ad23b0SNamhyung Kim };
6294ea4e2bc4SSteven Rostedt #endif /* CONFIG_FUNCTION_GRAPH_TRACER */
6295ea4e2bc4SSteven Rostedt 
6296591dffdaSSteven Rostedt (Red Hat) void ftrace_create_filter_files(struct ftrace_ops *ops,
6297591dffdaSSteven Rostedt (Red Hat) 				struct dentry *parent)
6298591dffdaSSteven Rostedt (Red Hat) {
6299591dffdaSSteven Rostedt (Red Hat) 
630021ccc9cdSSteven Rostedt (VMware) 	trace_create_file("set_ftrace_filter", TRACE_MODE_WRITE, parent,
6301591dffdaSSteven Rostedt (Red Hat) 			  ops, &ftrace_filter_fops);
6302591dffdaSSteven Rostedt (Red Hat) 
630321ccc9cdSSteven Rostedt (VMware) 	trace_create_file("set_ftrace_notrace", TRACE_MODE_WRITE, parent,
6304591dffdaSSteven Rostedt (Red Hat) 			  ops, &ftrace_notrace_fops);
6305591dffdaSSteven Rostedt (Red Hat) }
6306591dffdaSSteven Rostedt (Red Hat) 
6307591dffdaSSteven Rostedt (Red Hat) /*
6308591dffdaSSteven Rostedt (Red Hat)  * The name "destroy_filter_files" is really a misnomer. Although
63099efb85c5SHariprasad Kelam  * in the future, it may actually delete the files, but this is
6310591dffdaSSteven Rostedt (Red Hat)  * really intended to make sure the ops passed in are disabled
6311591dffdaSSteven Rostedt (Red Hat)  * and that when this function returns, the caller is free to
6312591dffdaSSteven Rostedt (Red Hat)  * free the ops.
6313591dffdaSSteven Rostedt (Red Hat)  *
6314591dffdaSSteven Rostedt (Red Hat)  * The "destroy" name is only to match the "create" name that this
6315591dffdaSSteven Rostedt (Red Hat)  * should be paired with.
6316591dffdaSSteven Rostedt (Red Hat)  */
6317591dffdaSSteven Rostedt (Red Hat) void ftrace_destroy_filter_files(struct ftrace_ops *ops)
6318591dffdaSSteven Rostedt (Red Hat) {
6319591dffdaSSteven Rostedt (Red Hat) 	mutex_lock(&ftrace_lock);
6320591dffdaSSteven Rostedt (Red Hat) 	if (ops->flags & FTRACE_OPS_FL_ENABLED)
6321591dffdaSSteven Rostedt (Red Hat) 		ftrace_shutdown(ops, 0);
6322591dffdaSSteven Rostedt (Red Hat) 	ops->flags |= FTRACE_OPS_FL_DELETED;
63232840f84fSSteven Rostedt (VMware) 	ftrace_free_filter(ops);
6324591dffdaSSteven Rostedt (Red Hat) 	mutex_unlock(&ftrace_lock);
6325591dffdaSSteven Rostedt (Red Hat) }
6326591dffdaSSteven Rostedt (Red Hat) 
63278434dc93SSteven Rostedt (Red Hat) static __init int ftrace_init_dyn_tracefs(struct dentry *d_tracer)
63285072c59fSSteven Rostedt {
63295072c59fSSteven Rostedt 
633021ccc9cdSSteven Rostedt (VMware) 	trace_create_file("available_filter_functions", TRACE_MODE_READ,
63315072c59fSSteven Rostedt 			d_tracer, NULL, &ftrace_avail_fops);
63325072c59fSSteven Rostedt 
633321ccc9cdSSteven Rostedt (VMware) 	trace_create_file("enabled_functions", TRACE_MODE_READ,
6334647bcd03SSteven Rostedt 			d_tracer, NULL, &ftrace_enabled_fops);
6335647bcd03SSteven Rostedt 
6336591dffdaSSteven Rostedt (Red Hat) 	ftrace_create_filter_files(&global_ops, d_tracer);
6337ad90c0e3SSteven Rostedt 
6338ea4e2bc4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
633921ccc9cdSSteven Rostedt (VMware) 	trace_create_file("set_graph_function", TRACE_MODE_WRITE, d_tracer,
6340ea4e2bc4SSteven Rostedt 				    NULL,
6341ea4e2bc4SSteven Rostedt 				    &ftrace_graph_fops);
634221ccc9cdSSteven Rostedt (VMware) 	trace_create_file("set_graph_notrace", TRACE_MODE_WRITE, d_tracer,
634329ad23b0SNamhyung Kim 				    NULL,
634429ad23b0SNamhyung Kim 				    &ftrace_graph_notrace_fops);
6345ea4e2bc4SSteven Rostedt #endif /* CONFIG_FUNCTION_GRAPH_TRACER */
6346ea4e2bc4SSteven Rostedt 
63475072c59fSSteven Rostedt 	return 0;
63485072c59fSSteven Rostedt }
63495072c59fSSteven Rostedt 
63509fd49328SSteven Rostedt static int ftrace_cmp_ips(const void *a, const void *b)
635168950619SSteven Rostedt {
63529fd49328SSteven Rostedt 	const unsigned long *ipa = a;
63539fd49328SSteven Rostedt 	const unsigned long *ipb = b;
635468950619SSteven Rostedt 
63559fd49328SSteven Rostedt 	if (*ipa > *ipb)
63569fd49328SSteven Rostedt 		return 1;
63579fd49328SSteven Rostedt 	if (*ipa < *ipb)
63589fd49328SSteven Rostedt 		return -1;
63599fd49328SSteven Rostedt 	return 0;
63609fd49328SSteven Rostedt }
63619fd49328SSteven Rostedt 
63628147dc78SSteven Rostedt (VMware) #ifdef CONFIG_FTRACE_SORT_STARTUP_TEST
63638147dc78SSteven Rostedt (VMware) static void test_is_sorted(unsigned long *start, unsigned long count)
63648147dc78SSteven Rostedt (VMware) {
63658147dc78SSteven Rostedt (VMware) 	int i;
63668147dc78SSteven Rostedt (VMware) 
63678147dc78SSteven Rostedt (VMware) 	for (i = 1; i < count; i++) {
63688147dc78SSteven Rostedt (VMware) 		if (WARN(start[i - 1] > start[i],
63698147dc78SSteven Rostedt (VMware) 			 "[%d] %pS at %lx is not sorted with %pS at %lx\n", i,
63708147dc78SSteven Rostedt (VMware) 			 (void *)start[i - 1], start[i - 1],
63718147dc78SSteven Rostedt (VMware) 			 (void *)start[i], start[i]))
63728147dc78SSteven Rostedt (VMware) 			break;
63738147dc78SSteven Rostedt (VMware) 	}
63748147dc78SSteven Rostedt (VMware) 	if (i == count)
63758147dc78SSteven Rostedt (VMware) 		pr_info("ftrace section at %px sorted properly\n", start);
63768147dc78SSteven Rostedt (VMware) }
63778147dc78SSteven Rostedt (VMware) #else
63788147dc78SSteven Rostedt (VMware) static void test_is_sorted(unsigned long *start, unsigned long count)
63798147dc78SSteven Rostedt (VMware) {
63808147dc78SSteven Rostedt (VMware) }
63818147dc78SSteven Rostedt (VMware) #endif
63828147dc78SSteven Rostedt (VMware) 
63835cb084bbSJiri Olsa static int ftrace_process_locs(struct module *mod,
638431e88909SSteven Rostedt 			       unsigned long *start,
638568bf21aaSSteven Rostedt 			       unsigned long *end)
638668bf21aaSSteven Rostedt {
6387706c81f8SSteven Rostedt 	struct ftrace_page *start_pg;
6388a7900875SSteven Rostedt 	struct ftrace_page *pg;
6389706c81f8SSteven Rostedt 	struct dyn_ftrace *rec;
6390a7900875SSteven Rostedt 	unsigned long count;
639168bf21aaSSteven Rostedt 	unsigned long *p;
639268bf21aaSSteven Rostedt 	unsigned long addr;
63934376cac6SSteven Rostedt 	unsigned long flags = 0; /* Shut up gcc */
6394a7900875SSteven Rostedt 	int ret = -ENOMEM;
6395a7900875SSteven Rostedt 
6396a7900875SSteven Rostedt 	count = end - start;
6397a7900875SSteven Rostedt 
6398a7900875SSteven Rostedt 	if (!count)
6399a7900875SSteven Rostedt 		return 0;
6400a7900875SSteven Rostedt 
640172b3942aSYinan Liu 	/*
640272b3942aSYinan Liu 	 * Sorting mcount in vmlinux at build time depend on
64036b9b6413SSteven Rostedt (Google) 	 * CONFIG_BUILDTIME_MCOUNT_SORT, while mcount loc in
640472b3942aSYinan Liu 	 * modules can not be sorted at build time.
640572b3942aSYinan Liu 	 */
64066b9b6413SSteven Rostedt (Google) 	if (!IS_ENABLED(CONFIG_BUILDTIME_MCOUNT_SORT) || mod) {
64079fd49328SSteven Rostedt 		sort(start, count, sizeof(*start),
64086db02903SRasmus Villemoes 		     ftrace_cmp_ips, NULL);
64098147dc78SSteven Rostedt (VMware) 	} else {
64108147dc78SSteven Rostedt (VMware) 		test_is_sorted(start, count);
641172b3942aSYinan Liu 	}
64129fd49328SSteven Rostedt 
6413706c81f8SSteven Rostedt 	start_pg = ftrace_allocate_pages(count);
6414706c81f8SSteven Rostedt 	if (!start_pg)
6415a7900875SSteven Rostedt 		return -ENOMEM;
641668bf21aaSSteven Rostedt 
6417e6ea44e9SSteven Rostedt 	mutex_lock(&ftrace_lock);
6418a7900875SSteven Rostedt 
641932082309SSteven Rostedt 	/*
642032082309SSteven Rostedt 	 * Core and each module needs their own pages, as
642132082309SSteven Rostedt 	 * modules will free them when they are removed.
642232082309SSteven Rostedt 	 * Force a new page to be allocated for modules.
642332082309SSteven Rostedt 	 */
6424a7900875SSteven Rostedt 	if (!mod) {
6425a7900875SSteven Rostedt 		WARN_ON(ftrace_pages || ftrace_pages_start);
6426a7900875SSteven Rostedt 		/* First initialization */
6427706c81f8SSteven Rostedt 		ftrace_pages = ftrace_pages_start = start_pg;
6428a7900875SSteven Rostedt 	} else {
642932082309SSteven Rostedt 		if (!ftrace_pages)
6430a7900875SSteven Rostedt 			goto out;
643132082309SSteven Rostedt 
6432a7900875SSteven Rostedt 		if (WARN_ON(ftrace_pages->next)) {
6433a7900875SSteven Rostedt 			/* Hmm, we have free pages? */
6434a7900875SSteven Rostedt 			while (ftrace_pages->next)
643532082309SSteven Rostedt 				ftrace_pages = ftrace_pages->next;
643632082309SSteven Rostedt 		}
6437a7900875SSteven Rostedt 
6438706c81f8SSteven Rostedt 		ftrace_pages->next = start_pg;
643932082309SSteven Rostedt 	}
644032082309SSteven Rostedt 
644168bf21aaSSteven Rostedt 	p = start;
6442706c81f8SSteven Rostedt 	pg = start_pg;
644368bf21aaSSteven Rostedt 	while (p < end) {
6444db42523bSLinus Torvalds 		unsigned long end_offset;
644568bf21aaSSteven Rostedt 		addr = ftrace_call_adjust(*p++);
644620e5227eSSteven Rostedt 		/*
644720e5227eSSteven Rostedt 		 * Some architecture linkers will pad between
644820e5227eSSteven Rostedt 		 * the different mcount_loc sections of different
644920e5227eSSteven Rostedt 		 * object files to satisfy alignments.
645020e5227eSSteven Rostedt 		 * Skip any NULL pointers.
645120e5227eSSteven Rostedt 		 */
645220e5227eSSteven Rostedt 		if (!addr)
645320e5227eSSteven Rostedt 			continue;
6454706c81f8SSteven Rostedt 
6455db42523bSLinus Torvalds 		end_offset = (pg->index+1) * sizeof(pg->records[0]);
6456db42523bSLinus Torvalds 		if (end_offset > PAGE_SIZE << pg->order) {
6457706c81f8SSteven Rostedt 			/* We should have allocated enough */
6458706c81f8SSteven Rostedt 			if (WARN_ON(!pg->next))
6459a7900875SSteven Rostedt 				break;
6460706c81f8SSteven Rostedt 			pg = pg->next;
646168bf21aaSSteven Rostedt 		}
646268bf21aaSSteven Rostedt 
6463706c81f8SSteven Rostedt 		rec = &pg->records[pg->index++];
6464706c81f8SSteven Rostedt 		rec->ip = addr;
6465706c81f8SSteven Rostedt 	}
6466706c81f8SSteven Rostedt 
6467706c81f8SSteven Rostedt 	/* We should have used all pages */
6468706c81f8SSteven Rostedt 	WARN_ON(pg->next);
6469706c81f8SSteven Rostedt 
6470706c81f8SSteven Rostedt 	/* Assign the last page to ftrace_pages */
6471706c81f8SSteven Rostedt 	ftrace_pages = pg;
6472706c81f8SSteven Rostedt 
6473a4f18ed1SSteven Rostedt 	/*
64744376cac6SSteven Rostedt 	 * We only need to disable interrupts on start up
64754376cac6SSteven Rostedt 	 * because we are modifying code that an interrupt
64764376cac6SSteven Rostedt 	 * may execute, and the modification is not atomic.
64774376cac6SSteven Rostedt 	 * But for modules, nothing runs the code we modify
64784376cac6SSteven Rostedt 	 * until we are finished with it, and there's no
64794376cac6SSteven Rostedt 	 * reason to cause large interrupt latencies while we do it.
6480a4f18ed1SSteven Rostedt 	 */
64814376cac6SSteven Rostedt 	if (!mod)
6482a4f18ed1SSteven Rostedt 		local_irq_save(flags);
64831dc43cf0SJiri Slaby 	ftrace_update_code(mod, start_pg);
64844376cac6SSteven Rostedt 	if (!mod)
6485a4f18ed1SSteven Rostedt 		local_irq_restore(flags);
6486a7900875SSteven Rostedt 	ret = 0;
6487a7900875SSteven Rostedt  out:
6488e6ea44e9SSteven Rostedt 	mutex_unlock(&ftrace_lock);
648968bf21aaSSteven Rostedt 
6490a7900875SSteven Rostedt 	return ret;
649168bf21aaSSteven Rostedt }
649268bf21aaSSteven Rostedt 
6493aba4b5c2SSteven Rostedt (VMware) struct ftrace_mod_func {
6494aba4b5c2SSteven Rostedt (VMware) 	struct list_head	list;
6495aba4b5c2SSteven Rostedt (VMware) 	char			*name;
6496aba4b5c2SSteven Rostedt (VMware) 	unsigned long		ip;
6497aba4b5c2SSteven Rostedt (VMware) 	unsigned int		size;
6498aba4b5c2SSteven Rostedt (VMware) };
6499aba4b5c2SSteven Rostedt (VMware) 
6500aba4b5c2SSteven Rostedt (VMware) struct ftrace_mod_map {
65016aa69784SSteven Rostedt (VMware) 	struct rcu_head		rcu;
6502aba4b5c2SSteven Rostedt (VMware) 	struct list_head	list;
6503aba4b5c2SSteven Rostedt (VMware) 	struct module		*mod;
6504aba4b5c2SSteven Rostedt (VMware) 	unsigned long		start_addr;
6505aba4b5c2SSteven Rostedt (VMware) 	unsigned long		end_addr;
6506aba4b5c2SSteven Rostedt (VMware) 	struct list_head	funcs;
65076171a031SSteven Rostedt (VMware) 	unsigned int		num_funcs;
6508aba4b5c2SSteven Rostedt (VMware) };
6509aba4b5c2SSteven Rostedt (VMware) 
6510fc0ea795SAdrian Hunter static int ftrace_get_trampoline_kallsym(unsigned int symnum,
6511fc0ea795SAdrian Hunter 					 unsigned long *value, char *type,
6512fc0ea795SAdrian Hunter 					 char *name, char *module_name,
6513fc0ea795SAdrian Hunter 					 int *exported)
6514fc0ea795SAdrian Hunter {
6515fc0ea795SAdrian Hunter 	struct ftrace_ops *op;
6516fc0ea795SAdrian Hunter 
6517fc0ea795SAdrian Hunter 	list_for_each_entry_rcu(op, &ftrace_ops_trampoline_list, list) {
6518fc0ea795SAdrian Hunter 		if (!op->trampoline || symnum--)
6519fc0ea795SAdrian Hunter 			continue;
6520fc0ea795SAdrian Hunter 		*value = op->trampoline;
6521fc0ea795SAdrian Hunter 		*type = 't';
6522fc0ea795SAdrian Hunter 		strlcpy(name, FTRACE_TRAMPOLINE_SYM, KSYM_NAME_LEN);
6523fc0ea795SAdrian Hunter 		strlcpy(module_name, FTRACE_TRAMPOLINE_MOD, MODULE_NAME_LEN);
6524fc0ea795SAdrian Hunter 		*exported = 0;
6525fc0ea795SAdrian Hunter 		return 0;
6526fc0ea795SAdrian Hunter 	}
6527fc0ea795SAdrian Hunter 
6528fc0ea795SAdrian Hunter 	return -ERANGE;
6529fc0ea795SAdrian Hunter }
6530fc0ea795SAdrian Hunter 
6531123d6455SWang Jingjin #if defined(CONFIG_DYNAMIC_FTRACE_WITH_DIRECT_CALLS) || defined(CONFIG_MODULES)
6532123d6455SWang Jingjin /*
6533123d6455SWang Jingjin  * Check if the current ops references the given ip.
6534123d6455SWang Jingjin  *
6535123d6455SWang Jingjin  * If the ops traces all functions, then it was already accounted for.
6536123d6455SWang Jingjin  * If the ops does not trace the current record function, skip it.
6537123d6455SWang Jingjin  * If the ops ignores the function via notrace filter, skip it.
6538123d6455SWang Jingjin  */
6539123d6455SWang Jingjin static bool
6540123d6455SWang Jingjin ops_references_ip(struct ftrace_ops *ops, unsigned long ip)
6541123d6455SWang Jingjin {
6542123d6455SWang Jingjin 	/* If ops isn't enabled, ignore it */
6543123d6455SWang Jingjin 	if (!(ops->flags & FTRACE_OPS_FL_ENABLED))
6544123d6455SWang Jingjin 		return false;
6545123d6455SWang Jingjin 
6546123d6455SWang Jingjin 	/* If ops traces all then it includes this function */
6547123d6455SWang Jingjin 	if (ops_traces_mod(ops))
6548123d6455SWang Jingjin 		return true;
6549123d6455SWang Jingjin 
6550123d6455SWang Jingjin 	/* The function must be in the filter */
6551123d6455SWang Jingjin 	if (!ftrace_hash_empty(ops->func_hash->filter_hash) &&
6552123d6455SWang Jingjin 	    !__ftrace_lookup_ip(ops->func_hash->filter_hash, ip))
6553123d6455SWang Jingjin 		return false;
6554123d6455SWang Jingjin 
6555123d6455SWang Jingjin 	/* If in notrace hash, we ignore it too */
6556123d6455SWang Jingjin 	if (ftrace_lookup_ip(ops->func_hash->notrace_hash, ip))
6557123d6455SWang Jingjin 		return false;
6558123d6455SWang Jingjin 
6559123d6455SWang Jingjin 	return true;
6560123d6455SWang Jingjin }
6561123d6455SWang Jingjin #endif
6562123d6455SWang Jingjin 
656393eb677dSSteven Rostedt #ifdef CONFIG_MODULES
656432082309SSteven Rostedt 
656532082309SSteven Rostedt #define next_to_ftrace_page(p) container_of(p, struct ftrace_page, next)
656632082309SSteven Rostedt 
65676aa69784SSteven Rostedt (VMware) static LIST_HEAD(ftrace_mod_maps);
65686aa69784SSteven Rostedt (VMware) 
6569b7ffffbbSSteven Rostedt (Red Hat) static int referenced_filters(struct dyn_ftrace *rec)
6570b7ffffbbSSteven Rostedt (Red Hat) {
6571b7ffffbbSSteven Rostedt (Red Hat) 	struct ftrace_ops *ops;
6572b7ffffbbSSteven Rostedt (Red Hat) 	int cnt = 0;
6573b7ffffbbSSteven Rostedt (Red Hat) 
6574b7ffffbbSSteven Rostedt (Red Hat) 	for (ops = ftrace_ops_list; ops != &ftrace_list_end; ops = ops->next) {
6575123d6455SWang Jingjin 		if (ops_references_ip(ops, rec->ip)) {
6576c5f51572SChengming Zhou 			if (WARN_ON_ONCE(ops->flags & FTRACE_OPS_FL_DIRECT))
6577c5f51572SChengming Zhou 				continue;
6578c5f51572SChengming Zhou 			if (WARN_ON_ONCE(ops->flags & FTRACE_OPS_FL_IPMODIFY))
6579c5f51572SChengming Zhou 				continue;
6580b7ffffbbSSteven Rostedt (Red Hat) 			cnt++;
65818a224ffbSChengming Zhou 			if (ops->flags & FTRACE_OPS_FL_SAVE_REGS)
65828a224ffbSChengming Zhou 				rec->flags |= FTRACE_FL_REGS;
6583c5f51572SChengming Zhou 			if (cnt == 1 && ops->trampoline)
6584c5f51572SChengming Zhou 				rec->flags |= FTRACE_FL_TRAMP;
6585c5f51572SChengming Zhou 			else
6586c5f51572SChengming Zhou 				rec->flags &= ~FTRACE_FL_TRAMP;
65878a224ffbSChengming Zhou 		}
6588b7ffffbbSSteven Rostedt (Red Hat) 	}
6589b7ffffbbSSteven Rostedt (Red Hat) 
6590b7ffffbbSSteven Rostedt (Red Hat) 	return cnt;
6591b7ffffbbSSteven Rostedt (Red Hat) }
6592b7ffffbbSSteven Rostedt (Red Hat) 
65932a5bfe47SSteven Rostedt (VMware) static void
65942a5bfe47SSteven Rostedt (VMware) clear_mod_from_hash(struct ftrace_page *pg, struct ftrace_hash *hash)
65952a5bfe47SSteven Rostedt (VMware) {
65962a5bfe47SSteven Rostedt (VMware) 	struct ftrace_func_entry *entry;
65972a5bfe47SSteven Rostedt (VMware) 	struct dyn_ftrace *rec;
65982a5bfe47SSteven Rostedt (VMware) 	int i;
65992a5bfe47SSteven Rostedt (VMware) 
66002a5bfe47SSteven Rostedt (VMware) 	if (ftrace_hash_empty(hash))
66012a5bfe47SSteven Rostedt (VMware) 		return;
66022a5bfe47SSteven Rostedt (VMware) 
66032a5bfe47SSteven Rostedt (VMware) 	for (i = 0; i < pg->index; i++) {
66042a5bfe47SSteven Rostedt (VMware) 		rec = &pg->records[i];
66052a5bfe47SSteven Rostedt (VMware) 		entry = __ftrace_lookup_ip(hash, rec->ip);
66062a5bfe47SSteven Rostedt (VMware) 		/*
66072a5bfe47SSteven Rostedt (VMware) 		 * Do not allow this rec to match again.
66082a5bfe47SSteven Rostedt (VMware) 		 * Yeah, it may waste some memory, but will be removed
66092a5bfe47SSteven Rostedt (VMware) 		 * if/when the hash is modified again.
66102a5bfe47SSteven Rostedt (VMware) 		 */
66112a5bfe47SSteven Rostedt (VMware) 		if (entry)
66122a5bfe47SSteven Rostedt (VMware) 			entry->ip = 0;
66132a5bfe47SSteven Rostedt (VMware) 	}
66142a5bfe47SSteven Rostedt (VMware) }
66152a5bfe47SSteven Rostedt (VMware) 
6616f2cc020dSIngo Molnar /* Clear any records from hashes */
66172a5bfe47SSteven Rostedt (VMware) static void clear_mod_from_hashes(struct ftrace_page *pg)
66182a5bfe47SSteven Rostedt (VMware) {
66192a5bfe47SSteven Rostedt (VMware) 	struct trace_array *tr;
66202a5bfe47SSteven Rostedt (VMware) 
66212a5bfe47SSteven Rostedt (VMware) 	mutex_lock(&trace_types_lock);
66222a5bfe47SSteven Rostedt (VMware) 	list_for_each_entry(tr, &ftrace_trace_arrays, list) {
66232a5bfe47SSteven Rostedt (VMware) 		if (!tr->ops || !tr->ops->func_hash)
66242a5bfe47SSteven Rostedt (VMware) 			continue;
66252a5bfe47SSteven Rostedt (VMware) 		mutex_lock(&tr->ops->func_hash->regex_lock);
66262a5bfe47SSteven Rostedt (VMware) 		clear_mod_from_hash(pg, tr->ops->func_hash->filter_hash);
66272a5bfe47SSteven Rostedt (VMware) 		clear_mod_from_hash(pg, tr->ops->func_hash->notrace_hash);
66282a5bfe47SSteven Rostedt (VMware) 		mutex_unlock(&tr->ops->func_hash->regex_lock);
66292a5bfe47SSteven Rostedt (VMware) 	}
66302a5bfe47SSteven Rostedt (VMware) 	mutex_unlock(&trace_types_lock);
66312a5bfe47SSteven Rostedt (VMware) }
66322a5bfe47SSteven Rostedt (VMware) 
66336aa69784SSteven Rostedt (VMware) static void ftrace_free_mod_map(struct rcu_head *rcu)
66346aa69784SSteven Rostedt (VMware) {
66356aa69784SSteven Rostedt (VMware) 	struct ftrace_mod_map *mod_map = container_of(rcu, struct ftrace_mod_map, rcu);
66366aa69784SSteven Rostedt (VMware) 	struct ftrace_mod_func *mod_func;
66376aa69784SSteven Rostedt (VMware) 	struct ftrace_mod_func *n;
66386aa69784SSteven Rostedt (VMware) 
66396aa69784SSteven Rostedt (VMware) 	/* All the contents of mod_map are now not visible to readers */
66406aa69784SSteven Rostedt (VMware) 	list_for_each_entry_safe(mod_func, n, &mod_map->funcs, list) {
66416aa69784SSteven Rostedt (VMware) 		kfree(mod_func->name);
66426aa69784SSteven Rostedt (VMware) 		list_del(&mod_func->list);
66436aa69784SSteven Rostedt (VMware) 		kfree(mod_func);
66446aa69784SSteven Rostedt (VMware) 	}
66456aa69784SSteven Rostedt (VMware) 
66466aa69784SSteven Rostedt (VMware) 	kfree(mod_map);
66476aa69784SSteven Rostedt (VMware) }
66486aa69784SSteven Rostedt (VMware) 
6649e7247a15S[email protected] void ftrace_release_mod(struct module *mod)
665093eb677dSSteven Rostedt {
66516aa69784SSteven Rostedt (VMware) 	struct ftrace_mod_map *mod_map;
66526aa69784SSteven Rostedt (VMware) 	struct ftrace_mod_map *n;
665393eb677dSSteven Rostedt 	struct dyn_ftrace *rec;
665432082309SSteven Rostedt 	struct ftrace_page **last_pg;
66552a5bfe47SSteven Rostedt (VMware) 	struct ftrace_page *tmp_page = NULL;
665693eb677dSSteven Rostedt 	struct ftrace_page *pg;
665793eb677dSSteven Rostedt 
665893eb677dSSteven Rostedt 	mutex_lock(&ftrace_lock);
665945a4a237SSteven Rostedt 
666045a4a237SSteven Rostedt 	if (ftrace_disabled)
666145a4a237SSteven Rostedt 		goto out_unlock;
666245a4a237SSteven Rostedt 
66636aa69784SSteven Rostedt (VMware) 	list_for_each_entry_safe(mod_map, n, &ftrace_mod_maps, list) {
66646aa69784SSteven Rostedt (VMware) 		if (mod_map->mod == mod) {
66656aa69784SSteven Rostedt (VMware) 			list_del_rcu(&mod_map->list);
666674401729SPaul E. McKenney 			call_rcu(&mod_map->rcu, ftrace_free_mod_map);
66676aa69784SSteven Rostedt (VMware) 			break;
66686aa69784SSteven Rostedt (VMware) 		}
66696aa69784SSteven Rostedt (VMware) 	}
66706aa69784SSteven Rostedt (VMware) 
667132082309SSteven Rostedt 	/*
667232082309SSteven Rostedt 	 * Each module has its own ftrace_pages, remove
667332082309SSteven Rostedt 	 * them from the list.
667432082309SSteven Rostedt 	 */
667532082309SSteven Rostedt 	last_pg = &ftrace_pages_start;
667632082309SSteven Rostedt 	for (pg = ftrace_pages_start; pg; pg = *last_pg) {
667732082309SSteven Rostedt 		rec = &pg->records[0];
66783e234289SSteven Rostedt (VMware) 		if (within_module_core(rec->ip, mod) ||
66793e234289SSteven Rostedt (VMware) 		    within_module_init(rec->ip, mod)) {
668093eb677dSSteven Rostedt 			/*
668132082309SSteven Rostedt 			 * As core pages are first, the first
668232082309SSteven Rostedt 			 * page should never be a module page.
668393eb677dSSteven Rostedt 			 */
668432082309SSteven Rostedt 			if (WARN_ON(pg == ftrace_pages_start))
668532082309SSteven Rostedt 				goto out_unlock;
668632082309SSteven Rostedt 
668732082309SSteven Rostedt 			/* Check if we are deleting the last page */
668832082309SSteven Rostedt 			if (pg == ftrace_pages)
668932082309SSteven Rostedt 				ftrace_pages = next_to_ftrace_page(last_pg);
669032082309SSteven Rostedt 
669183dd1493SSteven Rostedt (VMware) 			ftrace_update_tot_cnt -= pg->index;
669232082309SSteven Rostedt 			*last_pg = pg->next;
66932a5bfe47SSteven Rostedt (VMware) 
66942a5bfe47SSteven Rostedt (VMware) 			pg->next = tmp_page;
66952a5bfe47SSteven Rostedt (VMware) 			tmp_page = pg;
669632082309SSteven Rostedt 		} else
669732082309SSteven Rostedt 			last_pg = &pg->next;
669893eb677dSSteven Rostedt 	}
669945a4a237SSteven Rostedt  out_unlock:
670093eb677dSSteven Rostedt 	mutex_unlock(&ftrace_lock);
67012a5bfe47SSteven Rostedt (VMware) 
67022a5bfe47SSteven Rostedt (VMware) 	for (pg = tmp_page; pg; pg = tmp_page) {
67032a5bfe47SSteven Rostedt (VMware) 
67042a5bfe47SSteven Rostedt (VMware) 		/* Needs to be called outside of ftrace_lock */
67052a5bfe47SSteven Rostedt (VMware) 		clear_mod_from_hashes(pg);
67062a5bfe47SSteven Rostedt (VMware) 
6707db42523bSLinus Torvalds 		if (pg->records) {
6708db42523bSLinus Torvalds 			free_pages((unsigned long)pg->records, pg->order);
6709db42523bSLinus Torvalds 			ftrace_number_of_pages -= 1 << pg->order;
6710db42523bSLinus Torvalds 		}
67112a5bfe47SSteven Rostedt (VMware) 		tmp_page = pg->next;
67122a5bfe47SSteven Rostedt (VMware) 		kfree(pg);
6713da537f0aSSteven Rostedt (VMware) 		ftrace_number_of_groups--;
67142a5bfe47SSteven Rostedt (VMware) 	}
671593eb677dSSteven Rostedt }
671693eb677dSSteven Rostedt 
67177dcd182bSJessica Yu void ftrace_module_enable(struct module *mod)
6718b7ffffbbSSteven Rostedt (Red Hat) {
6719b7ffffbbSSteven Rostedt (Red Hat) 	struct dyn_ftrace *rec;
6720b7ffffbbSSteven Rostedt (Red Hat) 	struct ftrace_page *pg;
6721b7ffffbbSSteven Rostedt (Red Hat) 
6722b7ffffbbSSteven Rostedt (Red Hat) 	mutex_lock(&ftrace_lock);
6723b7ffffbbSSteven Rostedt (Red Hat) 
6724b7ffffbbSSteven Rostedt (Red Hat) 	if (ftrace_disabled)
6725b7ffffbbSSteven Rostedt (Red Hat) 		goto out_unlock;
6726b7ffffbbSSteven Rostedt (Red Hat) 
6727b7ffffbbSSteven Rostedt (Red Hat) 	/*
6728b7ffffbbSSteven Rostedt (Red Hat) 	 * If the tracing is enabled, go ahead and enable the record.
6729b7ffffbbSSteven Rostedt (Red Hat) 	 *
67309efb85c5SHariprasad Kelam 	 * The reason not to enable the record immediately is the
6731b7ffffbbSSteven Rostedt (Red Hat) 	 * inherent check of ftrace_make_nop/ftrace_make_call for
6732b7ffffbbSSteven Rostedt (Red Hat) 	 * correct previous instructions.  Making first the NOP
6733b7ffffbbSSteven Rostedt (Red Hat) 	 * conversion puts the module to the correct state, thus
6734b7ffffbbSSteven Rostedt (Red Hat) 	 * passing the ftrace_make_call check.
6735b7ffffbbSSteven Rostedt (Red Hat) 	 *
6736b7ffffbbSSteven Rostedt (Red Hat) 	 * We also delay this to after the module code already set the
6737b7ffffbbSSteven Rostedt (Red Hat) 	 * text to read-only, as we now need to set it back to read-write
6738b7ffffbbSSteven Rostedt (Red Hat) 	 * so that we can modify the text.
6739b7ffffbbSSteven Rostedt (Red Hat) 	 */
6740b7ffffbbSSteven Rostedt (Red Hat) 	if (ftrace_start_up)
6741b7ffffbbSSteven Rostedt (Red Hat) 		ftrace_arch_code_modify_prepare();
6742b7ffffbbSSteven Rostedt (Red Hat) 
6743b7ffffbbSSteven Rostedt (Red Hat) 	do_for_each_ftrace_rec(pg, rec) {
6744b7ffffbbSSteven Rostedt (Red Hat) 		int cnt;
6745b7ffffbbSSteven Rostedt (Red Hat) 		/*
6746b7ffffbbSSteven Rostedt (Red Hat) 		 * do_for_each_ftrace_rec() is a double loop.
6747b7ffffbbSSteven Rostedt (Red Hat) 		 * module text shares the pg. If a record is
6748b7ffffbbSSteven Rostedt (Red Hat) 		 * not part of this module, then skip this pg,
6749b7ffffbbSSteven Rostedt (Red Hat) 		 * which the "break" will do.
6750b7ffffbbSSteven Rostedt (Red Hat) 		 */
67513e234289SSteven Rostedt (VMware) 		if (!within_module_core(rec->ip, mod) &&
67523e234289SSteven Rostedt (VMware) 		    !within_module_init(rec->ip, mod))
6753b7ffffbbSSteven Rostedt (Red Hat) 			break;
6754b7ffffbbSSteven Rostedt (Red Hat) 
6755b39181f7SSteven Rostedt (Google) 		/* Weak functions should still be ignored */
6756b39181f7SSteven Rostedt (Google) 		if (!test_for_valid_rec(rec)) {
6757b39181f7SSteven Rostedt (Google) 			/* Clear all other flags. Should not be enabled anyway */
6758b39181f7SSteven Rostedt (Google) 			rec->flags = FTRACE_FL_DISABLED;
6759b39181f7SSteven Rostedt (Google) 			continue;
6760b39181f7SSteven Rostedt (Google) 		}
6761b39181f7SSteven Rostedt (Google) 
6762b7ffffbbSSteven Rostedt (Red Hat) 		cnt = 0;
6763b7ffffbbSSteven Rostedt (Red Hat) 
6764b7ffffbbSSteven Rostedt (Red Hat) 		/*
6765b7ffffbbSSteven Rostedt (Red Hat) 		 * When adding a module, we need to check if tracers are
6766b7ffffbbSSteven Rostedt (Red Hat) 		 * currently enabled and if they are, and can trace this record,
6767b7ffffbbSSteven Rostedt (Red Hat) 		 * we need to enable the module functions as well as update the
6768b7ffffbbSSteven Rostedt (Red Hat) 		 * reference counts for those function records.
6769b7ffffbbSSteven Rostedt (Red Hat) 		 */
6770b7ffffbbSSteven Rostedt (Red Hat) 		if (ftrace_start_up)
6771b7ffffbbSSteven Rostedt (Red Hat) 			cnt += referenced_filters(rec);
6772b7ffffbbSSteven Rostedt (Red Hat) 
67738a224ffbSChengming Zhou 		rec->flags &= ~FTRACE_FL_DISABLED;
67748a224ffbSChengming Zhou 		rec->flags += cnt;
6775b7ffffbbSSteven Rostedt (Red Hat) 
6776b7ffffbbSSteven Rostedt (Red Hat) 		if (ftrace_start_up && cnt) {
6777b7ffffbbSSteven Rostedt (Red Hat) 			int failed = __ftrace_replace_code(rec, 1);
6778b7ffffbbSSteven Rostedt (Red Hat) 			if (failed) {
6779b7ffffbbSSteven Rostedt (Red Hat) 				ftrace_bug(failed, rec);
6780b7ffffbbSSteven Rostedt (Red Hat) 				goto out_loop;
6781b7ffffbbSSteven Rostedt (Red Hat) 			}
6782b7ffffbbSSteven Rostedt (Red Hat) 		}
6783b7ffffbbSSteven Rostedt (Red Hat) 
6784b7ffffbbSSteven Rostedt (Red Hat) 	} while_for_each_ftrace_rec();
6785b7ffffbbSSteven Rostedt (Red Hat) 
6786b7ffffbbSSteven Rostedt (Red Hat)  out_loop:
6787b7ffffbbSSteven Rostedt (Red Hat) 	if (ftrace_start_up)
6788b7ffffbbSSteven Rostedt (Red Hat) 		ftrace_arch_code_modify_post_process();
6789b7ffffbbSSteven Rostedt (Red Hat) 
6790b7ffffbbSSteven Rostedt (Red Hat)  out_unlock:
6791b7ffffbbSSteven Rostedt (Red Hat) 	mutex_unlock(&ftrace_lock);
6792d7fbf8dfSSteven Rostedt (VMware) 
6793d7fbf8dfSSteven Rostedt (VMware) 	process_cached_mods(mod->name);
6794b7ffffbbSSteven Rostedt (Red Hat) }
6795b7ffffbbSSteven Rostedt (Red Hat) 
6796a949ae56SSteven Rostedt (Red Hat) void ftrace_module_init(struct module *mod)
679793eb677dSSteven Rostedt {
67982889c658SYuntao Wang 	int ret;
67992889c658SYuntao Wang 
680097e9b4fcSSteven Rostedt (Red Hat) 	if (ftrace_disabled || !mod->num_ftrace_callsites)
6801b6b71f66SAbel Vesa 		return;
6802b6b71f66SAbel Vesa 
68032889c658SYuntao Wang 	ret = ftrace_process_locs(mod, mod->ftrace_callsites,
680497e9b4fcSSteven Rostedt (Red Hat) 				  mod->ftrace_callsites + mod->num_ftrace_callsites);
68052889c658SYuntao Wang 	if (ret)
68062889c658SYuntao Wang 		pr_warn("ftrace: failed to allocate entries for module '%s' functions\n",
68072889c658SYuntao Wang 			mod->name);
680893eb677dSSteven Rostedt }
6809aba4b5c2SSteven Rostedt (VMware) 
6810aba4b5c2SSteven Rostedt (VMware) static void save_ftrace_mod_rec(struct ftrace_mod_map *mod_map,
6811aba4b5c2SSteven Rostedt (VMware) 				struct dyn_ftrace *rec)
6812aba4b5c2SSteven Rostedt (VMware) {
6813aba4b5c2SSteven Rostedt (VMware) 	struct ftrace_mod_func *mod_func;
6814aba4b5c2SSteven Rostedt (VMware) 	unsigned long symsize;
6815aba4b5c2SSteven Rostedt (VMware) 	unsigned long offset;
6816aba4b5c2SSteven Rostedt (VMware) 	char str[KSYM_SYMBOL_LEN];
6817aba4b5c2SSteven Rostedt (VMware) 	char *modname;
6818aba4b5c2SSteven Rostedt (VMware) 	const char *ret;
6819aba4b5c2SSteven Rostedt (VMware) 
6820aba4b5c2SSteven Rostedt (VMware) 	ret = kallsyms_lookup(rec->ip, &symsize, &offset, &modname, str);
6821aba4b5c2SSteven Rostedt (VMware) 	if (!ret)
6822aba4b5c2SSteven Rostedt (VMware) 		return;
6823aba4b5c2SSteven Rostedt (VMware) 
6824aba4b5c2SSteven Rostedt (VMware) 	mod_func = kmalloc(sizeof(*mod_func), GFP_KERNEL);
6825aba4b5c2SSteven Rostedt (VMware) 	if (!mod_func)
6826aba4b5c2SSteven Rostedt (VMware) 		return;
6827aba4b5c2SSteven Rostedt (VMware) 
6828aba4b5c2SSteven Rostedt (VMware) 	mod_func->name = kstrdup(str, GFP_KERNEL);
6829aba4b5c2SSteven Rostedt (VMware) 	if (!mod_func->name) {
6830aba4b5c2SSteven Rostedt (VMware) 		kfree(mod_func);
6831aba4b5c2SSteven Rostedt (VMware) 		return;
6832aba4b5c2SSteven Rostedt (VMware) 	}
6833aba4b5c2SSteven Rostedt (VMware) 
6834aba4b5c2SSteven Rostedt (VMware) 	mod_func->ip = rec->ip - offset;
6835aba4b5c2SSteven Rostedt (VMware) 	mod_func->size = symsize;
6836aba4b5c2SSteven Rostedt (VMware) 
68376171a031SSteven Rostedt (VMware) 	mod_map->num_funcs++;
68386171a031SSteven Rostedt (VMware) 
6839aba4b5c2SSteven Rostedt (VMware) 	list_add_rcu(&mod_func->list, &mod_map->funcs);
6840aba4b5c2SSteven Rostedt (VMware) }
6841aba4b5c2SSteven Rostedt (VMware) 
6842aba4b5c2SSteven Rostedt (VMware) static struct ftrace_mod_map *
6843aba4b5c2SSteven Rostedt (VMware) allocate_ftrace_mod_map(struct module *mod,
6844aba4b5c2SSteven Rostedt (VMware) 			unsigned long start, unsigned long end)
6845aba4b5c2SSteven Rostedt (VMware) {
6846aba4b5c2SSteven Rostedt (VMware) 	struct ftrace_mod_map *mod_map;
6847aba4b5c2SSteven Rostedt (VMware) 
6848aba4b5c2SSteven Rostedt (VMware) 	mod_map = kmalloc(sizeof(*mod_map), GFP_KERNEL);
6849aba4b5c2SSteven Rostedt (VMware) 	if (!mod_map)
6850aba4b5c2SSteven Rostedt (VMware) 		return NULL;
6851aba4b5c2SSteven Rostedt (VMware) 
6852aba4b5c2SSteven Rostedt (VMware) 	mod_map->mod = mod;
6853aba4b5c2SSteven Rostedt (VMware) 	mod_map->start_addr = start;
6854aba4b5c2SSteven Rostedt (VMware) 	mod_map->end_addr = end;
68556171a031SSteven Rostedt (VMware) 	mod_map->num_funcs = 0;
6856aba4b5c2SSteven Rostedt (VMware) 
6857aba4b5c2SSteven Rostedt (VMware) 	INIT_LIST_HEAD_RCU(&mod_map->funcs);
6858aba4b5c2SSteven Rostedt (VMware) 
6859aba4b5c2SSteven Rostedt (VMware) 	list_add_rcu(&mod_map->list, &ftrace_mod_maps);
6860aba4b5c2SSteven Rostedt (VMware) 
6861aba4b5c2SSteven Rostedt (VMware) 	return mod_map;
6862aba4b5c2SSteven Rostedt (VMware) }
6863aba4b5c2SSteven Rostedt (VMware) 
6864aba4b5c2SSteven Rostedt (VMware) static const char *
6865aba4b5c2SSteven Rostedt (VMware) ftrace_func_address_lookup(struct ftrace_mod_map *mod_map,
6866aba4b5c2SSteven Rostedt (VMware) 			   unsigned long addr, unsigned long *size,
6867aba4b5c2SSteven Rostedt (VMware) 			   unsigned long *off, char *sym)
6868aba4b5c2SSteven Rostedt (VMware) {
6869aba4b5c2SSteven Rostedt (VMware) 	struct ftrace_mod_func *found_func =  NULL;
6870aba4b5c2SSteven Rostedt (VMware) 	struct ftrace_mod_func *mod_func;
6871aba4b5c2SSteven Rostedt (VMware) 
6872aba4b5c2SSteven Rostedt (VMware) 	list_for_each_entry_rcu(mod_func, &mod_map->funcs, list) {
6873aba4b5c2SSteven Rostedt (VMware) 		if (addr >= mod_func->ip &&
6874aba4b5c2SSteven Rostedt (VMware) 		    addr < mod_func->ip + mod_func->size) {
6875aba4b5c2SSteven Rostedt (VMware) 			found_func = mod_func;
6876aba4b5c2SSteven Rostedt (VMware) 			break;
6877aba4b5c2SSteven Rostedt (VMware) 		}
6878aba4b5c2SSteven Rostedt (VMware) 	}
6879aba4b5c2SSteven Rostedt (VMware) 
6880aba4b5c2SSteven Rostedt (VMware) 	if (found_func) {
6881aba4b5c2SSteven Rostedt (VMware) 		if (size)
6882aba4b5c2SSteven Rostedt (VMware) 			*size = found_func->size;
6883aba4b5c2SSteven Rostedt (VMware) 		if (off)
6884aba4b5c2SSteven Rostedt (VMware) 			*off = addr - found_func->ip;
6885aba4b5c2SSteven Rostedt (VMware) 		if (sym)
6886aba4b5c2SSteven Rostedt (VMware) 			strlcpy(sym, found_func->name, KSYM_NAME_LEN);
6887aba4b5c2SSteven Rostedt (VMware) 
6888aba4b5c2SSteven Rostedt (VMware) 		return found_func->name;
6889aba4b5c2SSteven Rostedt (VMware) 	}
6890aba4b5c2SSteven Rostedt (VMware) 
6891aba4b5c2SSteven Rostedt (VMware) 	return NULL;
6892aba4b5c2SSteven Rostedt (VMware) }
6893aba4b5c2SSteven Rostedt (VMware) 
6894aba4b5c2SSteven Rostedt (VMware) const char *
6895aba4b5c2SSteven Rostedt (VMware) ftrace_mod_address_lookup(unsigned long addr, unsigned long *size,
6896aba4b5c2SSteven Rostedt (VMware) 		   unsigned long *off, char **modname, char *sym)
6897aba4b5c2SSteven Rostedt (VMware) {
6898aba4b5c2SSteven Rostedt (VMware) 	struct ftrace_mod_map *mod_map;
6899aba4b5c2SSteven Rostedt (VMware) 	const char *ret = NULL;
6900aba4b5c2SSteven Rostedt (VMware) 
690174401729SPaul E. McKenney 	/* mod_map is freed via call_rcu() */
6902aba4b5c2SSteven Rostedt (VMware) 	preempt_disable();
6903aba4b5c2SSteven Rostedt (VMware) 	list_for_each_entry_rcu(mod_map, &ftrace_mod_maps, list) {
6904aba4b5c2SSteven Rostedt (VMware) 		ret = ftrace_func_address_lookup(mod_map, addr, size, off, sym);
6905aba4b5c2SSteven Rostedt (VMware) 		if (ret) {
6906aba4b5c2SSteven Rostedt (VMware) 			if (modname)
6907aba4b5c2SSteven Rostedt (VMware) 				*modname = mod_map->mod->name;
6908aba4b5c2SSteven Rostedt (VMware) 			break;
6909aba4b5c2SSteven Rostedt (VMware) 		}
6910aba4b5c2SSteven Rostedt (VMware) 	}
6911aba4b5c2SSteven Rostedt (VMware) 	preempt_enable();
6912aba4b5c2SSteven Rostedt (VMware) 
6913aba4b5c2SSteven Rostedt (VMware) 	return ret;
6914aba4b5c2SSteven Rostedt (VMware) }
6915aba4b5c2SSteven Rostedt (VMware) 
69166171a031SSteven Rostedt (VMware) int ftrace_mod_get_kallsym(unsigned int symnum, unsigned long *value,
69176171a031SSteven Rostedt (VMware) 			   char *type, char *name,
69186171a031SSteven Rostedt (VMware) 			   char *module_name, int *exported)
69196171a031SSteven Rostedt (VMware) {
69206171a031SSteven Rostedt (VMware) 	struct ftrace_mod_map *mod_map;
69216171a031SSteven Rostedt (VMware) 	struct ftrace_mod_func *mod_func;
6922fc0ea795SAdrian Hunter 	int ret;
69236171a031SSteven Rostedt (VMware) 
69246171a031SSteven Rostedt (VMware) 	preempt_disable();
69256171a031SSteven Rostedt (VMware) 	list_for_each_entry_rcu(mod_map, &ftrace_mod_maps, list) {
69266171a031SSteven Rostedt (VMware) 
69276171a031SSteven Rostedt (VMware) 		if (symnum >= mod_map->num_funcs) {
69286171a031SSteven Rostedt (VMware) 			symnum -= mod_map->num_funcs;
69296171a031SSteven Rostedt (VMware) 			continue;
69306171a031SSteven Rostedt (VMware) 		}
69316171a031SSteven Rostedt (VMware) 
69326171a031SSteven Rostedt (VMware) 		list_for_each_entry_rcu(mod_func, &mod_map->funcs, list) {
69336171a031SSteven Rostedt (VMware) 			if (symnum > 1) {
69346171a031SSteven Rostedt (VMware) 				symnum--;
69356171a031SSteven Rostedt (VMware) 				continue;
69366171a031SSteven Rostedt (VMware) 			}
69376171a031SSteven Rostedt (VMware) 
69386171a031SSteven Rostedt (VMware) 			*value = mod_func->ip;
69396171a031SSteven Rostedt (VMware) 			*type = 'T';
69406171a031SSteven Rostedt (VMware) 			strlcpy(name, mod_func->name, KSYM_NAME_LEN);
69416171a031SSteven Rostedt (VMware) 			strlcpy(module_name, mod_map->mod->name, MODULE_NAME_LEN);
69426171a031SSteven Rostedt (VMware) 			*exported = 1;
69436171a031SSteven Rostedt (VMware) 			preempt_enable();
69446171a031SSteven Rostedt (VMware) 			return 0;
69456171a031SSteven Rostedt (VMware) 		}
69466171a031SSteven Rostedt (VMware) 		WARN_ON(1);
69476171a031SSteven Rostedt (VMware) 		break;
69486171a031SSteven Rostedt (VMware) 	}
6949fc0ea795SAdrian Hunter 	ret = ftrace_get_trampoline_kallsym(symnum, value, type, name,
6950fc0ea795SAdrian Hunter 					    module_name, exported);
69516171a031SSteven Rostedt (VMware) 	preempt_enable();
6952fc0ea795SAdrian Hunter 	return ret;
69536171a031SSteven Rostedt (VMware) }
69546171a031SSteven Rostedt (VMware) 
6955aba4b5c2SSteven Rostedt (VMware) #else
6956aba4b5c2SSteven Rostedt (VMware) static void save_ftrace_mod_rec(struct ftrace_mod_map *mod_map,
6957aba4b5c2SSteven Rostedt (VMware) 				struct dyn_ftrace *rec) { }
6958aba4b5c2SSteven Rostedt (VMware) static inline struct ftrace_mod_map *
6959aba4b5c2SSteven Rostedt (VMware) allocate_ftrace_mod_map(struct module *mod,
6960aba4b5c2SSteven Rostedt (VMware) 			unsigned long start, unsigned long end)
6961aba4b5c2SSteven Rostedt (VMware) {
6962aba4b5c2SSteven Rostedt (VMware) 	return NULL;
6963aba4b5c2SSteven Rostedt (VMware) }
6964fc0ea795SAdrian Hunter int ftrace_mod_get_kallsym(unsigned int symnum, unsigned long *value,
6965fc0ea795SAdrian Hunter 			   char *type, char *name, char *module_name,
6966fc0ea795SAdrian Hunter 			   int *exported)
6967fc0ea795SAdrian Hunter {
6968fc0ea795SAdrian Hunter 	int ret;
6969fc0ea795SAdrian Hunter 
6970fc0ea795SAdrian Hunter 	preempt_disable();
6971fc0ea795SAdrian Hunter 	ret = ftrace_get_trampoline_kallsym(symnum, value, type, name,
6972fc0ea795SAdrian Hunter 					    module_name, exported);
6973fc0ea795SAdrian Hunter 	preempt_enable();
6974fc0ea795SAdrian Hunter 	return ret;
6975fc0ea795SAdrian Hunter }
697693eb677dSSteven Rostedt #endif /* CONFIG_MODULES */
697793eb677dSSteven Rostedt 
69788715b108SJoel Fernandes struct ftrace_init_func {
69798715b108SJoel Fernandes 	struct list_head list;
69808715b108SJoel Fernandes 	unsigned long ip;
69818715b108SJoel Fernandes };
69828715b108SJoel Fernandes 
69838715b108SJoel Fernandes /* Clear any init ips from hashes */
69848715b108SJoel Fernandes static void
69858715b108SJoel Fernandes clear_func_from_hash(struct ftrace_init_func *func, struct ftrace_hash *hash)
698642c269c8SSteven Rostedt (VMware) {
69878715b108SJoel Fernandes 	struct ftrace_func_entry *entry;
69888715b108SJoel Fernandes 
698908468754SChangbin Du 	entry = ftrace_lookup_ip(hash, func->ip);
69908715b108SJoel Fernandes 	/*
69918715b108SJoel Fernandes 	 * Do not allow this rec to match again.
69928715b108SJoel Fernandes 	 * Yeah, it may waste some memory, but will be removed
69938715b108SJoel Fernandes 	 * if/when the hash is modified again.
69948715b108SJoel Fernandes 	 */
69958715b108SJoel Fernandes 	if (entry)
69968715b108SJoel Fernandes 		entry->ip = 0;
69978715b108SJoel Fernandes }
69988715b108SJoel Fernandes 
69998715b108SJoel Fernandes static void
70008715b108SJoel Fernandes clear_func_from_hashes(struct ftrace_init_func *func)
70018715b108SJoel Fernandes {
70028715b108SJoel Fernandes 	struct trace_array *tr;
70038715b108SJoel Fernandes 
70048715b108SJoel Fernandes 	mutex_lock(&trace_types_lock);
70058715b108SJoel Fernandes 	list_for_each_entry(tr, &ftrace_trace_arrays, list) {
70068715b108SJoel Fernandes 		if (!tr->ops || !tr->ops->func_hash)
70078715b108SJoel Fernandes 			continue;
70088715b108SJoel Fernandes 		mutex_lock(&tr->ops->func_hash->regex_lock);
70098715b108SJoel Fernandes 		clear_func_from_hash(func, tr->ops->func_hash->filter_hash);
70108715b108SJoel Fernandes 		clear_func_from_hash(func, tr->ops->func_hash->notrace_hash);
70118715b108SJoel Fernandes 		mutex_unlock(&tr->ops->func_hash->regex_lock);
70128715b108SJoel Fernandes 	}
70138715b108SJoel Fernandes 	mutex_unlock(&trace_types_lock);
70148715b108SJoel Fernandes }
70158715b108SJoel Fernandes 
70168715b108SJoel Fernandes static void add_to_clear_hash_list(struct list_head *clear_list,
70178715b108SJoel Fernandes 				   struct dyn_ftrace *rec)
70188715b108SJoel Fernandes {
70198715b108SJoel Fernandes 	struct ftrace_init_func *func;
70208715b108SJoel Fernandes 
70218715b108SJoel Fernandes 	func = kmalloc(sizeof(*func), GFP_KERNEL);
70228715b108SJoel Fernandes 	if (!func) {
702324589e3aSSteven Rostedt (VMware) 		MEM_FAIL(1, "alloc failure, ftrace filter could be stale\n");
70248715b108SJoel Fernandes 		return;
70258715b108SJoel Fernandes 	}
70268715b108SJoel Fernandes 
70278715b108SJoel Fernandes 	func->ip = rec->ip;
70288715b108SJoel Fernandes 	list_add(&func->list, clear_list);
70298715b108SJoel Fernandes }
70308715b108SJoel Fernandes 
7031aba4b5c2SSteven Rostedt (VMware) void ftrace_free_mem(struct module *mod, void *start_ptr, void *end_ptr)
703242c269c8SSteven Rostedt (VMware) {
70336cafbe15SSteven Rostedt (VMware) 	unsigned long start = (unsigned long)(start_ptr);
70346cafbe15SSteven Rostedt (VMware) 	unsigned long end = (unsigned long)(end_ptr);
703542c269c8SSteven Rostedt (VMware) 	struct ftrace_page **last_pg = &ftrace_pages_start;
703642c269c8SSteven Rostedt (VMware) 	struct ftrace_page *pg;
703742c269c8SSteven Rostedt (VMware) 	struct dyn_ftrace *rec;
703842c269c8SSteven Rostedt (VMware) 	struct dyn_ftrace key;
7039aba4b5c2SSteven Rostedt (VMware) 	struct ftrace_mod_map *mod_map = NULL;
70408715b108SJoel Fernandes 	struct ftrace_init_func *func, *func_next;
70418715b108SJoel Fernandes 	struct list_head clear_hash;
704242c269c8SSteven Rostedt (VMware) 
70438715b108SJoel Fernandes 	INIT_LIST_HEAD(&clear_hash);
70448715b108SJoel Fernandes 
704542c269c8SSteven Rostedt (VMware) 	key.ip = start;
704642c269c8SSteven Rostedt (VMware) 	key.flags = end;	/* overload flags, as it is unsigned long */
704742c269c8SSteven Rostedt (VMware) 
704842c269c8SSteven Rostedt (VMware) 	mutex_lock(&ftrace_lock);
704942c269c8SSteven Rostedt (VMware) 
7050aba4b5c2SSteven Rostedt (VMware) 	/*
7051aba4b5c2SSteven Rostedt (VMware) 	 * If we are freeing module init memory, then check if
7052aba4b5c2SSteven Rostedt (VMware) 	 * any tracer is active. If so, we need to save a mapping of
7053aba4b5c2SSteven Rostedt (VMware) 	 * the module functions being freed with the address.
7054aba4b5c2SSteven Rostedt (VMware) 	 */
7055aba4b5c2SSteven Rostedt (VMware) 	if (mod && ftrace_ops_list != &ftrace_list_end)
7056aba4b5c2SSteven Rostedt (VMware) 		mod_map = allocate_ftrace_mod_map(mod, start, end);
7057aba4b5c2SSteven Rostedt (VMware) 
705842c269c8SSteven Rostedt (VMware) 	for (pg = ftrace_pages_start; pg; last_pg = &pg->next, pg = *last_pg) {
705942c269c8SSteven Rostedt (VMware) 		if (end < pg->records[0].ip ||
706042c269c8SSteven Rostedt (VMware) 		    start >= (pg->records[pg->index - 1].ip + MCOUNT_INSN_SIZE))
706142c269c8SSteven Rostedt (VMware) 			continue;
706242c269c8SSteven Rostedt (VMware)  again:
706342c269c8SSteven Rostedt (VMware) 		rec = bsearch(&key, pg->records, pg->index,
706442c269c8SSteven Rostedt (VMware) 			      sizeof(struct dyn_ftrace),
706542c269c8SSteven Rostedt (VMware) 			      ftrace_cmp_recs);
706642c269c8SSteven Rostedt (VMware) 		if (!rec)
706742c269c8SSteven Rostedt (VMware) 			continue;
7068aba4b5c2SSteven Rostedt (VMware) 
70698715b108SJoel Fernandes 		/* rec will be cleared from hashes after ftrace_lock unlock */
70708715b108SJoel Fernandes 		add_to_clear_hash_list(&clear_hash, rec);
70718715b108SJoel Fernandes 
7072aba4b5c2SSteven Rostedt (VMware) 		if (mod_map)
7073aba4b5c2SSteven Rostedt (VMware) 			save_ftrace_mod_rec(mod_map, rec);
7074aba4b5c2SSteven Rostedt (VMware) 
707542c269c8SSteven Rostedt (VMware) 		pg->index--;
70764ec78467SSteven Rostedt (VMware) 		ftrace_update_tot_cnt--;
707742c269c8SSteven Rostedt (VMware) 		if (!pg->index) {
707842c269c8SSteven Rostedt (VMware) 			*last_pg = pg->next;
7079db42523bSLinus Torvalds 			if (pg->records) {
7080db42523bSLinus Torvalds 				free_pages((unsigned long)pg->records, pg->order);
7081db42523bSLinus Torvalds 				ftrace_number_of_pages -= 1 << pg->order;
7082db42523bSLinus Torvalds 			}
7083da537f0aSSteven Rostedt (VMware) 			ftrace_number_of_groups--;
708442c269c8SSteven Rostedt (VMware) 			kfree(pg);
708542c269c8SSteven Rostedt (VMware) 			pg = container_of(last_pg, struct ftrace_page, next);
708642c269c8SSteven Rostedt (VMware) 			if (!(*last_pg))
708742c269c8SSteven Rostedt (VMware) 				ftrace_pages = pg;
708842c269c8SSteven Rostedt (VMware) 			continue;
708942c269c8SSteven Rostedt (VMware) 		}
709042c269c8SSteven Rostedt (VMware) 		memmove(rec, rec + 1,
709142c269c8SSteven Rostedt (VMware) 			(pg->index - (rec - pg->records)) * sizeof(*rec));
709242c269c8SSteven Rostedt (VMware) 		/* More than one function may be in this block */
709342c269c8SSteven Rostedt (VMware) 		goto again;
709442c269c8SSteven Rostedt (VMware) 	}
709542c269c8SSteven Rostedt (VMware) 	mutex_unlock(&ftrace_lock);
70968715b108SJoel Fernandes 
70978715b108SJoel Fernandes 	list_for_each_entry_safe(func, func_next, &clear_hash, list) {
70988715b108SJoel Fernandes 		clear_func_from_hashes(func);
70998715b108SJoel Fernandes 		kfree(func);
71008715b108SJoel Fernandes 	}
710142c269c8SSteven Rostedt (VMware) }
710242c269c8SSteven Rostedt (VMware) 
71036cafbe15SSteven Rostedt (VMware) void __init ftrace_free_init_mem(void)
71046cafbe15SSteven Rostedt (VMware) {
71056cafbe15SSteven Rostedt (VMware) 	void *start = (void *)(&__init_begin);
71066cafbe15SSteven Rostedt (VMware) 	void *end = (void *)(&__init_end);
71076cafbe15SSteven Rostedt (VMware) 
7108380af29bSSteven Rostedt (Google) 	ftrace_boot_snapshot();
7109380af29bSSteven Rostedt (Google) 
7110aba4b5c2SSteven Rostedt (VMware) 	ftrace_free_mem(NULL, start, end);
711193eb677dSSteven Rostedt }
711293eb677dSSteven Rostedt 
71136644c654SWeizhao Ouyang int __init __weak ftrace_dyn_arch_init(void)
71146644c654SWeizhao Ouyang {
71156644c654SWeizhao Ouyang 	return 0;
71166644c654SWeizhao Ouyang }
71176644c654SWeizhao Ouyang 
711868bf21aaSSteven Rostedt void __init ftrace_init(void)
711968bf21aaSSteven Rostedt {
71201dc43cf0SJiri Slaby 	extern unsigned long __start_mcount_loc[];
71211dc43cf0SJiri Slaby 	extern unsigned long __stop_mcount_loc[];
71223a36cb11SJiri Slaby 	unsigned long count, flags;
712368bf21aaSSteven Rostedt 	int ret;
712468bf21aaSSteven Rostedt 
712568bf21aaSSteven Rostedt 	local_irq_save(flags);
71263a36cb11SJiri Slaby 	ret = ftrace_dyn_arch_init();
712768bf21aaSSteven Rostedt 	local_irq_restore(flags);
7128af64a7cbSJiri Slaby 	if (ret)
712968bf21aaSSteven Rostedt 		goto failed;
713068bf21aaSSteven Rostedt 
713168bf21aaSSteven Rostedt 	count = __stop_mcount_loc - __start_mcount_loc;
7132c867ccd8SJiri Slaby 	if (!count) {
7133c867ccd8SJiri Slaby 		pr_info("ftrace: No functions to be traced?\n");
713468bf21aaSSteven Rostedt 		goto failed;
7135c867ccd8SJiri Slaby 	}
7136c867ccd8SJiri Slaby 
7137c867ccd8SJiri Slaby 	pr_info("ftrace: allocating %ld entries in %ld pages\n",
713808948caeSWang Wensheng 		count, DIV_ROUND_UP(count, ENTRIES_PER_PAGE));
713968bf21aaSSteven Rostedt 
71405cb084bbSJiri Olsa 	ret = ftrace_process_locs(NULL,
714131e88909SSteven Rostedt 				  __start_mcount_loc,
714268bf21aaSSteven Rostedt 				  __stop_mcount_loc);
71432889c658SYuntao Wang 	if (ret) {
71442889c658SYuntao Wang 		pr_warn("ftrace: failed to allocate entries for functions\n");
71452889c658SYuntao Wang 		goto failed;
71462889c658SYuntao Wang 	}
714768bf21aaSSteven Rostedt 
7148da537f0aSSteven Rostedt (VMware) 	pr_info("ftrace: allocated %ld pages with %ld groups\n",
7149da537f0aSSteven Rostedt (VMware) 		ftrace_number_of_pages, ftrace_number_of_groups);
7150da537f0aSSteven Rostedt (VMware) 
71512889c658SYuntao Wang 	last_ftrace_enabled = ftrace_enabled = 1;
71522889c658SYuntao Wang 
71532af15d6aSSteven Rostedt 	set_ftrace_early_filters();
71542af15d6aSSteven Rostedt 
715568bf21aaSSteven Rostedt 	return;
715668bf21aaSSteven Rostedt  failed:
715768bf21aaSSteven Rostedt 	ftrace_disabled = 1;
715868bf21aaSSteven Rostedt }
715968bf21aaSSteven Rostedt 
7160f3bea491SSteven Rostedt (Red Hat) /* Do nothing if arch does not support this */
7161f3bea491SSteven Rostedt (Red Hat) void __weak arch_ftrace_update_trampoline(struct ftrace_ops *ops)
7162f3bea491SSteven Rostedt (Red Hat) {
7163f3bea491SSteven Rostedt (Red Hat) }
7164f3bea491SSteven Rostedt (Red Hat) 
7165f3bea491SSteven Rostedt (Red Hat) static void ftrace_update_trampoline(struct ftrace_ops *ops)
7166f3bea491SSteven Rostedt (Red Hat) {
7167fc0ea795SAdrian Hunter 	unsigned long trampoline = ops->trampoline;
7168fc0ea795SAdrian Hunter 
7169f3bea491SSteven Rostedt (Red Hat) 	arch_ftrace_update_trampoline(ops);
7170fc0ea795SAdrian Hunter 	if (ops->trampoline && ops->trampoline != trampoline &&
7171dd9ddf46SAdrian Hunter 	    (ops->flags & FTRACE_OPS_FL_ALLOC_TRAMP)) {
7172dd9ddf46SAdrian Hunter 		/* Add to kallsyms before the perf events */
7173fc0ea795SAdrian Hunter 		ftrace_add_trampoline_to_kallsyms(ops);
7174dd9ddf46SAdrian Hunter 		perf_event_ksymbol(PERF_RECORD_KSYMBOL_TYPE_OOL,
7175dd9ddf46SAdrian Hunter 				   ops->trampoline, ops->trampoline_size, false,
7176dd9ddf46SAdrian Hunter 				   FTRACE_TRAMPOLINE_SYM);
7177548e1f6cSAdrian Hunter 		/*
7178548e1f6cSAdrian Hunter 		 * Record the perf text poke event after the ksymbol register
7179548e1f6cSAdrian Hunter 		 * event.
7180548e1f6cSAdrian Hunter 		 */
7181548e1f6cSAdrian Hunter 		perf_event_text_poke((void *)ops->trampoline, NULL, 0,
7182548e1f6cSAdrian Hunter 				     (void *)ops->trampoline,
7183548e1f6cSAdrian Hunter 				     ops->trampoline_size);
7184dd9ddf46SAdrian Hunter 	}
7185f3bea491SSteven Rostedt (Red Hat) }
7186f3bea491SSteven Rostedt (Red Hat) 
718704ec7bb6SSteven Rostedt (VMware) void ftrace_init_trace_array(struct trace_array *tr)
718804ec7bb6SSteven Rostedt (VMware) {
718904ec7bb6SSteven Rostedt (VMware) 	INIT_LIST_HEAD(&tr->func_probes);
7190673feb9dSSteven Rostedt (VMware) 	INIT_LIST_HEAD(&tr->mod_trace);
7191673feb9dSSteven Rostedt (VMware) 	INIT_LIST_HEAD(&tr->mod_notrace);
719204ec7bb6SSteven Rostedt (VMware) }
71933d083395SSteven Rostedt #else
71940b6e4d56SFrederic Weisbecker 
71953306fc4aSSteven Rostedt (VMware) struct ftrace_ops global_ops = {
7196bd69c30bSSteven Rostedt 	.func			= ftrace_stub,
7197a25d036dSSteven Rostedt (VMware) 	.flags			= FTRACE_OPS_FL_INITIALIZED |
7198e3eea140SSteven Rostedt (Red Hat) 				  FTRACE_OPS_FL_PID,
7199bd69c30bSSteven Rostedt };
7200bd69c30bSSteven Rostedt 
72010b6e4d56SFrederic Weisbecker static int __init ftrace_nodyn_init(void)
72020b6e4d56SFrederic Weisbecker {
72030b6e4d56SFrederic Weisbecker 	ftrace_enabled = 1;
72040b6e4d56SFrederic Weisbecker 	return 0;
72050b6e4d56SFrederic Weisbecker }
72066f415672SSteven Rostedt core_initcall(ftrace_nodyn_init);
72070b6e4d56SFrederic Weisbecker 
72088434dc93SSteven Rostedt (Red Hat) static inline int ftrace_init_dyn_tracefs(struct dentry *d_tracer) { return 0; }
7209e1effa01SSteven Rostedt (Red Hat) static inline void ftrace_startup_all(int command) { }
72108a56d776SSteven Rostedt (Red Hat) 
7211f3bea491SSteven Rostedt (Red Hat) static void ftrace_update_trampoline(struct ftrace_ops *ops)
7212f3bea491SSteven Rostedt (Red Hat) {
7213f3bea491SSteven Rostedt (Red Hat) }
7214f3bea491SSteven Rostedt (Red Hat) 
72153d083395SSteven Rostedt #endif /* CONFIG_DYNAMIC_FTRACE */
72163d083395SSteven Rostedt 
72174104d326SSteven Rostedt (Red Hat) __init void ftrace_init_global_array_ops(struct trace_array *tr)
72184104d326SSteven Rostedt (Red Hat) {
72194104d326SSteven Rostedt (Red Hat) 	tr->ops = &global_ops;
72204104d326SSteven Rostedt (Red Hat) 	tr->ops->private = tr;
722104ec7bb6SSteven Rostedt (VMware) 	ftrace_init_trace_array(tr);
72224104d326SSteven Rostedt (Red Hat) }
72234104d326SSteven Rostedt (Red Hat) 
72244104d326SSteven Rostedt (Red Hat) void ftrace_init_array_ops(struct trace_array *tr, ftrace_func_t func)
72254104d326SSteven Rostedt (Red Hat) {
72264104d326SSteven Rostedt (Red Hat) 	/* If we filter on pids, update to use the pid function */
72274104d326SSteven Rostedt (Red Hat) 	if (tr->flags & TRACE_ARRAY_FL_GLOBAL) {
72284104d326SSteven Rostedt (Red Hat) 		if (WARN_ON(tr->ops->func != ftrace_stub))
72294104d326SSteven Rostedt (Red Hat) 			printk("ftrace ops had %pS for function\n",
72304104d326SSteven Rostedt (Red Hat) 			       tr->ops->func);
72314104d326SSteven Rostedt (Red Hat) 	}
72324104d326SSteven Rostedt (Red Hat) 	tr->ops->func = func;
72334104d326SSteven Rostedt (Red Hat) 	tr->ops->private = tr;
72344104d326SSteven Rostedt (Red Hat) }
72354104d326SSteven Rostedt (Red Hat) 
72364104d326SSteven Rostedt (Red Hat) void ftrace_reset_array_ops(struct trace_array *tr)
72374104d326SSteven Rostedt (Red Hat) {
72384104d326SSteven Rostedt (Red Hat) 	tr->ops->func = ftrace_stub;
72394104d326SSteven Rostedt (Red Hat) }
72404104d326SSteven Rostedt (Red Hat) 
7241fabe38abSMasami Hiramatsu static nokprobe_inline void
72422f5f6ad9SSteven Rostedt __ftrace_ops_list_func(unsigned long ip, unsigned long parent_ip,
7243d19ad077SSteven Rostedt (VMware) 		       struct ftrace_ops *ignored, struct ftrace_regs *fregs)
7244b848914cSSteven Rostedt {
7245d19ad077SSteven Rostedt (VMware) 	struct pt_regs *regs = ftrace_get_regs(fregs);
7246cdbe61bfSSteven Rostedt 	struct ftrace_ops *op;
7247edc15cafSSteven Rostedt 	int bit;
7248b848914cSSteven Rostedt 
7249ce5e4803S王贇 	/*
7250ce5e4803S王贇 	 * The ftrace_test_and_set_recursion() will disable preemption,
7251ce5e4803S王贇 	 * which is required since some of the ops may be dynamically
7252ce5e4803S王贇 	 * allocated, they must be freed after a synchronize_rcu().
7253ce5e4803S王贇 	 */
7254ed65df63SSteven Rostedt (VMware) 	bit = trace_test_and_set_recursion(ip, parent_ip, TRACE_LIST_START);
7255edc15cafSSteven Rostedt 	if (bit < 0)
7256b1cff0adSSteven Rostedt 		return;
7257b1cff0adSSteven Rostedt 
72580a016409SSteven Rostedt 	do_for_each_ftrace_op(op, ftrace_ops_list) {
72592fa717a0SSteven Rostedt (VMware) 		/* Stub functions don't need to be called nor tested */
72602fa717a0SSteven Rostedt (VMware) 		if (op->flags & FTRACE_OPS_FL_STUB)
72612fa717a0SSteven Rostedt (VMware) 			continue;
7262ba27f2bcSSteven Rostedt (Red Hat) 		/*
7263ba27f2bcSSteven Rostedt (Red Hat) 		 * Check the following for each ops before calling their func:
7264ba27f2bcSSteven Rostedt (Red Hat) 		 *  if RCU flag is set, then rcu_is_watching() must be true
7265ba27f2bcSSteven Rostedt (Red Hat) 		 *  Otherwise test if the ip matches the ops filter
7266ba27f2bcSSteven Rostedt (Red Hat) 		 *
7267ba27f2bcSSteven Rostedt (Red Hat) 		 * If any of the above fails then the op->func() is not executed.
7268ba27f2bcSSteven Rostedt (Red Hat) 		 */
7269ba27f2bcSSteven Rostedt (Red Hat) 		if ((!(op->flags & FTRACE_OPS_FL_RCU) || rcu_is_watching()) &&
7270ba27f2bcSSteven Rostedt (Red Hat) 		    ftrace_ops_test(op, ip, regs)) {
72711d48d596SSteven Rostedt (Red Hat) 			if (FTRACE_WARN_ON(!op->func)) {
72721d48d596SSteven Rostedt (Red Hat) 				pr_warn("op=%p %pS\n", op, op);
72734104d326SSteven Rostedt (Red Hat) 				goto out;
72744104d326SSteven Rostedt (Red Hat) 			}
7275d19ad077SSteven Rostedt (VMware) 			op->func(ip, parent_ip, op, fregs);
72764104d326SSteven Rostedt (Red Hat) 		}
72770a016409SSteven Rostedt 	} while_for_each_ftrace_op(op);
72784104d326SSteven Rostedt (Red Hat) out:
7279edc15cafSSteven Rostedt 	trace_clear_recursion(bit);
7280b848914cSSteven Rostedt }
7281b848914cSSteven Rostedt 
72822f5f6ad9SSteven Rostedt /*
72832f5f6ad9SSteven Rostedt  * Some archs only support passing ip and parent_ip. Even though
72842f5f6ad9SSteven Rostedt  * the list function ignores the op parameter, we do not want any
72852f5f6ad9SSteven Rostedt  * C side effects, where a function is called without the caller
72862f5f6ad9SSteven Rostedt  * sending a third parameter.
7287a1e2e31dSSteven Rostedt  * Archs are to support both the regs and ftrace_ops at the same time.
7288a1e2e31dSSteven Rostedt  * If they support ftrace_ops, it is assumed they support regs.
7289a1e2e31dSSteven Rostedt  * If call backs want to use regs, they must either check for regs
729006aeaaeaSMasami Hiramatsu  * being NULL, or CONFIG_DYNAMIC_FTRACE_WITH_REGS.
729106aeaaeaSMasami Hiramatsu  * Note, CONFIG_DYNAMIC_FTRACE_WITH_REGS expects a full regs to be saved.
7292a1e2e31dSSteven Rostedt  * An architecture can pass partial regs with ftrace_ops and still
7293b8ec330aSLi Bin  * set the ARCH_SUPPORTS_FTRACE_OPS.
729434cdd18bSSteven Rostedt (VMware)  *
729534cdd18bSSteven Rostedt (VMware)  * In vmlinux.lds.h, ftrace_ops_list_func() is defined to be
729634cdd18bSSteven Rostedt (VMware)  * arch_ftrace_ops_list_func.
72972f5f6ad9SSteven Rostedt  */
72982f5f6ad9SSteven Rostedt #if ARCH_SUPPORTS_FTRACE_OPS
729934cdd18bSSteven Rostedt (VMware) void arch_ftrace_ops_list_func(unsigned long ip, unsigned long parent_ip,
7300d19ad077SSteven Rostedt (VMware) 			       struct ftrace_ops *op, struct ftrace_regs *fregs)
73012f5f6ad9SSteven Rostedt {
7302d19ad077SSteven Rostedt (VMware) 	__ftrace_ops_list_func(ip, parent_ip, NULL, fregs);
73032f5f6ad9SSteven Rostedt }
73042f5f6ad9SSteven Rostedt #else
730534cdd18bSSteven Rostedt (VMware) void arch_ftrace_ops_list_func(unsigned long ip, unsigned long parent_ip)
73062f5f6ad9SSteven Rostedt {
7307a1e2e31dSSteven Rostedt 	__ftrace_ops_list_func(ip, parent_ip, NULL, NULL);
73082f5f6ad9SSteven Rostedt }
73092f5f6ad9SSteven Rostedt #endif
731034cdd18bSSteven Rostedt (VMware) NOKPROBE_SYMBOL(arch_ftrace_ops_list_func);
73112f5f6ad9SSteven Rostedt 
7312f1ff6348SSteven Rostedt (Red Hat) /*
7313f1ff6348SSteven Rostedt (Red Hat)  * If there's only one function registered but it does not support
731478a01febSZheng Yejian  * recursion, needs RCU protection, then this function will be called
731578a01febSZheng Yejian  * by the mcount trampoline.
7316f1ff6348SSteven Rostedt (Red Hat)  */
7317c68c0fa2SSteven Rostedt (Red Hat) static void ftrace_ops_assist_func(unsigned long ip, unsigned long parent_ip,
7318d19ad077SSteven Rostedt (VMware) 				   struct ftrace_ops *op, struct ftrace_regs *fregs)
7319f1ff6348SSteven Rostedt (Red Hat) {
7320f1ff6348SSteven Rostedt (Red Hat) 	int bit;
7321f1ff6348SSteven Rostedt (Red Hat) 
7322ed65df63SSteven Rostedt (VMware) 	bit = trace_test_and_set_recursion(ip, parent_ip, TRACE_LIST_START);
7323f1ff6348SSteven Rostedt (Red Hat) 	if (bit < 0)
7324f1ff6348SSteven Rostedt (Red Hat) 		return;
7325f1ff6348SSteven Rostedt (Red Hat) 
7326b40341faSSteven Rostedt (VMware) 	if (!(op->flags & FTRACE_OPS_FL_RCU) || rcu_is_watching())
7327d19ad077SSteven Rostedt (VMware) 		op->func(ip, parent_ip, op, fregs);
7328c68c0fa2SSteven Rostedt (Red Hat) 
7329f1ff6348SSteven Rostedt (Red Hat) 	trace_clear_recursion(bit);
7330f1ff6348SSteven Rostedt (Red Hat) }
7331fabe38abSMasami Hiramatsu NOKPROBE_SYMBOL(ftrace_ops_assist_func);
7332f1ff6348SSteven Rostedt (Red Hat) 
733387354059SSteven Rostedt (Red Hat) /**
733487354059SSteven Rostedt (Red Hat)  * ftrace_ops_get_func - get the function a trampoline should call
733587354059SSteven Rostedt (Red Hat)  * @ops: the ops to get the function for
733687354059SSteven Rostedt (Red Hat)  *
733787354059SSteven Rostedt (Red Hat)  * Normally the mcount trampoline will call the ops->func, but there
733887354059SSteven Rostedt (Red Hat)  * are times that it should not. For example, if the ops does not
733987354059SSteven Rostedt (Red Hat)  * have its own recursion protection, then it should call the
73403a150df9SChunyu Hu  * ftrace_ops_assist_func() instead.
734187354059SSteven Rostedt (Red Hat)  *
734287354059SSteven Rostedt (Red Hat)  * Returns the function that the trampoline should call for @ops.
734387354059SSteven Rostedt (Red Hat)  */
734487354059SSteven Rostedt (Red Hat) ftrace_func_t ftrace_ops_get_func(struct ftrace_ops *ops)
734587354059SSteven Rostedt (Red Hat) {
734687354059SSteven Rostedt (Red Hat) 	/*
7347a25d036dSSteven Rostedt (VMware) 	 * If the function does not handle recursion or needs to be RCU safe,
7348a25d036dSSteven Rostedt (VMware) 	 * then we need to call the assist handler.
734987354059SSteven Rostedt (Red Hat) 	 */
7350a25d036dSSteven Rostedt (VMware) 	if (ops->flags & (FTRACE_OPS_FL_RECURSION |
7351a25d036dSSteven Rostedt (VMware) 			  FTRACE_OPS_FL_RCU))
7352c68c0fa2SSteven Rostedt (Red Hat) 		return ftrace_ops_assist_func;
735387354059SSteven Rostedt (Red Hat) 
735487354059SSteven Rostedt (Red Hat) 	return ops->func;
735587354059SSteven Rostedt (Red Hat) }
735687354059SSteven Rostedt (Red Hat) 
7357345ddcc8SSteven Rostedt (Red Hat) static void
7358345ddcc8SSteven Rostedt (Red Hat) ftrace_filter_pid_sched_switch_probe(void *data, bool preempt,
7359fa2c3254SValentin Schneider 				     struct task_struct *prev,
73609c2136beSDelyan Kratunov 				     struct task_struct *next,
73619c2136beSDelyan Kratunov 				     unsigned int prev_state)
7362e32d8956SSteven Rostedt {
7363345ddcc8SSteven Rostedt (Red Hat) 	struct trace_array *tr = data;
7364345ddcc8SSteven Rostedt (Red Hat) 	struct trace_pid_list *pid_list;
7365b3b1e6edSSteven Rostedt (VMware) 	struct trace_pid_list *no_pid_list;
7366345ddcc8SSteven Rostedt (Red Hat) 
7367345ddcc8SSteven Rostedt (Red Hat) 	pid_list = rcu_dereference_sched(tr->function_pids);
7368b3b1e6edSSteven Rostedt (VMware) 	no_pid_list = rcu_dereference_sched(tr->function_no_pids);
7369345ddcc8SSteven Rostedt (Red Hat) 
7370b3b1e6edSSteven Rostedt (VMware) 	if (trace_ignore_this_task(pid_list, no_pid_list, next))
73711c5eb448SSteven Rostedt (VMware) 		this_cpu_write(tr->array_buffer.data->ftrace_ignore_pid,
7372717e3f5eSSteven Rostedt (VMware) 			       FTRACE_PID_IGNORE);
7373717e3f5eSSteven Rostedt (VMware) 	else
7374717e3f5eSSteven Rostedt (VMware) 		this_cpu_write(tr->array_buffer.data->ftrace_ignore_pid,
7375717e3f5eSSteven Rostedt (VMware) 			       next->pid);
7376345ddcc8SSteven Rostedt (Red Hat) }
7377345ddcc8SSteven Rostedt (Red Hat) 
73781e10486fSNamhyung Kim static void
73791e10486fSNamhyung Kim ftrace_pid_follow_sched_process_fork(void *data,
73801e10486fSNamhyung Kim 				     struct task_struct *self,
73811e10486fSNamhyung Kim 				     struct task_struct *task)
73821e10486fSNamhyung Kim {
73831e10486fSNamhyung Kim 	struct trace_pid_list *pid_list;
73841e10486fSNamhyung Kim 	struct trace_array *tr = data;
73851e10486fSNamhyung Kim 
73861e10486fSNamhyung Kim 	pid_list = rcu_dereference_sched(tr->function_pids);
73871e10486fSNamhyung Kim 	trace_filter_add_remove_task(pid_list, self, task);
7388b3b1e6edSSteven Rostedt (VMware) 
7389b3b1e6edSSteven Rostedt (VMware) 	pid_list = rcu_dereference_sched(tr->function_no_pids);
7390b3b1e6edSSteven Rostedt (VMware) 	trace_filter_add_remove_task(pid_list, self, task);
73911e10486fSNamhyung Kim }
73921e10486fSNamhyung Kim 
73931e10486fSNamhyung Kim static void
73941e10486fSNamhyung Kim ftrace_pid_follow_sched_process_exit(void *data, struct task_struct *task)
73951e10486fSNamhyung Kim {
73961e10486fSNamhyung Kim 	struct trace_pid_list *pid_list;
73971e10486fSNamhyung Kim 	struct trace_array *tr = data;
73981e10486fSNamhyung Kim 
73991e10486fSNamhyung Kim 	pid_list = rcu_dereference_sched(tr->function_pids);
74001e10486fSNamhyung Kim 	trace_filter_add_remove_task(pid_list, NULL, task);
7401b3b1e6edSSteven Rostedt (VMware) 
7402b3b1e6edSSteven Rostedt (VMware) 	pid_list = rcu_dereference_sched(tr->function_no_pids);
7403b3b1e6edSSteven Rostedt (VMware) 	trace_filter_add_remove_task(pid_list, NULL, task);
74041e10486fSNamhyung Kim }
74051e10486fSNamhyung Kim 
74061e10486fSNamhyung Kim void ftrace_pid_follow_fork(struct trace_array *tr, bool enable)
74071e10486fSNamhyung Kim {
74081e10486fSNamhyung Kim 	if (enable) {
74091e10486fSNamhyung Kim 		register_trace_sched_process_fork(ftrace_pid_follow_sched_process_fork,
74101e10486fSNamhyung Kim 						  tr);
7411afcab636SSteven Rostedt (VMware) 		register_trace_sched_process_free(ftrace_pid_follow_sched_process_exit,
74121e10486fSNamhyung Kim 						  tr);
74131e10486fSNamhyung Kim 	} else {
74141e10486fSNamhyung Kim 		unregister_trace_sched_process_fork(ftrace_pid_follow_sched_process_fork,
74151e10486fSNamhyung Kim 						    tr);
7416afcab636SSteven Rostedt (VMware) 		unregister_trace_sched_process_free(ftrace_pid_follow_sched_process_exit,
74171e10486fSNamhyung Kim 						    tr);
74181e10486fSNamhyung Kim 	}
74191e10486fSNamhyung Kim }
74201e10486fSNamhyung Kim 
7421b3b1e6edSSteven Rostedt (VMware) static void clear_ftrace_pids(struct trace_array *tr, int type)
7422345ddcc8SSteven Rostedt (Red Hat) {
7423345ddcc8SSteven Rostedt (Red Hat) 	struct trace_pid_list *pid_list;
7424b3b1e6edSSteven Rostedt (VMware) 	struct trace_pid_list *no_pid_list;
7425e32d8956SSteven Rostedt 	int cpu;
7426e32d8956SSteven Rostedt 
7427345ddcc8SSteven Rostedt (Red Hat) 	pid_list = rcu_dereference_protected(tr->function_pids,
7428345ddcc8SSteven Rostedt (Red Hat) 					     lockdep_is_held(&ftrace_lock));
7429b3b1e6edSSteven Rostedt (VMware) 	no_pid_list = rcu_dereference_protected(tr->function_no_pids,
7430b3b1e6edSSteven Rostedt (VMware) 						lockdep_is_held(&ftrace_lock));
7431b3b1e6edSSteven Rostedt (VMware) 
7432b3b1e6edSSteven Rostedt (VMware) 	/* Make sure there's something to do */
743327683626SSteven Rostedt (VMware) 	if (!pid_type_enabled(type, pid_list, no_pid_list))
7434345ddcc8SSteven Rostedt (Red Hat) 		return;
7435345ddcc8SSteven Rostedt (Red Hat) 
7436b3b1e6edSSteven Rostedt (VMware) 	/* See if the pids still need to be checked after this */
743727683626SSteven Rostedt (VMware) 	if (!still_need_pid_events(type, pid_list, no_pid_list)) {
7438345ddcc8SSteven Rostedt (Red Hat) 		unregister_trace_sched_switch(ftrace_filter_pid_sched_switch_probe, tr);
7439345ddcc8SSteven Rostedt (Red Hat) 		for_each_possible_cpu(cpu)
7440717e3f5eSSteven Rostedt (VMware) 			per_cpu_ptr(tr->array_buffer.data, cpu)->ftrace_ignore_pid = FTRACE_PID_TRACE;
7441b3b1e6edSSteven Rostedt (VMware) 	}
7442345ddcc8SSteven Rostedt (Red Hat) 
7443b3b1e6edSSteven Rostedt (VMware) 	if (type & TRACE_PIDS)
7444345ddcc8SSteven Rostedt (Red Hat) 		rcu_assign_pointer(tr->function_pids, NULL);
7445345ddcc8SSteven Rostedt (Red Hat) 
7446b3b1e6edSSteven Rostedt (VMware) 	if (type & TRACE_NO_PIDS)
7447b3b1e6edSSteven Rostedt (VMware) 		rcu_assign_pointer(tr->function_no_pids, NULL);
7448b3b1e6edSSteven Rostedt (VMware) 
7449345ddcc8SSteven Rostedt (Red Hat) 	/* Wait till all users are no longer using pid filtering */
745074401729SPaul E. McKenney 	synchronize_rcu();
7451345ddcc8SSteven Rostedt (Red Hat) 
7452b3b1e6edSSteven Rostedt (VMware) 	if ((type & TRACE_PIDS) && pid_list)
74536954e415SSteven Rostedt (VMware) 		trace_pid_list_free(pid_list);
7454b3b1e6edSSteven Rostedt (VMware) 
7455b3b1e6edSSteven Rostedt (VMware) 	if ((type & TRACE_NO_PIDS) && no_pid_list)
74566954e415SSteven Rostedt (VMware) 		trace_pid_list_free(no_pid_list);
7457e32d8956SSteven Rostedt }
7458e32d8956SSteven Rostedt 
7459d879d0b8SNamhyung Kim void ftrace_clear_pids(struct trace_array *tr)
7460d879d0b8SNamhyung Kim {
7461d879d0b8SNamhyung Kim 	mutex_lock(&ftrace_lock);
7462d879d0b8SNamhyung Kim 
7463b3b1e6edSSteven Rostedt (VMware) 	clear_ftrace_pids(tr, TRACE_PIDS | TRACE_NO_PIDS);
7464d879d0b8SNamhyung Kim 
7465d879d0b8SNamhyung Kim 	mutex_unlock(&ftrace_lock);
7466d879d0b8SNamhyung Kim }
7467d879d0b8SNamhyung Kim 
7468b3b1e6edSSteven Rostedt (VMware) static void ftrace_pid_reset(struct trace_array *tr, int type)
7469e32d8956SSteven Rostedt {
7470756d17eeS[email protected] 	mutex_lock(&ftrace_lock);
7471b3b1e6edSSteven Rostedt (VMware) 	clear_ftrace_pids(tr, type);
7472756d17eeS[email protected] 
7473756d17eeS[email protected] 	ftrace_update_pid_func();
7474e1effa01SSteven Rostedt (Red Hat) 	ftrace_startup_all(0);
7475756d17eeS[email protected] 
7476756d17eeS[email protected] 	mutex_unlock(&ftrace_lock);
7477756d17eeS[email protected] }
7478756d17eeS[email protected] 
7479345ddcc8SSteven Rostedt (Red Hat) /* Greater than any max PID */
7480345ddcc8SSteven Rostedt (Red Hat) #define FTRACE_NO_PIDS		(void *)(PID_MAX_LIMIT + 1)
7481345ddcc8SSteven Rostedt (Red Hat) 
7482756d17eeS[email protected] static void *fpid_start(struct seq_file *m, loff_t *pos)
7483345ddcc8SSteven Rostedt (Red Hat) 	__acquires(RCU)
7484756d17eeS[email protected] {
7485345ddcc8SSteven Rostedt (Red Hat) 	struct trace_pid_list *pid_list;
7486345ddcc8SSteven Rostedt (Red Hat) 	struct trace_array *tr = m->private;
7487345ddcc8SSteven Rostedt (Red Hat) 
7488756d17eeS[email protected] 	mutex_lock(&ftrace_lock);
7489345ddcc8SSteven Rostedt (Red Hat) 	rcu_read_lock_sched();
7490756d17eeS[email protected] 
7491345ddcc8SSteven Rostedt (Red Hat) 	pid_list = rcu_dereference_sched(tr->function_pids);
7492756d17eeS[email protected] 
7493345ddcc8SSteven Rostedt (Red Hat) 	if (!pid_list)
7494345ddcc8SSteven Rostedt (Red Hat) 		return !(*pos) ? FTRACE_NO_PIDS : NULL;
7495345ddcc8SSteven Rostedt (Red Hat) 
7496345ddcc8SSteven Rostedt (Red Hat) 	return trace_pid_start(pid_list, pos);
7497756d17eeS[email protected] }
7498756d17eeS[email protected] 
7499756d17eeS[email protected] static void *fpid_next(struct seq_file *m, void *v, loff_t *pos)
7500756d17eeS[email protected] {
7501345ddcc8SSteven Rostedt (Red Hat) 	struct trace_array *tr = m->private;
7502345ddcc8SSteven Rostedt (Red Hat) 	struct trace_pid_list *pid_list = rcu_dereference_sched(tr->function_pids);
7503345ddcc8SSteven Rostedt (Red Hat) 
7504e4075e8bSVasily Averin 	if (v == FTRACE_NO_PIDS) {
7505e4075e8bSVasily Averin 		(*pos)++;
7506756d17eeS[email protected] 		return NULL;
7507e4075e8bSVasily Averin 	}
7508345ddcc8SSteven Rostedt (Red Hat) 	return trace_pid_next(pid_list, v, pos);
7509756d17eeS[email protected] }
7510756d17eeS[email protected] 
7511756d17eeS[email protected] static void fpid_stop(struct seq_file *m, void *p)
7512345ddcc8SSteven Rostedt (Red Hat) 	__releases(RCU)
7513756d17eeS[email protected] {
7514345ddcc8SSteven Rostedt (Red Hat) 	rcu_read_unlock_sched();
7515756d17eeS[email protected] 	mutex_unlock(&ftrace_lock);
7516756d17eeS[email protected] }
7517756d17eeS[email protected] 
7518756d17eeS[email protected] static int fpid_show(struct seq_file *m, void *v)
7519756d17eeS[email protected] {
7520345ddcc8SSteven Rostedt (Red Hat) 	if (v == FTRACE_NO_PIDS) {
7521fa6f0cc7SRasmus Villemoes 		seq_puts(m, "no pid\n");
7522756d17eeS[email protected] 		return 0;
7523756d17eeS[email protected] 	}
7524756d17eeS[email protected] 
7525345ddcc8SSteven Rostedt (Red Hat) 	return trace_pid_show(m, v);
7526756d17eeS[email protected] }
7527756d17eeS[email protected] 
7528756d17eeS[email protected] static const struct seq_operations ftrace_pid_sops = {
7529756d17eeS[email protected] 	.start = fpid_start,
7530756d17eeS[email protected] 	.next = fpid_next,
7531756d17eeS[email protected] 	.stop = fpid_stop,
7532756d17eeS[email protected] 	.show = fpid_show,
7533756d17eeS[email protected] };
7534756d17eeS[email protected] 
7535b3b1e6edSSteven Rostedt (VMware) static void *fnpid_start(struct seq_file *m, loff_t *pos)
7536b3b1e6edSSteven Rostedt (VMware) 	__acquires(RCU)
7537756d17eeS[email protected] {
7538b3b1e6edSSteven Rostedt (VMware) 	struct trace_pid_list *pid_list;
7539b3b1e6edSSteven Rostedt (VMware) 	struct trace_array *tr = m->private;
7540b3b1e6edSSteven Rostedt (VMware) 
7541b3b1e6edSSteven Rostedt (VMware) 	mutex_lock(&ftrace_lock);
7542b3b1e6edSSteven Rostedt (VMware) 	rcu_read_lock_sched();
7543b3b1e6edSSteven Rostedt (VMware) 
7544b3b1e6edSSteven Rostedt (VMware) 	pid_list = rcu_dereference_sched(tr->function_no_pids);
7545b3b1e6edSSteven Rostedt (VMware) 
7546b3b1e6edSSteven Rostedt (VMware) 	if (!pid_list)
7547b3b1e6edSSteven Rostedt (VMware) 		return !(*pos) ? FTRACE_NO_PIDS : NULL;
7548b3b1e6edSSteven Rostedt (VMware) 
7549b3b1e6edSSteven Rostedt (VMware) 	return trace_pid_start(pid_list, pos);
7550b3b1e6edSSteven Rostedt (VMware) }
7551b3b1e6edSSteven Rostedt (VMware) 
7552b3b1e6edSSteven Rostedt (VMware) static void *fnpid_next(struct seq_file *m, void *v, loff_t *pos)
7553b3b1e6edSSteven Rostedt (VMware) {
7554b3b1e6edSSteven Rostedt (VMware) 	struct trace_array *tr = m->private;
7555b3b1e6edSSteven Rostedt (VMware) 	struct trace_pid_list *pid_list = rcu_dereference_sched(tr->function_no_pids);
7556b3b1e6edSSteven Rostedt (VMware) 
7557b3b1e6edSSteven Rostedt (VMware) 	if (v == FTRACE_NO_PIDS) {
7558b3b1e6edSSteven Rostedt (VMware) 		(*pos)++;
7559b3b1e6edSSteven Rostedt (VMware) 		return NULL;
7560b3b1e6edSSteven Rostedt (VMware) 	}
7561b3b1e6edSSteven Rostedt (VMware) 	return trace_pid_next(pid_list, v, pos);
7562b3b1e6edSSteven Rostedt (VMware) }
7563b3b1e6edSSteven Rostedt (VMware) 
7564b3b1e6edSSteven Rostedt (VMware) static const struct seq_operations ftrace_no_pid_sops = {
7565b3b1e6edSSteven Rostedt (VMware) 	.start = fnpid_start,
7566b3b1e6edSSteven Rostedt (VMware) 	.next = fnpid_next,
7567b3b1e6edSSteven Rostedt (VMware) 	.stop = fpid_stop,
7568b3b1e6edSSteven Rostedt (VMware) 	.show = fpid_show,
7569b3b1e6edSSteven Rostedt (VMware) };
7570b3b1e6edSSteven Rostedt (VMware) 
7571b3b1e6edSSteven Rostedt (VMware) static int pid_open(struct inode *inode, struct file *file, int type)
7572b3b1e6edSSteven Rostedt (VMware) {
7573b3b1e6edSSteven Rostedt (VMware) 	const struct seq_operations *seq_ops;
7574345ddcc8SSteven Rostedt (Red Hat) 	struct trace_array *tr = inode->i_private;
7575345ddcc8SSteven Rostedt (Red Hat) 	struct seq_file *m;
7576756d17eeS[email protected] 	int ret = 0;
7577756d17eeS[email protected] 
75788530dec6SSteven Rostedt (VMware) 	ret = tracing_check_open_get_tr(tr);
75798530dec6SSteven Rostedt (VMware) 	if (ret)
75808530dec6SSteven Rostedt (VMware) 		return ret;
7581345ddcc8SSteven Rostedt (Red Hat) 
7582756d17eeS[email protected] 	if ((file->f_mode & FMODE_WRITE) &&
7583756d17eeS[email protected] 	    (file->f_flags & O_TRUNC))
7584b3b1e6edSSteven Rostedt (VMware) 		ftrace_pid_reset(tr, type);
7585756d17eeS[email protected] 
7586b3b1e6edSSteven Rostedt (VMware) 	switch (type) {
7587b3b1e6edSSteven Rostedt (VMware) 	case TRACE_PIDS:
7588b3b1e6edSSteven Rostedt (VMware) 		seq_ops = &ftrace_pid_sops;
7589b3b1e6edSSteven Rostedt (VMware) 		break;
7590b3b1e6edSSteven Rostedt (VMware) 	case TRACE_NO_PIDS:
7591b3b1e6edSSteven Rostedt (VMware) 		seq_ops = &ftrace_no_pid_sops;
7592b3b1e6edSSteven Rostedt (VMware) 		break;
7593026bb845SKaitao Cheng 	default:
7594026bb845SKaitao Cheng 		trace_array_put(tr);
7595026bb845SKaitao Cheng 		WARN_ON_ONCE(1);
7596026bb845SKaitao Cheng 		return -EINVAL;
7597b3b1e6edSSteven Rostedt (VMware) 	}
7598b3b1e6edSSteven Rostedt (VMware) 
7599b3b1e6edSSteven Rostedt (VMware) 	ret = seq_open(file, seq_ops);
7600345ddcc8SSteven Rostedt (Red Hat) 	if (ret < 0) {
7601345ddcc8SSteven Rostedt (Red Hat) 		trace_array_put(tr);
7602345ddcc8SSteven Rostedt (Red Hat) 	} else {
7603345ddcc8SSteven Rostedt (Red Hat) 		m = file->private_data;
7604345ddcc8SSteven Rostedt (Red Hat) 		/* copy tr over to seq ops */
7605345ddcc8SSteven Rostedt (Red Hat) 		m->private = tr;
7606345ddcc8SSteven Rostedt (Red Hat) 	}
7607756d17eeS[email protected] 
7608756d17eeS[email protected] 	return ret;
7609756d17eeS[email protected] }
7610756d17eeS[email protected] 
7611b3b1e6edSSteven Rostedt (VMware) static int
7612b3b1e6edSSteven Rostedt (VMware) ftrace_pid_open(struct inode *inode, struct file *file)
7613b3b1e6edSSteven Rostedt (VMware) {
7614b3b1e6edSSteven Rostedt (VMware) 	return pid_open(inode, file, TRACE_PIDS);
7615b3b1e6edSSteven Rostedt (VMware) }
7616b3b1e6edSSteven Rostedt (VMware) 
7617b3b1e6edSSteven Rostedt (VMware) static int
7618b3b1e6edSSteven Rostedt (VMware) ftrace_no_pid_open(struct inode *inode, struct file *file)
7619b3b1e6edSSteven Rostedt (VMware) {
7620b3b1e6edSSteven Rostedt (VMware) 	return pid_open(inode, file, TRACE_NO_PIDS);
7621b3b1e6edSSteven Rostedt (VMware) }
7622b3b1e6edSSteven Rostedt (VMware) 
7623345ddcc8SSteven Rostedt (Red Hat) static void ignore_task_cpu(void *data)
7624345ddcc8SSteven Rostedt (Red Hat) {
7625345ddcc8SSteven Rostedt (Red Hat) 	struct trace_array *tr = data;
7626345ddcc8SSteven Rostedt (Red Hat) 	struct trace_pid_list *pid_list;
7627b3b1e6edSSteven Rostedt (VMware) 	struct trace_pid_list *no_pid_list;
7628345ddcc8SSteven Rostedt (Red Hat) 
7629345ddcc8SSteven Rostedt (Red Hat) 	/*
7630345ddcc8SSteven Rostedt (Red Hat) 	 * This function is called by on_each_cpu() while the
7631345ddcc8SSteven Rostedt (Red Hat) 	 * event_mutex is held.
7632345ddcc8SSteven Rostedt (Red Hat) 	 */
7633345ddcc8SSteven Rostedt (Red Hat) 	pid_list = rcu_dereference_protected(tr->function_pids,
7634345ddcc8SSteven Rostedt (Red Hat) 					     mutex_is_locked(&ftrace_lock));
7635b3b1e6edSSteven Rostedt (VMware) 	no_pid_list = rcu_dereference_protected(tr->function_no_pids,
7636b3b1e6edSSteven Rostedt (VMware) 						mutex_is_locked(&ftrace_lock));
7637345ddcc8SSteven Rostedt (Red Hat) 
7638b3b1e6edSSteven Rostedt (VMware) 	if (trace_ignore_this_task(pid_list, no_pid_list, current))
76391c5eb448SSteven Rostedt (VMware) 		this_cpu_write(tr->array_buffer.data->ftrace_ignore_pid,
7640717e3f5eSSteven Rostedt (VMware) 			       FTRACE_PID_IGNORE);
7641717e3f5eSSteven Rostedt (VMware) 	else
7642717e3f5eSSteven Rostedt (VMware) 		this_cpu_write(tr->array_buffer.data->ftrace_ignore_pid,
7643717e3f5eSSteven Rostedt (VMware) 			       current->pid);
7644345ddcc8SSteven Rostedt (Red Hat) }
7645345ddcc8SSteven Rostedt (Red Hat) 
7646df4fc315SSteven Rostedt static ssize_t
7647b3b1e6edSSteven Rostedt (VMware) pid_write(struct file *filp, const char __user *ubuf,
7648b3b1e6edSSteven Rostedt (VMware) 	  size_t cnt, loff_t *ppos, int type)
7649df4fc315SSteven Rostedt {
7650345ddcc8SSteven Rostedt (Red Hat) 	struct seq_file *m = filp->private_data;
7651345ddcc8SSteven Rostedt (Red Hat) 	struct trace_array *tr = m->private;
7652b3b1e6edSSteven Rostedt (VMware) 	struct trace_pid_list *filtered_pids;
7653b3b1e6edSSteven Rostedt (VMware) 	struct trace_pid_list *other_pids;
7654345ddcc8SSteven Rostedt (Red Hat) 	struct trace_pid_list *pid_list;
7655345ddcc8SSteven Rostedt (Red Hat) 	ssize_t ret;
7656df4fc315SSteven Rostedt 
7657345ddcc8SSteven Rostedt (Red Hat) 	if (!cnt)
7658345ddcc8SSteven Rostedt (Red Hat) 		return 0;
7659df4fc315SSteven Rostedt 
7660345ddcc8SSteven Rostedt (Red Hat) 	mutex_lock(&ftrace_lock);
7661df4fc315SSteven Rostedt 
7662b3b1e6edSSteven Rostedt (VMware) 	switch (type) {
7663b3b1e6edSSteven Rostedt (VMware) 	case TRACE_PIDS:
7664345ddcc8SSteven Rostedt (Red Hat) 		filtered_pids = rcu_dereference_protected(tr->function_pids,
7665345ddcc8SSteven Rostedt (Red Hat) 					     lockdep_is_held(&ftrace_lock));
7666b3b1e6edSSteven Rostedt (VMware) 		other_pids = rcu_dereference_protected(tr->function_no_pids,
7667b3b1e6edSSteven Rostedt (VMware) 					     lockdep_is_held(&ftrace_lock));
7668b3b1e6edSSteven Rostedt (VMware) 		break;
7669b3b1e6edSSteven Rostedt (VMware) 	case TRACE_NO_PIDS:
7670b3b1e6edSSteven Rostedt (VMware) 		filtered_pids = rcu_dereference_protected(tr->function_no_pids,
7671b3b1e6edSSteven Rostedt (VMware) 					     lockdep_is_held(&ftrace_lock));
7672b3b1e6edSSteven Rostedt (VMware) 		other_pids = rcu_dereference_protected(tr->function_pids,
7673b3b1e6edSSteven Rostedt (VMware) 					     lockdep_is_held(&ftrace_lock));
7674b3b1e6edSSteven Rostedt (VMware) 		break;
7675026bb845SKaitao Cheng 	default:
7676026bb845SKaitao Cheng 		ret = -EINVAL;
7677026bb845SKaitao Cheng 		WARN_ON_ONCE(1);
7678026bb845SKaitao Cheng 		goto out;
7679b3b1e6edSSteven Rostedt (VMware) 	}
7680345ddcc8SSteven Rostedt (Red Hat) 
7681345ddcc8SSteven Rostedt (Red Hat) 	ret = trace_pid_write(filtered_pids, &pid_list, ubuf, cnt);
7682345ddcc8SSteven Rostedt (Red Hat) 	if (ret < 0)
7683345ddcc8SSteven Rostedt (Red Hat) 		goto out;
7684345ddcc8SSteven Rostedt (Red Hat) 
7685b3b1e6edSSteven Rostedt (VMware) 	switch (type) {
7686b3b1e6edSSteven Rostedt (VMware) 	case TRACE_PIDS:
7687345ddcc8SSteven Rostedt (Red Hat) 		rcu_assign_pointer(tr->function_pids, pid_list);
7688b3b1e6edSSteven Rostedt (VMware) 		break;
7689b3b1e6edSSteven Rostedt (VMware) 	case TRACE_NO_PIDS:
7690b3b1e6edSSteven Rostedt (VMware) 		rcu_assign_pointer(tr->function_no_pids, pid_list);
7691b3b1e6edSSteven Rostedt (VMware) 		break;
7692b3b1e6edSSteven Rostedt (VMware) 	}
7693b3b1e6edSSteven Rostedt (VMware) 
7694345ddcc8SSteven Rostedt (Red Hat) 
7695345ddcc8SSteven Rostedt (Red Hat) 	if (filtered_pids) {
769674401729SPaul E. McKenney 		synchronize_rcu();
76976954e415SSteven Rostedt (VMware) 		trace_pid_list_free(filtered_pids);
7698b3b1e6edSSteven Rostedt (VMware) 	} else if (pid_list && !other_pids) {
7699345ddcc8SSteven Rostedt (Red Hat) 		/* Register a probe to set whether to ignore the tracing of a task */
7700345ddcc8SSteven Rostedt (Red Hat) 		register_trace_sched_switch(ftrace_filter_pid_sched_switch_probe, tr);
7701345ddcc8SSteven Rostedt (Red Hat) 	}
7702df4fc315SSteven Rostedt 
7703756d17eeS[email protected] 	/*
7704345ddcc8SSteven Rostedt (Red Hat) 	 * Ignoring of pids is done at task switch. But we have to
7705345ddcc8SSteven Rostedt (Red Hat) 	 * check for those tasks that are currently running.
7706345ddcc8SSteven Rostedt (Red Hat) 	 * Always do this in case a pid was appended or removed.
7707756d17eeS[email protected] 	 */
7708345ddcc8SSteven Rostedt (Red Hat) 	on_each_cpu(ignore_task_cpu, tr, 1);
7709756d17eeS[email protected] 
7710345ddcc8SSteven Rostedt (Red Hat) 	ftrace_update_pid_func();
7711345ddcc8SSteven Rostedt (Red Hat) 	ftrace_startup_all(0);
7712345ddcc8SSteven Rostedt (Red Hat)  out:
7713345ddcc8SSteven Rostedt (Red Hat) 	mutex_unlock(&ftrace_lock);
7714345ddcc8SSteven Rostedt (Red Hat) 
7715345ddcc8SSteven Rostedt (Red Hat) 	if (ret > 0)
7716345ddcc8SSteven Rostedt (Red Hat) 		*ppos += ret;
7717345ddcc8SSteven Rostedt (Red Hat) 
7718df4fc315SSteven Rostedt 	return ret;
7719e32d8956SSteven Rostedt }
7720978f3a45SSteven Rostedt 
7721b3b1e6edSSteven Rostedt (VMware) static ssize_t
7722b3b1e6edSSteven Rostedt (VMware) ftrace_pid_write(struct file *filp, const char __user *ubuf,
7723b3b1e6edSSteven Rostedt (VMware) 		 size_t cnt, loff_t *ppos)
7724b3b1e6edSSteven Rostedt (VMware) {
7725b3b1e6edSSteven Rostedt (VMware) 	return pid_write(filp, ubuf, cnt, ppos, TRACE_PIDS);
7726b3b1e6edSSteven Rostedt (VMware) }
7727b3b1e6edSSteven Rostedt (VMware) 
7728b3b1e6edSSteven Rostedt (VMware) static ssize_t
7729b3b1e6edSSteven Rostedt (VMware) ftrace_no_pid_write(struct file *filp, const char __user *ubuf,
7730b3b1e6edSSteven Rostedt (VMware) 		    size_t cnt, loff_t *ppos)
7731b3b1e6edSSteven Rostedt (VMware) {
7732b3b1e6edSSteven Rostedt (VMware) 	return pid_write(filp, ubuf, cnt, ppos, TRACE_NO_PIDS);
7733b3b1e6edSSteven Rostedt (VMware) }
7734b3b1e6edSSteven Rostedt (VMware) 
7735756d17eeS[email protected] static int
7736756d17eeS[email protected] ftrace_pid_release(struct inode *inode, struct file *file)
7737756d17eeS[email protected] {
7738345ddcc8SSteven Rostedt (Red Hat) 	struct trace_array *tr = inode->i_private;
7739978f3a45SSteven Rostedt 
7740345ddcc8SSteven Rostedt (Red Hat) 	trace_array_put(tr);
7741345ddcc8SSteven Rostedt (Red Hat) 
7742345ddcc8SSteven Rostedt (Red Hat) 	return seq_release(inode, file);
7743df4fc315SSteven Rostedt }
7744df4fc315SSteven Rostedt 
77455e2336a0SSteven Rostedt static const struct file_operations ftrace_pid_fops = {
7746756d17eeS[email protected] 	.open		= ftrace_pid_open,
7747df4fc315SSteven Rostedt 	.write		= ftrace_pid_write,
7748756d17eeS[email protected] 	.read		= seq_read,
7749098c879eSSteven Rostedt (Red Hat) 	.llseek		= tracing_lseek,
7750756d17eeS[email protected] 	.release	= ftrace_pid_release,
7751df4fc315SSteven Rostedt };
7752df4fc315SSteven Rostedt 
7753b3b1e6edSSteven Rostedt (VMware) static const struct file_operations ftrace_no_pid_fops = {
7754b3b1e6edSSteven Rostedt (VMware) 	.open		= ftrace_no_pid_open,
7755b3b1e6edSSteven Rostedt (VMware) 	.write		= ftrace_no_pid_write,
7756b3b1e6edSSteven Rostedt (VMware) 	.read		= seq_read,
7757b3b1e6edSSteven Rostedt (VMware) 	.llseek		= tracing_lseek,
7758b3b1e6edSSteven Rostedt (VMware) 	.release	= ftrace_pid_release,
7759b3b1e6edSSteven Rostedt (VMware) };
7760b3b1e6edSSteven Rostedt (VMware) 
7761345ddcc8SSteven Rostedt (Red Hat) void ftrace_init_tracefs(struct trace_array *tr, struct dentry *d_tracer)
7762df4fc315SSteven Rostedt {
776321ccc9cdSSteven Rostedt (VMware) 	trace_create_file("set_ftrace_pid", TRACE_MODE_WRITE, d_tracer,
7764345ddcc8SSteven Rostedt (Red Hat) 			    tr, &ftrace_pid_fops);
776521ccc9cdSSteven Rostedt (VMware) 	trace_create_file("set_ftrace_notrace_pid", TRACE_MODE_WRITE,
776621ccc9cdSSteven Rostedt (VMware) 			  d_tracer, tr, &ftrace_no_pid_fops);
7767df4fc315SSteven Rostedt }
7768df4fc315SSteven Rostedt 
7769501c2375SSteven Rostedt (Red Hat) void __init ftrace_init_tracefs_toplevel(struct trace_array *tr,
7770501c2375SSteven Rostedt (Red Hat) 					 struct dentry *d_tracer)
7771501c2375SSteven Rostedt (Red Hat) {
7772501c2375SSteven Rostedt (Red Hat) 	/* Only the top level directory has the dyn_tracefs and profile */
7773501c2375SSteven Rostedt (Red Hat) 	WARN_ON(!(tr->flags & TRACE_ARRAY_FL_GLOBAL));
7774501c2375SSteven Rostedt (Red Hat) 
7775501c2375SSteven Rostedt (Red Hat) 	ftrace_init_dyn_tracefs(d_tracer);
7776501c2375SSteven Rostedt (Red Hat) 	ftrace_profile_tracefs(d_tracer);
7777501c2375SSteven Rostedt (Red Hat) }
7778501c2375SSteven Rostedt (Red Hat) 
77793d083395SSteven Rostedt /**
778081adbdc0SSteven Rostedt  * ftrace_kill - kill ftrace
7781a2bb6a3dSSteven Rostedt  *
7782a2bb6a3dSSteven Rostedt  * This function should be used by panic code. It stops ftrace
7783a2bb6a3dSSteven Rostedt  * but in a not so nice way. If you need to simply kill ftrace
7784a2bb6a3dSSteven Rostedt  * from a non-atomic section, use ftrace_kill.
7785a2bb6a3dSSteven Rostedt  */
778681adbdc0SSteven Rostedt void ftrace_kill(void)
7787a2bb6a3dSSteven Rostedt {
7788a2bb6a3dSSteven Rostedt 	ftrace_disabled = 1;
7789a2bb6a3dSSteven Rostedt 	ftrace_enabled = 0;
77905ccba64aSYisheng Xie 	ftrace_trace_function = ftrace_stub;
7791a2bb6a3dSSteven Rostedt }
7792a2bb6a3dSSteven Rostedt 
7793a2bb6a3dSSteven Rostedt /**
77946130722fSSteven Rostedt (VMware)  * ftrace_is_dead - Test if ftrace is dead or not.
77956130722fSSteven Rostedt (VMware)  *
77966130722fSSteven Rostedt (VMware)  * Returns 1 if ftrace is "dead", zero otherwise.
7797e0a413f6SSteven Rostedt  */
7798e0a413f6SSteven Rostedt int ftrace_is_dead(void)
7799e0a413f6SSteven Rostedt {
7800e0a413f6SSteven Rostedt 	return ftrace_disabled;
7801e0a413f6SSteven Rostedt }
7802e0a413f6SSteven Rostedt 
780353cd885bSSong Liu #ifdef CONFIG_DYNAMIC_FTRACE_WITH_DIRECT_CALLS
780453cd885bSSong Liu /*
780553cd885bSSong Liu  * When registering ftrace_ops with IPMODIFY, it is necessary to make sure
780653cd885bSSong Liu  * it doesn't conflict with any direct ftrace_ops. If there is existing
780753cd885bSSong Liu  * direct ftrace_ops on a kernel function being patched, call
780853cd885bSSong Liu  * FTRACE_OPS_CMD_ENABLE_SHARE_IPMODIFY_PEER on it to enable sharing.
780953cd885bSSong Liu  *
781053cd885bSSong Liu  * @ops:     ftrace_ops being registered.
781153cd885bSSong Liu  *
781253cd885bSSong Liu  * Returns:
781353cd885bSSong Liu  *         0 on success;
781453cd885bSSong Liu  *         Negative on failure.
781553cd885bSSong Liu  */
781653cd885bSSong Liu static int prepare_direct_functions_for_ipmodify(struct ftrace_ops *ops)
781753cd885bSSong Liu {
781853cd885bSSong Liu 	struct ftrace_func_entry *entry;
781953cd885bSSong Liu 	struct ftrace_hash *hash;
782053cd885bSSong Liu 	struct ftrace_ops *op;
782153cd885bSSong Liu 	int size, i, ret;
782253cd885bSSong Liu 
782353cd885bSSong Liu 	lockdep_assert_held_once(&direct_mutex);
782453cd885bSSong Liu 
782553cd885bSSong Liu 	if (!(ops->flags & FTRACE_OPS_FL_IPMODIFY))
782653cd885bSSong Liu 		return 0;
782753cd885bSSong Liu 
782853cd885bSSong Liu 	hash = ops->func_hash->filter_hash;
782953cd885bSSong Liu 	size = 1 << hash->size_bits;
783053cd885bSSong Liu 	for (i = 0; i < size; i++) {
783153cd885bSSong Liu 		hlist_for_each_entry(entry, &hash->buckets[i], hlist) {
783253cd885bSSong Liu 			unsigned long ip = entry->ip;
783353cd885bSSong Liu 			bool found_op = false;
783453cd885bSSong Liu 
783553cd885bSSong Liu 			mutex_lock(&ftrace_lock);
783653cd885bSSong Liu 			do_for_each_ftrace_op(op, ftrace_ops_list) {
783753cd885bSSong Liu 				if (!(op->flags & FTRACE_OPS_FL_DIRECT))
783853cd885bSSong Liu 					continue;
783953cd885bSSong Liu 				if (ops_references_ip(op, ip)) {
784053cd885bSSong Liu 					found_op = true;
784153cd885bSSong Liu 					break;
784253cd885bSSong Liu 				}
784353cd885bSSong Liu 			} while_for_each_ftrace_op(op);
784453cd885bSSong Liu 			mutex_unlock(&ftrace_lock);
784553cd885bSSong Liu 
784653cd885bSSong Liu 			if (found_op) {
784753cd885bSSong Liu 				if (!op->ops_func)
784853cd885bSSong Liu 					return -EBUSY;
784953cd885bSSong Liu 
785053cd885bSSong Liu 				ret = op->ops_func(op, FTRACE_OPS_CMD_ENABLE_SHARE_IPMODIFY_PEER);
785153cd885bSSong Liu 				if (ret)
785253cd885bSSong Liu 					return ret;
785353cd885bSSong Liu 			}
785453cd885bSSong Liu 		}
785553cd885bSSong Liu 	}
785653cd885bSSong Liu 
785753cd885bSSong Liu 	return 0;
785853cd885bSSong Liu }
785953cd885bSSong Liu 
786053cd885bSSong Liu /*
786153cd885bSSong Liu  * Similar to prepare_direct_functions_for_ipmodify, clean up after ops
786253cd885bSSong Liu  * with IPMODIFY is unregistered. The cleanup is optional for most DIRECT
786353cd885bSSong Liu  * ops.
786453cd885bSSong Liu  */
786553cd885bSSong Liu static void cleanup_direct_functions_after_ipmodify(struct ftrace_ops *ops)
786653cd885bSSong Liu {
786753cd885bSSong Liu 	struct ftrace_func_entry *entry;
786853cd885bSSong Liu 	struct ftrace_hash *hash;
786953cd885bSSong Liu 	struct ftrace_ops *op;
787053cd885bSSong Liu 	int size, i;
787153cd885bSSong Liu 
787253cd885bSSong Liu 	if (!(ops->flags & FTRACE_OPS_FL_IPMODIFY))
787353cd885bSSong Liu 		return;
787453cd885bSSong Liu 
787553cd885bSSong Liu 	mutex_lock(&direct_mutex);
787653cd885bSSong Liu 
787753cd885bSSong Liu 	hash = ops->func_hash->filter_hash;
787853cd885bSSong Liu 	size = 1 << hash->size_bits;
787953cd885bSSong Liu 	for (i = 0; i < size; i++) {
788053cd885bSSong Liu 		hlist_for_each_entry(entry, &hash->buckets[i], hlist) {
788153cd885bSSong Liu 			unsigned long ip = entry->ip;
788253cd885bSSong Liu 			bool found_op = false;
788353cd885bSSong Liu 
788453cd885bSSong Liu 			mutex_lock(&ftrace_lock);
788553cd885bSSong Liu 			do_for_each_ftrace_op(op, ftrace_ops_list) {
788653cd885bSSong Liu 				if (!(op->flags & FTRACE_OPS_FL_DIRECT))
788753cd885bSSong Liu 					continue;
788853cd885bSSong Liu 				if (ops_references_ip(op, ip)) {
788953cd885bSSong Liu 					found_op = true;
789053cd885bSSong Liu 					break;
789153cd885bSSong Liu 				}
789253cd885bSSong Liu 			} while_for_each_ftrace_op(op);
789353cd885bSSong Liu 			mutex_unlock(&ftrace_lock);
789453cd885bSSong Liu 
789553cd885bSSong Liu 			/* The cleanup is optional, ignore any errors */
789653cd885bSSong Liu 			if (found_op && op->ops_func)
789753cd885bSSong Liu 				op->ops_func(op, FTRACE_OPS_CMD_DISABLE_SHARE_IPMODIFY_PEER);
789853cd885bSSong Liu 		}
789953cd885bSSong Liu 	}
790053cd885bSSong Liu 	mutex_unlock(&direct_mutex);
790153cd885bSSong Liu }
790253cd885bSSong Liu 
790353cd885bSSong Liu #define lock_direct_mutex()	mutex_lock(&direct_mutex)
790453cd885bSSong Liu #define unlock_direct_mutex()	mutex_unlock(&direct_mutex)
790553cd885bSSong Liu 
790653cd885bSSong Liu #else  /* CONFIG_DYNAMIC_FTRACE_WITH_DIRECT_CALLS */
790753cd885bSSong Liu 
790853cd885bSSong Liu static int prepare_direct_functions_for_ipmodify(struct ftrace_ops *ops)
790953cd885bSSong Liu {
791053cd885bSSong Liu 	return 0;
791153cd885bSSong Liu }
791253cd885bSSong Liu 
791353cd885bSSong Liu static void cleanup_direct_functions_after_ipmodify(struct ftrace_ops *ops)
791453cd885bSSong Liu {
791553cd885bSSong Liu }
791653cd885bSSong Liu 
791753cd885bSSong Liu #define lock_direct_mutex()	do { } while (0)
791853cd885bSSong Liu #define unlock_direct_mutex()	do { } while (0)
791953cd885bSSong Liu 
792053cd885bSSong Liu #endif  /* CONFIG_DYNAMIC_FTRACE_WITH_DIRECT_CALLS */
792153cd885bSSong Liu 
792253cd885bSSong Liu /*
792353cd885bSSong Liu  * Similar to register_ftrace_function, except we don't lock direct_mutex.
792453cd885bSSong Liu  */
792553cd885bSSong Liu static int register_ftrace_function_nolock(struct ftrace_ops *ops)
792653cd885bSSong Liu {
792753cd885bSSong Liu 	int ret;
792853cd885bSSong Liu 
792953cd885bSSong Liu 	ftrace_ops_init(ops);
793053cd885bSSong Liu 
793153cd885bSSong Liu 	mutex_lock(&ftrace_lock);
793253cd885bSSong Liu 
793353cd885bSSong Liu 	ret = ftrace_startup(ops, 0);
793453cd885bSSong Liu 
793553cd885bSSong Liu 	mutex_unlock(&ftrace_lock);
793653cd885bSSong Liu 
793753cd885bSSong Liu 	return ret;
793853cd885bSSong Liu }
793953cd885bSSong Liu 
7940e0a413f6SSteven Rostedt /**
79413d083395SSteven Rostedt  * register_ftrace_function - register a function for profiling
794278cbc651SJiapeng Chong  * @ops:	ops structure that holds the function for profiling.
79433d083395SSteven Rostedt  *
79443d083395SSteven Rostedt  * Register a function to be called by all functions in the
79453d083395SSteven Rostedt  * kernel.
79463d083395SSteven Rostedt  *
79473d083395SSteven Rostedt  * Note: @ops->func and all the functions it calls must be labeled
79483d083395SSteven Rostedt  *       with "notrace", otherwise it will go into a
79493d083395SSteven Rostedt  *       recursive loop.
79503d083395SSteven Rostedt  */
79513d083395SSteven Rostedt int register_ftrace_function(struct ftrace_ops *ops)
79523d083395SSteven Rostedt {
79533b1a8f45SColin Ian King 	int ret;
79544eebcc81SSteven Rostedt 
795553cd885bSSong Liu 	lock_direct_mutex();
795653cd885bSSong Liu 	ret = prepare_direct_functions_for_ipmodify(ops);
795753cd885bSSong Liu 	if (ret < 0)
795853cd885bSSong Liu 		goto out_unlock;
7959f04f24fbSMasami Hiramatsu 
796053cd885bSSong Liu 	ret = register_ftrace_function_nolock(ops);
7961e7d3737eSFrederic Weisbecker 
796253cd885bSSong Liu out_unlock:
796353cd885bSSong Liu 	unlock_direct_mutex();
7964b0fc494fSSteven Rostedt 	return ret;
79653d083395SSteven Rostedt }
7966cdbe61bfSSteven Rostedt EXPORT_SYMBOL_GPL(register_ftrace_function);
79673d083395SSteven Rostedt 
79683d083395SSteven Rostedt /**
796932632920SUwe Kleine-Koenig  * unregister_ftrace_function - unregister a function for profiling.
797078cbc651SJiapeng Chong  * @ops:	ops structure that holds the function to unregister
79713d083395SSteven Rostedt  *
79723d083395SSteven Rostedt  * Unregister a function that was added to be called by ftrace profiling.
79733d083395SSteven Rostedt  */
79743d083395SSteven Rostedt int unregister_ftrace_function(struct ftrace_ops *ops)
79753d083395SSteven Rostedt {
79763d083395SSteven Rostedt 	int ret;
79773d083395SSteven Rostedt 
7978e6ea44e9SSteven Rostedt 	mutex_lock(&ftrace_lock);
79798a56d776SSteven Rostedt (Red Hat) 	ret = ftrace_shutdown(ops, 0);
7980e6ea44e9SSteven Rostedt 	mutex_unlock(&ftrace_lock);
7981b0fc494fSSteven Rostedt 
798253cd885bSSong Liu 	cleanup_direct_functions_after_ipmodify(ops);
7983b0fc494fSSteven Rostedt 	return ret;
7984b0fc494fSSteven Rostedt }
7985cdbe61bfSSteven Rostedt EXPORT_SYMBOL_GPL(unregister_ftrace_function);
7986b0fc494fSSteven Rostedt 
7987bed0d9a5SJiri Olsa static int symbols_cmp(const void *a, const void *b)
7988bed0d9a5SJiri Olsa {
7989bed0d9a5SJiri Olsa 	const char **str_a = (const char **) a;
7990bed0d9a5SJiri Olsa 	const char **str_b = (const char **) b;
7991bed0d9a5SJiri Olsa 
7992bed0d9a5SJiri Olsa 	return strcmp(*str_a, *str_b);
7993bed0d9a5SJiri Olsa }
7994bed0d9a5SJiri Olsa 
7995bed0d9a5SJiri Olsa struct kallsyms_data {
7996bed0d9a5SJiri Olsa 	unsigned long *addrs;
7997bed0d9a5SJiri Olsa 	const char **syms;
7998bed0d9a5SJiri Olsa 	size_t cnt;
7999bed0d9a5SJiri Olsa 	size_t found;
8000bed0d9a5SJiri Olsa };
8001bed0d9a5SJiri Olsa 
80023640bf85SJiri Olsa /* This function gets called for all kernel and module symbols
80033640bf85SJiri Olsa  * and returns 1 in case we resolved all the requested symbols,
80043640bf85SJiri Olsa  * 0 otherwise.
80053640bf85SJiri Olsa  */
8006bed0d9a5SJiri Olsa static int kallsyms_callback(void *data, const char *name,
8007bed0d9a5SJiri Olsa 			     struct module *mod, unsigned long addr)
8008bed0d9a5SJiri Olsa {
8009bed0d9a5SJiri Olsa 	struct kallsyms_data *args = data;
8010eb1b2985SJiri Olsa 	const char **sym;
8011eb1b2985SJiri Olsa 	int idx;
8012bed0d9a5SJiri Olsa 
8013eb1b2985SJiri Olsa 	sym = bsearch(&name, args->syms, args->cnt, sizeof(*args->syms), symbols_cmp);
8014eb1b2985SJiri Olsa 	if (!sym)
8015eb1b2985SJiri Olsa 		return 0;
8016eb1b2985SJiri Olsa 
8017eb1b2985SJiri Olsa 	idx = sym - args->syms;
8018eb1b2985SJiri Olsa 	if (args->addrs[idx])
8019bed0d9a5SJiri Olsa 		return 0;
8020bed0d9a5SJiri Olsa 
80219d68c19cSJiri Olsa 	if (!ftrace_location(addr))
8022bed0d9a5SJiri Olsa 		return 0;
8023bed0d9a5SJiri Olsa 
8024eb1b2985SJiri Olsa 	args->addrs[idx] = addr;
8025eb1b2985SJiri Olsa 	args->found++;
8026bed0d9a5SJiri Olsa 	return args->found == args->cnt ? 1 : 0;
8027bed0d9a5SJiri Olsa }
8028bed0d9a5SJiri Olsa 
8029bed0d9a5SJiri Olsa /**
8030bed0d9a5SJiri Olsa  * ftrace_lookup_symbols - Lookup addresses for array of symbols
8031bed0d9a5SJiri Olsa  *
8032bed0d9a5SJiri Olsa  * @sorted_syms: array of symbols pointers symbols to resolve,
8033bed0d9a5SJiri Olsa  * must be alphabetically sorted
8034bed0d9a5SJiri Olsa  * @cnt: number of symbols/addresses in @syms/@addrs arrays
8035bed0d9a5SJiri Olsa  * @addrs: array for storing resulting addresses
8036bed0d9a5SJiri Olsa  *
8037bed0d9a5SJiri Olsa  * This function looks up addresses for array of symbols provided in
8038bed0d9a5SJiri Olsa  * @syms array (must be alphabetically sorted) and stores them in
8039bed0d9a5SJiri Olsa  * @addrs array, which needs to be big enough to store at least @cnt
8040bed0d9a5SJiri Olsa  * addresses.
8041bed0d9a5SJiri Olsa  *
8042bed0d9a5SJiri Olsa  * This function returns 0 if all provided symbols are found,
8043bed0d9a5SJiri Olsa  * -ESRCH otherwise.
8044bed0d9a5SJiri Olsa  */
8045bed0d9a5SJiri Olsa int ftrace_lookup_symbols(const char **sorted_syms, size_t cnt, unsigned long *addrs)
8046bed0d9a5SJiri Olsa {
8047bed0d9a5SJiri Olsa 	struct kallsyms_data args;
80483640bf85SJiri Olsa 	int found_all;
8049bed0d9a5SJiri Olsa 
8050eb1b2985SJiri Olsa 	memset(addrs, 0, sizeof(*addrs) * cnt);
8051bed0d9a5SJiri Olsa 	args.addrs = addrs;
8052bed0d9a5SJiri Olsa 	args.syms = sorted_syms;
8053bed0d9a5SJiri Olsa 	args.cnt = cnt;
8054bed0d9a5SJiri Olsa 	args.found = 0;
80553640bf85SJiri Olsa 
80563640bf85SJiri Olsa 	found_all = kallsyms_on_each_symbol(kallsyms_callback, &args);
80573640bf85SJiri Olsa 	if (found_all)
80583640bf85SJiri Olsa 		return 0;
805907cc2c93SZhen Lei 	found_all = module_kallsyms_on_each_symbol(NULL, kallsyms_callback, &args);
80603640bf85SJiri Olsa 	return found_all ? 0 : -ESRCH;
8061bed0d9a5SJiri Olsa }
806244d35720SLinus Torvalds 
80635d79fa0dSYueHaibing #ifdef CONFIG_SYSCTL
80648fd7c214SLuis Chamberlain 
80658fd7c214SLuis Chamberlain #ifdef CONFIG_DYNAMIC_FTRACE
8066f8b7d2b4SLuis Chamberlain static void ftrace_startup_sysctl(void)
8067f8b7d2b4SLuis Chamberlain {
8068f8b7d2b4SLuis Chamberlain 	int command;
8069f8b7d2b4SLuis Chamberlain 
8070f8b7d2b4SLuis Chamberlain 	if (unlikely(ftrace_disabled))
8071f8b7d2b4SLuis Chamberlain 		return;
8072f8b7d2b4SLuis Chamberlain 
8073f8b7d2b4SLuis Chamberlain 	/* Force update next time */
8074f8b7d2b4SLuis Chamberlain 	saved_ftrace_func = NULL;
8075f8b7d2b4SLuis Chamberlain 	/* ftrace_start_up is true if we want ftrace running */
8076f8b7d2b4SLuis Chamberlain 	if (ftrace_start_up) {
8077f8b7d2b4SLuis Chamberlain 		command = FTRACE_UPDATE_CALLS;
8078f8b7d2b4SLuis Chamberlain 		if (ftrace_graph_active)
8079f8b7d2b4SLuis Chamberlain 			command |= FTRACE_START_FUNC_RET;
8080f8b7d2b4SLuis Chamberlain 		ftrace_startup_enable(command);
8081f8b7d2b4SLuis Chamberlain 	}
8082f8b7d2b4SLuis Chamberlain }
8083f8b7d2b4SLuis Chamberlain 
8084f8b7d2b4SLuis Chamberlain static void ftrace_shutdown_sysctl(void)
8085f8b7d2b4SLuis Chamberlain {
8086f8b7d2b4SLuis Chamberlain 	int command;
8087f8b7d2b4SLuis Chamberlain 
8088f8b7d2b4SLuis Chamberlain 	if (unlikely(ftrace_disabled))
8089f8b7d2b4SLuis Chamberlain 		return;
8090f8b7d2b4SLuis Chamberlain 
8091f8b7d2b4SLuis Chamberlain 	/* ftrace_start_up is true if ftrace is running */
8092f8b7d2b4SLuis Chamberlain 	if (ftrace_start_up) {
8093f8b7d2b4SLuis Chamberlain 		command = FTRACE_DISABLE_CALLS;
8094f8b7d2b4SLuis Chamberlain 		if (ftrace_graph_active)
8095f8b7d2b4SLuis Chamberlain 			command |= FTRACE_STOP_FUNC_RET;
8096f8b7d2b4SLuis Chamberlain 		ftrace_run_update_code(command);
8097f8b7d2b4SLuis Chamberlain 	}
8098f8b7d2b4SLuis Chamberlain }
80998fd7c214SLuis Chamberlain #else
81008fd7c214SLuis Chamberlain # define ftrace_startup_sysctl()       do { } while (0)
81018fd7c214SLuis Chamberlain # define ftrace_shutdown_sysctl()      do { } while (0)
81028fd7c214SLuis Chamberlain #endif /* CONFIG_DYNAMIC_FTRACE */
8103f8b7d2b4SLuis Chamberlain 
81047162431dSMiroslav Benes static bool is_permanent_ops_registered(void)
81057162431dSMiroslav Benes {
81067162431dSMiroslav Benes 	struct ftrace_ops *op;
81077162431dSMiroslav Benes 
81087162431dSMiroslav Benes 	do_for_each_ftrace_op(op, ftrace_ops_list) {
81097162431dSMiroslav Benes 		if (op->flags & FTRACE_OPS_FL_PERMANENT)
81107162431dSMiroslav Benes 			return true;
81117162431dSMiroslav Benes 	} while_for_each_ftrace_op(op);
81127162431dSMiroslav Benes 
81137162431dSMiroslav Benes 	return false;
81147162431dSMiroslav Benes }
81157162431dSMiroslav Benes 
81168e4e83b2SWei Xiao static int
8117b0fc494fSSteven Rostedt ftrace_enable_sysctl(struct ctl_table *table, int write,
811854fa9ba5STobias Klauser 		     void *buffer, size_t *lenp, loff_t *ppos)
8119b0fc494fSSteven Rostedt {
812045a4a237SSteven Rostedt 	int ret = -ENODEV;
81214eebcc81SSteven Rostedt 
8122e6ea44e9SSteven Rostedt 	mutex_lock(&ftrace_lock);
8123b0fc494fSSteven Rostedt 
812445a4a237SSteven Rostedt 	if (unlikely(ftrace_disabled))
812545a4a237SSteven Rostedt 		goto out;
812645a4a237SSteven Rostedt 
81278d65af78SAlexey Dobriyan 	ret = proc_dointvec(table, write, buffer, lenp, ppos);
8128b0fc494fSSteven Rostedt 
8129a32c7765SLi Zefan 	if (ret || !write || (last_ftrace_enabled == !!ftrace_enabled))
8130b0fc494fSSteven Rostedt 		goto out;
8131b0fc494fSSteven Rostedt 
8132b0fc494fSSteven Rostedt 	if (ftrace_enabled) {
8133b0fc494fSSteven Rostedt 
8134b0fc494fSSteven Rostedt 		/* we are starting ftrace again */
8135f86f4180SChunyan Zhang 		if (rcu_dereference_protected(ftrace_ops_list,
8136f86f4180SChunyan Zhang 			lockdep_is_held(&ftrace_lock)) != &ftrace_list_end)
81375000c418SJan Kiszka 			update_ftrace_function();
8138b0fc494fSSteven Rostedt 
8139524a3868SSteven Rostedt (Red Hat) 		ftrace_startup_sysctl();
8140524a3868SSteven Rostedt (Red Hat) 
8141b0fc494fSSteven Rostedt 	} else {
81427162431dSMiroslav Benes 		if (is_permanent_ops_registered()) {
81437162431dSMiroslav Benes 			ftrace_enabled = true;
81447162431dSMiroslav Benes 			ret = -EBUSY;
81457162431dSMiroslav Benes 			goto out;
81467162431dSMiroslav Benes 		}
81477162431dSMiroslav Benes 
8148b0fc494fSSteven Rostedt 		/* stopping ftrace calls (just send to ftrace_stub) */
8149b0fc494fSSteven Rostedt 		ftrace_trace_function = ftrace_stub;
8150b0fc494fSSteven Rostedt 
8151b0fc494fSSteven Rostedt 		ftrace_shutdown_sysctl();
8152b0fc494fSSteven Rostedt 	}
8153b0fc494fSSteven Rostedt 
81547162431dSMiroslav Benes 	last_ftrace_enabled = !!ftrace_enabled;
8155b0fc494fSSteven Rostedt  out:
8156e6ea44e9SSteven Rostedt 	mutex_unlock(&ftrace_lock);
81573d083395SSteven Rostedt 	return ret;
815816444a8aSArnaldo Carvalho de Melo }
81598e4e83b2SWei Xiao 
81608e4e83b2SWei Xiao static struct ctl_table ftrace_sysctls[] = {
81618e4e83b2SWei Xiao 	{
81628e4e83b2SWei Xiao 		.procname       = "ftrace_enabled",
81638e4e83b2SWei Xiao 		.data           = &ftrace_enabled,
81648e4e83b2SWei Xiao 		.maxlen         = sizeof(int),
81658e4e83b2SWei Xiao 		.mode           = 0644,
81668e4e83b2SWei Xiao 		.proc_handler   = ftrace_enable_sysctl,
81678e4e83b2SWei Xiao 	},
81688e4e83b2SWei Xiao 	{}
81698e4e83b2SWei Xiao };
81708e4e83b2SWei Xiao 
81718e4e83b2SWei Xiao static int __init ftrace_sysctl_init(void)
81728e4e83b2SWei Xiao {
81738e4e83b2SWei Xiao 	register_sysctl_init("kernel", ftrace_sysctls);
81748e4e83b2SWei Xiao 	return 0;
81758e4e83b2SWei Xiao }
81768e4e83b2SWei Xiao late_initcall(ftrace_sysctl_init);
81778e4e83b2SWei Xiao #endif
8178