xref: /linux-6.15/kernel/trace/ftrace.c (revision db6544e0)
116444a8aSArnaldo Carvalho de Melo /*
216444a8aSArnaldo Carvalho de Melo  * Infrastructure for profiling code inserted by 'gcc -pg'.
316444a8aSArnaldo Carvalho de Melo  *
416444a8aSArnaldo Carvalho de Melo  * Copyright (C) 2007-2008 Steven Rostedt <[email protected]>
516444a8aSArnaldo Carvalho de Melo  * Copyright (C) 2004-2008 Ingo Molnar <[email protected]>
616444a8aSArnaldo Carvalho de Melo  *
716444a8aSArnaldo Carvalho de Melo  * Originally ported from the -rt patch by:
816444a8aSArnaldo Carvalho de Melo  *   Copyright (C) 2007 Arnaldo Carvalho de Melo <[email protected]>
916444a8aSArnaldo Carvalho de Melo  *
1016444a8aSArnaldo Carvalho de Melo  * Based on code in the latency_tracer, that is:
1116444a8aSArnaldo Carvalho de Melo  *
1216444a8aSArnaldo Carvalho de Melo  *  Copyright (C) 2004-2006 Ingo Molnar
1316444a8aSArnaldo Carvalho de Melo  *  Copyright (C) 2004 William Lee Irwin III
1416444a8aSArnaldo Carvalho de Melo  */
1516444a8aSArnaldo Carvalho de Melo 
163d083395SSteven Rostedt #include <linux/stop_machine.h>
173d083395SSteven Rostedt #include <linux/clocksource.h>
183d083395SSteven Rostedt #include <linux/kallsyms.h>
195072c59fSSteven Rostedt #include <linux/seq_file.h>
204a2b8ddaSFrederic Weisbecker #include <linux/suspend.h>
215072c59fSSteven Rostedt #include <linux/debugfs.h>
223d083395SSteven Rostedt #include <linux/hardirq.h>
232d8b820bSIngo Molnar #include <linux/kthread.h>
245072c59fSSteven Rostedt #include <linux/uaccess.h>
255855feadSSteven Rostedt #include <linux/bsearch.h>
2656d82e00SPaul Gortmaker #include <linux/module.h>
272d8b820bSIngo Molnar #include <linux/ftrace.h>
28b0fc494fSSteven Rostedt #include <linux/sysctl.h>
295a0e3ad6STejun Heo #include <linux/slab.h>
305072c59fSSteven Rostedt #include <linux/ctype.h>
3168950619SSteven Rostedt #include <linux/sort.h>
323d083395SSteven Rostedt #include <linux/list.h>
3359df055fSSteven Rostedt #include <linux/hash.h>
343f379b03SPaul E. McKenney #include <linux/rcupdate.h>
3516444a8aSArnaldo Carvalho de Melo 
36ad8d75ffSSteven Rostedt #include <trace/events/sched.h>
378aef2d28SSteven Rostedt 
382af15d6aSSteven Rostedt #include <asm/setup.h>
39395a59d0SAbhishek Sagar 
400706f1c4SSteven Rostedt #include "trace_output.h"
41bac429f0SSteven Rostedt #include "trace_stat.h"
423d083395SSteven Rostedt 
436912896eSSteven Rostedt #define FTRACE_WARN_ON(cond)			\
440778d9adSSteven Rostedt 	({					\
450778d9adSSteven Rostedt 		int ___r = cond;		\
460778d9adSSteven Rostedt 		if (WARN_ON(___r))		\
476912896eSSteven Rostedt 			ftrace_kill();		\
480778d9adSSteven Rostedt 		___r;				\
490778d9adSSteven Rostedt 	})
506912896eSSteven Rostedt 
516912896eSSteven Rostedt #define FTRACE_WARN_ON_ONCE(cond)		\
520778d9adSSteven Rostedt 	({					\
530778d9adSSteven Rostedt 		int ___r = cond;		\
540778d9adSSteven Rostedt 		if (WARN_ON_ONCE(___r))		\
556912896eSSteven Rostedt 			ftrace_kill();		\
560778d9adSSteven Rostedt 		___r;				\
570778d9adSSteven Rostedt 	})
586912896eSSteven Rostedt 
598fc0c701SSteven Rostedt /* hash bits for specific function selection */
608fc0c701SSteven Rostedt #define FTRACE_HASH_BITS 7
618fc0c701SSteven Rostedt #define FTRACE_FUNC_HASHSIZE (1 << FTRACE_HASH_BITS)
6233dc9b12SSteven Rostedt #define FTRACE_HASH_DEFAULT_BITS 10
6333dc9b12SSteven Rostedt #define FTRACE_HASH_MAX_BITS 12
648fc0c701SSteven Rostedt 
65e248491aSJiri Olsa #define FL_GLOBAL_CONTROL_MASK (FTRACE_OPS_FL_GLOBAL | FTRACE_OPS_FL_CONTROL)
66e248491aSJiri Olsa 
674eebcc81SSteven Rostedt /* ftrace_enabled is a method to turn ftrace on or off */
684eebcc81SSteven Rostedt int ftrace_enabled __read_mostly;
69d61f82d0SSteven Rostedt static int last_ftrace_enabled;
70b0fc494fSSteven Rostedt 
7160a7ecf4SSteven Rostedt /* Quick disabling of function tracer. */
7260a7ecf4SSteven Rostedt int function_trace_stop;
7360a7ecf4SSteven Rostedt 
74756d17eeS[email protected] /* List for set_ftrace_pid's pids. */
75756d17eeS[email protected] LIST_HEAD(ftrace_pids);
76756d17eeS[email protected] struct ftrace_pid {
77756d17eeS[email protected] 	struct list_head list;
78756d17eeS[email protected] 	struct pid *pid;
79756d17eeS[email protected] };
80756d17eeS[email protected] 
814eebcc81SSteven Rostedt /*
824eebcc81SSteven Rostedt  * ftrace_disabled is set when an anomaly is discovered.
834eebcc81SSteven Rostedt  * ftrace_disabled is much stronger than ftrace_enabled.
844eebcc81SSteven Rostedt  */
854eebcc81SSteven Rostedt static int ftrace_disabled __read_mostly;
864eebcc81SSteven Rostedt 
8752baf119SSteven Rostedt static DEFINE_MUTEX(ftrace_lock);
88b0fc494fSSteven Rostedt 
89bd38c0e6SPaul McQuade static struct ftrace_ops ftrace_list_end __read_mostly = {
9016444a8aSArnaldo Carvalho de Melo 	.func		= ftrace_stub,
9116444a8aSArnaldo Carvalho de Melo };
9216444a8aSArnaldo Carvalho de Melo 
93b848914cSSteven Rostedt static struct ftrace_ops *ftrace_global_list __read_mostly = &ftrace_list_end;
94e248491aSJiri Olsa static struct ftrace_ops *ftrace_control_list __read_mostly = &ftrace_list_end;
95b848914cSSteven Rostedt static struct ftrace_ops *ftrace_ops_list __read_mostly = &ftrace_list_end;
9616444a8aSArnaldo Carvalho de Melo ftrace_func_t ftrace_trace_function __read_mostly = ftrace_stub;
976331c28cSSteven Rostedt static ftrace_func_t __ftrace_trace_function_delay __read_mostly = ftrace_stub;
9860a7ecf4SSteven Rostedt ftrace_func_t __ftrace_trace_function __read_mostly = ftrace_stub;
99df4fc315SSteven Rostedt ftrace_func_t ftrace_pid_function __read_mostly = ftrace_stub;
1002b499381SSteven Rostedt static struct ftrace_ops global_ops;
101e248491aSJiri Olsa static struct ftrace_ops control_ops;
10216444a8aSArnaldo Carvalho de Melo 
103b848914cSSteven Rostedt static void
104b848914cSSteven Rostedt ftrace_ops_list_func(unsigned long ip, unsigned long parent_ip);
105b848914cSSteven Rostedt 
1063f379b03SPaul E. McKenney /*
107b848914cSSteven Rostedt  * Traverse the ftrace_global_list, invoking all entries.  The reason that we
1083f379b03SPaul E. McKenney  * can use rcu_dereference_raw() is that elements removed from this list
1093f379b03SPaul E. McKenney  * are simply leaked, so there is no need to interact with a grace-period
1103f379b03SPaul E. McKenney  * mechanism.  The rcu_dereference_raw() calls are needed to handle
111b848914cSSteven Rostedt  * concurrent insertions into the ftrace_global_list.
1123f379b03SPaul E. McKenney  *
1133f379b03SPaul E. McKenney  * Silly Alpha and silly pointer-speculation compiler optimizations!
1143f379b03SPaul E. McKenney  */
115b848914cSSteven Rostedt static void ftrace_global_list_func(unsigned long ip,
116b848914cSSteven Rostedt 				    unsigned long parent_ip)
11716444a8aSArnaldo Carvalho de Melo {
118b1cff0adSSteven Rostedt 	struct ftrace_ops *op;
11916444a8aSArnaldo Carvalho de Melo 
120b1cff0adSSteven Rostedt 	if (unlikely(trace_recursion_test(TRACE_GLOBAL_BIT)))
121b1cff0adSSteven Rostedt 		return;
122b1cff0adSSteven Rostedt 
123b1cff0adSSteven Rostedt 	trace_recursion_set(TRACE_GLOBAL_BIT);
124b1cff0adSSteven Rostedt 	op = rcu_dereference_raw(ftrace_global_list); /*see above*/
12516444a8aSArnaldo Carvalho de Melo 	while (op != &ftrace_list_end) {
12616444a8aSArnaldo Carvalho de Melo 		op->func(ip, parent_ip);
1273f379b03SPaul E. McKenney 		op = rcu_dereference_raw(op->next); /*see above*/
12816444a8aSArnaldo Carvalho de Melo 	};
129b1cff0adSSteven Rostedt 	trace_recursion_clear(TRACE_GLOBAL_BIT);
13016444a8aSArnaldo Carvalho de Melo }
13116444a8aSArnaldo Carvalho de Melo 
132df4fc315SSteven Rostedt static void ftrace_pid_func(unsigned long ip, unsigned long parent_ip)
133df4fc315SSteven Rostedt {
1340ef8cde5SSteven Rostedt 	if (!test_tsk_trace_trace(current))
135df4fc315SSteven Rostedt 		return;
136df4fc315SSteven Rostedt 
137df4fc315SSteven Rostedt 	ftrace_pid_function(ip, parent_ip);
138df4fc315SSteven Rostedt }
139df4fc315SSteven Rostedt 
140df4fc315SSteven Rostedt static void set_ftrace_pid_function(ftrace_func_t func)
141df4fc315SSteven Rostedt {
142df4fc315SSteven Rostedt 	/* do not set ftrace_pid_function to itself! */
143df4fc315SSteven Rostedt 	if (func != ftrace_pid_func)
144df4fc315SSteven Rostedt 		ftrace_pid_function = func;
145df4fc315SSteven Rostedt }
146df4fc315SSteven Rostedt 
14716444a8aSArnaldo Carvalho de Melo /**
1483d083395SSteven Rostedt  * clear_ftrace_function - reset the ftrace function
14916444a8aSArnaldo Carvalho de Melo  *
1503d083395SSteven Rostedt  * This NULLs the ftrace function and in essence stops
1513d083395SSteven Rostedt  * tracing.  There may be lag
15216444a8aSArnaldo Carvalho de Melo  */
1533d083395SSteven Rostedt void clear_ftrace_function(void)
15416444a8aSArnaldo Carvalho de Melo {
1553d083395SSteven Rostedt 	ftrace_trace_function = ftrace_stub;
15660a7ecf4SSteven Rostedt 	__ftrace_trace_function = ftrace_stub;
1576331c28cSSteven Rostedt 	__ftrace_trace_function_delay = ftrace_stub;
158df4fc315SSteven Rostedt 	ftrace_pid_function = ftrace_stub;
1593d083395SSteven Rostedt }
16016444a8aSArnaldo Carvalho de Melo 
16160a7ecf4SSteven Rostedt #ifndef CONFIG_HAVE_FUNCTION_TRACE_MCOUNT_TEST
16260a7ecf4SSteven Rostedt /*
16360a7ecf4SSteven Rostedt  * For those archs that do not test ftrace_trace_stop in their
16460a7ecf4SSteven Rostedt  * mcount call site, we need to do it from C.
16560a7ecf4SSteven Rostedt  */
16660a7ecf4SSteven Rostedt static void ftrace_test_stop_func(unsigned long ip, unsigned long parent_ip)
16760a7ecf4SSteven Rostedt {
16860a7ecf4SSteven Rostedt 	if (function_trace_stop)
16960a7ecf4SSteven Rostedt 		return;
17060a7ecf4SSteven Rostedt 
17160a7ecf4SSteven Rostedt 	__ftrace_trace_function(ip, parent_ip);
17260a7ecf4SSteven Rostedt }
17360a7ecf4SSteven Rostedt #endif
17460a7ecf4SSteven Rostedt 
175e248491aSJiri Olsa static void control_ops_disable_all(struct ftrace_ops *ops)
176e248491aSJiri Olsa {
177e248491aSJiri Olsa 	int cpu;
178e248491aSJiri Olsa 
179e248491aSJiri Olsa 	for_each_possible_cpu(cpu)
180e248491aSJiri Olsa 		*per_cpu_ptr(ops->disabled, cpu) = 1;
181e248491aSJiri Olsa }
182e248491aSJiri Olsa 
183e248491aSJiri Olsa static int control_ops_alloc(struct ftrace_ops *ops)
184e248491aSJiri Olsa {
185e248491aSJiri Olsa 	int __percpu *disabled;
186e248491aSJiri Olsa 
187e248491aSJiri Olsa 	disabled = alloc_percpu(int);
188e248491aSJiri Olsa 	if (!disabled)
189e248491aSJiri Olsa 		return -ENOMEM;
190e248491aSJiri Olsa 
191e248491aSJiri Olsa 	ops->disabled = disabled;
192e248491aSJiri Olsa 	control_ops_disable_all(ops);
193e248491aSJiri Olsa 	return 0;
194e248491aSJiri Olsa }
195e248491aSJiri Olsa 
196e248491aSJiri Olsa static void control_ops_free(struct ftrace_ops *ops)
197e248491aSJiri Olsa {
198e248491aSJiri Olsa 	free_percpu(ops->disabled);
199e248491aSJiri Olsa }
200e248491aSJiri Olsa 
2012b499381SSteven Rostedt static void update_global_ops(void)
202491d0dcfSSteven Rostedt {
203491d0dcfSSteven Rostedt 	ftrace_func_t func;
204491d0dcfSSteven Rostedt 
205491d0dcfSSteven Rostedt 	/*
206491d0dcfSSteven Rostedt 	 * If there's only one function registered, then call that
207491d0dcfSSteven Rostedt 	 * function directly. Otherwise, we need to iterate over the
208491d0dcfSSteven Rostedt 	 * registered callers.
209491d0dcfSSteven Rostedt 	 */
210b848914cSSteven Rostedt 	if (ftrace_global_list == &ftrace_list_end ||
211b848914cSSteven Rostedt 	    ftrace_global_list->next == &ftrace_list_end)
212b848914cSSteven Rostedt 		func = ftrace_global_list->func;
213491d0dcfSSteven Rostedt 	else
214b848914cSSteven Rostedt 		func = ftrace_global_list_func;
215491d0dcfSSteven Rostedt 
216491d0dcfSSteven Rostedt 	/* If we filter on pids, update to use the pid function */
217491d0dcfSSteven Rostedt 	if (!list_empty(&ftrace_pids)) {
218491d0dcfSSteven Rostedt 		set_ftrace_pid_function(func);
219491d0dcfSSteven Rostedt 		func = ftrace_pid_func;
220491d0dcfSSteven Rostedt 	}
2212b499381SSteven Rostedt 
2222b499381SSteven Rostedt 	global_ops.func = func;
2232b499381SSteven Rostedt }
2242b499381SSteven Rostedt 
2252b499381SSteven Rostedt static void update_ftrace_function(void)
2262b499381SSteven Rostedt {
2272b499381SSteven Rostedt 	ftrace_func_t func;
2282b499381SSteven Rostedt 
2292b499381SSteven Rostedt 	update_global_ops();
2302b499381SSteven Rostedt 
231cdbe61bfSSteven Rostedt 	/*
232cdbe61bfSSteven Rostedt 	 * If we are at the end of the list and this ops is
233cdbe61bfSSteven Rostedt 	 * not dynamic, then have the mcount trampoline call
234cdbe61bfSSteven Rostedt 	 * the function directly
235cdbe61bfSSteven Rostedt 	 */
236b848914cSSteven Rostedt 	if (ftrace_ops_list == &ftrace_list_end ||
237cdbe61bfSSteven Rostedt 	    (ftrace_ops_list->next == &ftrace_list_end &&
238cdbe61bfSSteven Rostedt 	     !(ftrace_ops_list->flags & FTRACE_OPS_FL_DYNAMIC)))
239b848914cSSteven Rostedt 		func = ftrace_ops_list->func;
240b848914cSSteven Rostedt 	else
241b848914cSSteven Rostedt 		func = ftrace_ops_list_func;
2422b499381SSteven Rostedt 
243491d0dcfSSteven Rostedt #ifdef CONFIG_HAVE_FUNCTION_TRACE_MCOUNT_TEST
244491d0dcfSSteven Rostedt 	ftrace_trace_function = func;
245491d0dcfSSteven Rostedt #else
2466331c28cSSteven Rostedt #ifdef CONFIG_DYNAMIC_FTRACE
2476331c28cSSteven Rostedt 	/* do not update till all functions have been modified */
2486331c28cSSteven Rostedt 	__ftrace_trace_function_delay = func;
2496331c28cSSteven Rostedt #else
250491d0dcfSSteven Rostedt 	__ftrace_trace_function = func;
2516331c28cSSteven Rostedt #endif
252*db6544e0SRajesh Bhagat 	ftrace_trace_function =
253*db6544e0SRajesh Bhagat 		(func == ftrace_stub) ? func : ftrace_test_stop_func;
254491d0dcfSSteven Rostedt #endif
255491d0dcfSSteven Rostedt }
256491d0dcfSSteven Rostedt 
2572b499381SSteven Rostedt static void add_ftrace_ops(struct ftrace_ops **list, struct ftrace_ops *ops)
2583d083395SSteven Rostedt {
2592b499381SSteven Rostedt 	ops->next = *list;
26016444a8aSArnaldo Carvalho de Melo 	/*
261b848914cSSteven Rostedt 	 * We are entering ops into the list but another
26216444a8aSArnaldo Carvalho de Melo 	 * CPU might be walking that list. We need to make sure
26316444a8aSArnaldo Carvalho de Melo 	 * the ops->next pointer is valid before another CPU sees
264b848914cSSteven Rostedt 	 * the ops pointer included into the list.
26516444a8aSArnaldo Carvalho de Melo 	 */
2662b499381SSteven Rostedt 	rcu_assign_pointer(*list, ops);
2672b499381SSteven Rostedt }
2683d083395SSteven Rostedt 
2692b499381SSteven Rostedt static int remove_ftrace_ops(struct ftrace_ops **list, struct ftrace_ops *ops)
2702b499381SSteven Rostedt {
2712b499381SSteven Rostedt 	struct ftrace_ops **p;
2722b499381SSteven Rostedt 
2732b499381SSteven Rostedt 	/*
2742b499381SSteven Rostedt 	 * If we are removing the last function, then simply point
2752b499381SSteven Rostedt 	 * to the ftrace_stub.
2762b499381SSteven Rostedt 	 */
2772b499381SSteven Rostedt 	if (*list == ops && ops->next == &ftrace_list_end) {
2782b499381SSteven Rostedt 		*list = &ftrace_list_end;
2792b499381SSteven Rostedt 		return 0;
2802b499381SSteven Rostedt 	}
2812b499381SSteven Rostedt 
2822b499381SSteven Rostedt 	for (p = list; *p != &ftrace_list_end; p = &(*p)->next)
2832b499381SSteven Rostedt 		if (*p == ops)
2842b499381SSteven Rostedt 			break;
2852b499381SSteven Rostedt 
2862b499381SSteven Rostedt 	if (*p != ops)
2872b499381SSteven Rostedt 		return -1;
2882b499381SSteven Rostedt 
2892b499381SSteven Rostedt 	*p = (*p)->next;
2902b499381SSteven Rostedt 	return 0;
2912b499381SSteven Rostedt }
2922b499381SSteven Rostedt 
293e248491aSJiri Olsa static void add_ftrace_list_ops(struct ftrace_ops **list,
294e248491aSJiri Olsa 				struct ftrace_ops *main_ops,
295e248491aSJiri Olsa 				struct ftrace_ops *ops)
296e248491aSJiri Olsa {
297e248491aSJiri Olsa 	int first = *list == &ftrace_list_end;
298e248491aSJiri Olsa 	add_ftrace_ops(list, ops);
299e248491aSJiri Olsa 	if (first)
300e248491aSJiri Olsa 		add_ftrace_ops(&ftrace_ops_list, main_ops);
301e248491aSJiri Olsa }
302e248491aSJiri Olsa 
303e248491aSJiri Olsa static int remove_ftrace_list_ops(struct ftrace_ops **list,
304e248491aSJiri Olsa 				  struct ftrace_ops *main_ops,
305e248491aSJiri Olsa 				  struct ftrace_ops *ops)
306e248491aSJiri Olsa {
307e248491aSJiri Olsa 	int ret = remove_ftrace_ops(list, ops);
308e248491aSJiri Olsa 	if (!ret && *list == &ftrace_list_end)
309e248491aSJiri Olsa 		ret = remove_ftrace_ops(&ftrace_ops_list, main_ops);
310e248491aSJiri Olsa 	return ret;
311e248491aSJiri Olsa }
312e248491aSJiri Olsa 
3132b499381SSteven Rostedt static int __register_ftrace_function(struct ftrace_ops *ops)
3142b499381SSteven Rostedt {
3152b499381SSteven Rostedt 	if (ftrace_disabled)
3162b499381SSteven Rostedt 		return -ENODEV;
3172b499381SSteven Rostedt 
3182b499381SSteven Rostedt 	if (FTRACE_WARN_ON(ops == &global_ops))
3192b499381SSteven Rostedt 		return -EINVAL;
3202b499381SSteven Rostedt 
321b848914cSSteven Rostedt 	if (WARN_ON(ops->flags & FTRACE_OPS_FL_ENABLED))
322b848914cSSteven Rostedt 		return -EBUSY;
323b848914cSSteven Rostedt 
324e248491aSJiri Olsa 	/* We don't support both control and global flags set. */
325e248491aSJiri Olsa 	if ((ops->flags & FL_GLOBAL_CONTROL_MASK) == FL_GLOBAL_CONTROL_MASK)
326e248491aSJiri Olsa 		return -EINVAL;
327e248491aSJiri Olsa 
328cdbe61bfSSteven Rostedt 	if (!core_kernel_data((unsigned long)ops))
329cdbe61bfSSteven Rostedt 		ops->flags |= FTRACE_OPS_FL_DYNAMIC;
330cdbe61bfSSteven Rostedt 
331b848914cSSteven Rostedt 	if (ops->flags & FTRACE_OPS_FL_GLOBAL) {
332e248491aSJiri Olsa 		add_ftrace_list_ops(&ftrace_global_list, &global_ops, ops);
333b848914cSSteven Rostedt 		ops->flags |= FTRACE_OPS_FL_ENABLED;
334e248491aSJiri Olsa 	} else if (ops->flags & FTRACE_OPS_FL_CONTROL) {
335e248491aSJiri Olsa 		if (control_ops_alloc(ops))
336e248491aSJiri Olsa 			return -ENOMEM;
337e248491aSJiri Olsa 		add_ftrace_list_ops(&ftrace_control_list, &control_ops, ops);
338b848914cSSteven Rostedt 	} else
339b848914cSSteven Rostedt 		add_ftrace_ops(&ftrace_ops_list, ops);
340b848914cSSteven Rostedt 
341491d0dcfSSteven Rostedt 	if (ftrace_enabled)
342491d0dcfSSteven Rostedt 		update_ftrace_function();
3433d083395SSteven Rostedt 
34416444a8aSArnaldo Carvalho de Melo 	return 0;
34516444a8aSArnaldo Carvalho de Melo }
34616444a8aSArnaldo Carvalho de Melo 
347e309b41dSIngo Molnar static int __unregister_ftrace_function(struct ftrace_ops *ops)
34816444a8aSArnaldo Carvalho de Melo {
3492b499381SSteven Rostedt 	int ret;
35016444a8aSArnaldo Carvalho de Melo 
3512b499381SSteven Rostedt 	if (ftrace_disabled)
3522b499381SSteven Rostedt 		return -ENODEV;
35316444a8aSArnaldo Carvalho de Melo 
354b848914cSSteven Rostedt 	if (WARN_ON(!(ops->flags & FTRACE_OPS_FL_ENABLED)))
355b848914cSSteven Rostedt 		return -EBUSY;
356b848914cSSteven Rostedt 
3572b499381SSteven Rostedt 	if (FTRACE_WARN_ON(ops == &global_ops))
3582b499381SSteven Rostedt 		return -EINVAL;
35916444a8aSArnaldo Carvalho de Melo 
360b848914cSSteven Rostedt 	if (ops->flags & FTRACE_OPS_FL_GLOBAL) {
361e248491aSJiri Olsa 		ret = remove_ftrace_list_ops(&ftrace_global_list,
362e248491aSJiri Olsa 					     &global_ops, ops);
363b848914cSSteven Rostedt 		if (!ret)
364b848914cSSteven Rostedt 			ops->flags &= ~FTRACE_OPS_FL_ENABLED;
365e248491aSJiri Olsa 	} else if (ops->flags & FTRACE_OPS_FL_CONTROL) {
366e248491aSJiri Olsa 		ret = remove_ftrace_list_ops(&ftrace_control_list,
367e248491aSJiri Olsa 					     &control_ops, ops);
368e248491aSJiri Olsa 		if (!ret) {
369e248491aSJiri Olsa 			/*
370e248491aSJiri Olsa 			 * The ftrace_ops is now removed from the list,
371e248491aSJiri Olsa 			 * so there'll be no new users. We must ensure
372e248491aSJiri Olsa 			 * all current users are done before we free
373e248491aSJiri Olsa 			 * the control data.
374e248491aSJiri Olsa 			 */
375e248491aSJiri Olsa 			synchronize_sched();
376e248491aSJiri Olsa 			control_ops_free(ops);
377e248491aSJiri Olsa 		}
378b848914cSSteven Rostedt 	} else
379b848914cSSteven Rostedt 		ret = remove_ftrace_ops(&ftrace_ops_list, ops);
380b848914cSSteven Rostedt 
3812b499381SSteven Rostedt 	if (ret < 0)
3822b499381SSteven Rostedt 		return ret;
383b848914cSSteven Rostedt 
384491d0dcfSSteven Rostedt 	if (ftrace_enabled)
385491d0dcfSSteven Rostedt 		update_ftrace_function();
38616444a8aSArnaldo Carvalho de Melo 
387cdbe61bfSSteven Rostedt 	/*
388cdbe61bfSSteven Rostedt 	 * Dynamic ops may be freed, we must make sure that all
389cdbe61bfSSteven Rostedt 	 * callers are done before leaving this function.
390cdbe61bfSSteven Rostedt 	 */
391cdbe61bfSSteven Rostedt 	if (ops->flags & FTRACE_OPS_FL_DYNAMIC)
392cdbe61bfSSteven Rostedt 		synchronize_sched();
393cdbe61bfSSteven Rostedt 
394e6ea44e9SSteven Rostedt 	return 0;
3953d083395SSteven Rostedt }
3963d083395SSteven Rostedt 
397df4fc315SSteven Rostedt static void ftrace_update_pid_func(void)
398df4fc315SSteven Rostedt {
399491d0dcfSSteven Rostedt 	/* Only do something if we are tracing something */
400df4fc315SSteven Rostedt 	if (ftrace_trace_function == ftrace_stub)
40110dd3ebeSKOSAKI Motohiro 		return;
402df4fc315SSteven Rostedt 
403491d0dcfSSteven Rostedt 	update_ftrace_function();
404df4fc315SSteven Rostedt }
405df4fc315SSteven Rostedt 
406493762fcSSteven Rostedt #ifdef CONFIG_FUNCTION_PROFILER
407493762fcSSteven Rostedt struct ftrace_profile {
408493762fcSSteven Rostedt 	struct hlist_node		node;
409493762fcSSteven Rostedt 	unsigned long			ip;
410493762fcSSteven Rostedt 	unsigned long			counter;
4110706f1c4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
4120706f1c4SSteven Rostedt 	unsigned long long		time;
413e330b3bcSChase Douglas 	unsigned long long		time_squared;
4140706f1c4SSteven Rostedt #endif
415493762fcSSteven Rostedt };
416493762fcSSteven Rostedt 
417493762fcSSteven Rostedt struct ftrace_profile_page {
418493762fcSSteven Rostedt 	struct ftrace_profile_page	*next;
419493762fcSSteven Rostedt 	unsigned long			index;
420493762fcSSteven Rostedt 	struct ftrace_profile		records[];
421493762fcSSteven Rostedt };
422493762fcSSteven Rostedt 
423cafb168aSSteven Rostedt struct ftrace_profile_stat {
424cafb168aSSteven Rostedt 	atomic_t			disabled;
425cafb168aSSteven Rostedt 	struct hlist_head		*hash;
426cafb168aSSteven Rostedt 	struct ftrace_profile_page	*pages;
427cafb168aSSteven Rostedt 	struct ftrace_profile_page	*start;
428cafb168aSSteven Rostedt 	struct tracer_stat		stat;
429cafb168aSSteven Rostedt };
430cafb168aSSteven Rostedt 
431493762fcSSteven Rostedt #define PROFILE_RECORDS_SIZE						\
432493762fcSSteven Rostedt 	(PAGE_SIZE - offsetof(struct ftrace_profile_page, records))
433493762fcSSteven Rostedt 
434493762fcSSteven Rostedt #define PROFILES_PER_PAGE					\
435493762fcSSteven Rostedt 	(PROFILE_RECORDS_SIZE / sizeof(struct ftrace_profile))
436493762fcSSteven Rostedt 
437fb9fb015SSteven Rostedt static int ftrace_profile_bits __read_mostly;
438fb9fb015SSteven Rostedt static int ftrace_profile_enabled __read_mostly;
439fb9fb015SSteven Rostedt 
440fb9fb015SSteven Rostedt /* ftrace_profile_lock - synchronize the enable and disable of the profiler */
441493762fcSSteven Rostedt static DEFINE_MUTEX(ftrace_profile_lock);
442493762fcSSteven Rostedt 
443cafb168aSSteven Rostedt static DEFINE_PER_CPU(struct ftrace_profile_stat, ftrace_profile_stats);
444493762fcSSteven Rostedt 
445493762fcSSteven Rostedt #define FTRACE_PROFILE_HASH_SIZE 1024 /* must be power of 2 */
446493762fcSSteven Rostedt 
447493762fcSSteven Rostedt static void *
448493762fcSSteven Rostedt function_stat_next(void *v, int idx)
449493762fcSSteven Rostedt {
450493762fcSSteven Rostedt 	struct ftrace_profile *rec = v;
451493762fcSSteven Rostedt 	struct ftrace_profile_page *pg;
452493762fcSSteven Rostedt 
453493762fcSSteven Rostedt 	pg = (struct ftrace_profile_page *)((unsigned long)rec & PAGE_MASK);
454493762fcSSteven Rostedt 
455493762fcSSteven Rostedt  again:
4560296e425SLi Zefan 	if (idx != 0)
457493762fcSSteven Rostedt 		rec++;
4580296e425SLi Zefan 
459493762fcSSteven Rostedt 	if ((void *)rec >= (void *)&pg->records[pg->index]) {
460493762fcSSteven Rostedt 		pg = pg->next;
461493762fcSSteven Rostedt 		if (!pg)
462493762fcSSteven Rostedt 			return NULL;
463493762fcSSteven Rostedt 		rec = &pg->records[0];
464493762fcSSteven Rostedt 		if (!rec->counter)
465493762fcSSteven Rostedt 			goto again;
466493762fcSSteven Rostedt 	}
467493762fcSSteven Rostedt 
468493762fcSSteven Rostedt 	return rec;
469493762fcSSteven Rostedt }
470493762fcSSteven Rostedt 
471493762fcSSteven Rostedt static void *function_stat_start(struct tracer_stat *trace)
472493762fcSSteven Rostedt {
473cafb168aSSteven Rostedt 	struct ftrace_profile_stat *stat =
474cafb168aSSteven Rostedt 		container_of(trace, struct ftrace_profile_stat, stat);
475cafb168aSSteven Rostedt 
476cafb168aSSteven Rostedt 	if (!stat || !stat->start)
477cafb168aSSteven Rostedt 		return NULL;
478cafb168aSSteven Rostedt 
479cafb168aSSteven Rostedt 	return function_stat_next(&stat->start->records[0], 0);
480493762fcSSteven Rostedt }
481493762fcSSteven Rostedt 
4820706f1c4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
4830706f1c4SSteven Rostedt /* function graph compares on total time */
4840706f1c4SSteven Rostedt static int function_stat_cmp(void *p1, void *p2)
4850706f1c4SSteven Rostedt {
4860706f1c4SSteven Rostedt 	struct ftrace_profile *a = p1;
4870706f1c4SSteven Rostedt 	struct ftrace_profile *b = p2;
4880706f1c4SSteven Rostedt 
4890706f1c4SSteven Rostedt 	if (a->time < b->time)
4900706f1c4SSteven Rostedt 		return -1;
4910706f1c4SSteven Rostedt 	if (a->time > b->time)
4920706f1c4SSteven Rostedt 		return 1;
4930706f1c4SSteven Rostedt 	else
4940706f1c4SSteven Rostedt 		return 0;
4950706f1c4SSteven Rostedt }
4960706f1c4SSteven Rostedt #else
4970706f1c4SSteven Rostedt /* not function graph compares against hits */
498493762fcSSteven Rostedt static int function_stat_cmp(void *p1, void *p2)
499493762fcSSteven Rostedt {
500493762fcSSteven Rostedt 	struct ftrace_profile *a = p1;
501493762fcSSteven Rostedt 	struct ftrace_profile *b = p2;
502493762fcSSteven Rostedt 
503493762fcSSteven Rostedt 	if (a->counter < b->counter)
504493762fcSSteven Rostedt 		return -1;
505493762fcSSteven Rostedt 	if (a->counter > b->counter)
506493762fcSSteven Rostedt 		return 1;
507493762fcSSteven Rostedt 	else
508493762fcSSteven Rostedt 		return 0;
509493762fcSSteven Rostedt }
5100706f1c4SSteven Rostedt #endif
511493762fcSSteven Rostedt 
512493762fcSSteven Rostedt static int function_stat_headers(struct seq_file *m)
513493762fcSSteven Rostedt {
5140706f1c4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
51534886c8bSSteven Rostedt 	seq_printf(m, "  Function                               "
516e330b3bcSChase Douglas 		   "Hit    Time            Avg             s^2\n"
51734886c8bSSteven Rostedt 		      "  --------                               "
518e330b3bcSChase Douglas 		   "---    ----            ---             ---\n");
5190706f1c4SSteven Rostedt #else
520493762fcSSteven Rostedt 	seq_printf(m, "  Function                               Hit\n"
521493762fcSSteven Rostedt 		      "  --------                               ---\n");
5220706f1c4SSteven Rostedt #endif
523493762fcSSteven Rostedt 	return 0;
524493762fcSSteven Rostedt }
525493762fcSSteven Rostedt 
526493762fcSSteven Rostedt static int function_stat_show(struct seq_file *m, void *v)
527493762fcSSteven Rostedt {
528493762fcSSteven Rostedt 	struct ftrace_profile *rec = v;
529493762fcSSteven Rostedt 	char str[KSYM_SYMBOL_LEN];
5303aaba20fSLi Zefan 	int ret = 0;
5310706f1c4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
53234886c8bSSteven Rostedt 	static struct trace_seq s;
53334886c8bSSteven Rostedt 	unsigned long long avg;
534e330b3bcSChase Douglas 	unsigned long long stddev;
5350706f1c4SSteven Rostedt #endif
5363aaba20fSLi Zefan 	mutex_lock(&ftrace_profile_lock);
5373aaba20fSLi Zefan 
5383aaba20fSLi Zefan 	/* we raced with function_profile_reset() */
5393aaba20fSLi Zefan 	if (unlikely(rec->counter == 0)) {
5403aaba20fSLi Zefan 		ret = -EBUSY;
5413aaba20fSLi Zefan 		goto out;
5423aaba20fSLi Zefan 	}
543493762fcSSteven Rostedt 
544493762fcSSteven Rostedt 	kallsyms_lookup(rec->ip, NULL, NULL, NULL, str);
5450706f1c4SSteven Rostedt 	seq_printf(m, "  %-30.30s  %10lu", str, rec->counter);
546493762fcSSteven Rostedt 
5470706f1c4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
5480706f1c4SSteven Rostedt 	seq_printf(m, "    ");
54934886c8bSSteven Rostedt 	avg = rec->time;
55034886c8bSSteven Rostedt 	do_div(avg, rec->counter);
55134886c8bSSteven Rostedt 
552e330b3bcSChase Douglas 	/* Sample standard deviation (s^2) */
553e330b3bcSChase Douglas 	if (rec->counter <= 1)
554e330b3bcSChase Douglas 		stddev = 0;
555e330b3bcSChase Douglas 	else {
556e330b3bcSChase Douglas 		stddev = rec->time_squared - rec->counter * avg * avg;
557e330b3bcSChase Douglas 		/*
558e330b3bcSChase Douglas 		 * Divide only 1000 for ns^2 -> us^2 conversion.
559e330b3bcSChase Douglas 		 * trace_print_graph_duration will divide 1000 again.
560e330b3bcSChase Douglas 		 */
561e330b3bcSChase Douglas 		do_div(stddev, (rec->counter - 1) * 1000);
562e330b3bcSChase Douglas 	}
563e330b3bcSChase Douglas 
56434886c8bSSteven Rostedt 	trace_seq_init(&s);
56534886c8bSSteven Rostedt 	trace_print_graph_duration(rec->time, &s);
56634886c8bSSteven Rostedt 	trace_seq_puts(&s, "    ");
56734886c8bSSteven Rostedt 	trace_print_graph_duration(avg, &s);
568e330b3bcSChase Douglas 	trace_seq_puts(&s, "    ");
569e330b3bcSChase Douglas 	trace_print_graph_duration(stddev, &s);
5700706f1c4SSteven Rostedt 	trace_print_seq(m, &s);
5710706f1c4SSteven Rostedt #endif
5720706f1c4SSteven Rostedt 	seq_putc(m, '\n');
5733aaba20fSLi Zefan out:
5743aaba20fSLi Zefan 	mutex_unlock(&ftrace_profile_lock);
5750706f1c4SSteven Rostedt 
5763aaba20fSLi Zefan 	return ret;
577493762fcSSteven Rostedt }
578493762fcSSteven Rostedt 
579cafb168aSSteven Rostedt static void ftrace_profile_reset(struct ftrace_profile_stat *stat)
580493762fcSSteven Rostedt {
581493762fcSSteven Rostedt 	struct ftrace_profile_page *pg;
582493762fcSSteven Rostedt 
583cafb168aSSteven Rostedt 	pg = stat->pages = stat->start;
584493762fcSSteven Rostedt 
585493762fcSSteven Rostedt 	while (pg) {
586493762fcSSteven Rostedt 		memset(pg->records, 0, PROFILE_RECORDS_SIZE);
587493762fcSSteven Rostedt 		pg->index = 0;
588493762fcSSteven Rostedt 		pg = pg->next;
589493762fcSSteven Rostedt 	}
590493762fcSSteven Rostedt 
591cafb168aSSteven Rostedt 	memset(stat->hash, 0,
592493762fcSSteven Rostedt 	       FTRACE_PROFILE_HASH_SIZE * sizeof(struct hlist_head));
593493762fcSSteven Rostedt }
594493762fcSSteven Rostedt 
595cafb168aSSteven Rostedt int ftrace_profile_pages_init(struct ftrace_profile_stat *stat)
596493762fcSSteven Rostedt {
597493762fcSSteven Rostedt 	struct ftrace_profile_page *pg;
598318e0a73SSteven Rostedt 	int functions;
599318e0a73SSteven Rostedt 	int pages;
600493762fcSSteven Rostedt 	int i;
601493762fcSSteven Rostedt 
602493762fcSSteven Rostedt 	/* If we already allocated, do nothing */
603cafb168aSSteven Rostedt 	if (stat->pages)
604493762fcSSteven Rostedt 		return 0;
605493762fcSSteven Rostedt 
606cafb168aSSteven Rostedt 	stat->pages = (void *)get_zeroed_page(GFP_KERNEL);
607cafb168aSSteven Rostedt 	if (!stat->pages)
608493762fcSSteven Rostedt 		return -ENOMEM;
609493762fcSSteven Rostedt 
610318e0a73SSteven Rostedt #ifdef CONFIG_DYNAMIC_FTRACE
611318e0a73SSteven Rostedt 	functions = ftrace_update_tot_cnt;
612318e0a73SSteven Rostedt #else
613318e0a73SSteven Rostedt 	/*
614318e0a73SSteven Rostedt 	 * We do not know the number of functions that exist because
615318e0a73SSteven Rostedt 	 * dynamic tracing is what counts them. With past experience
616318e0a73SSteven Rostedt 	 * we have around 20K functions. That should be more than enough.
617318e0a73SSteven Rostedt 	 * It is highly unlikely we will execute every function in
618318e0a73SSteven Rostedt 	 * the kernel.
619318e0a73SSteven Rostedt 	 */
620318e0a73SSteven Rostedt 	functions = 20000;
621318e0a73SSteven Rostedt #endif
622318e0a73SSteven Rostedt 
623cafb168aSSteven Rostedt 	pg = stat->start = stat->pages;
624493762fcSSteven Rostedt 
625318e0a73SSteven Rostedt 	pages = DIV_ROUND_UP(functions, PROFILES_PER_PAGE);
626318e0a73SSteven Rostedt 
627318e0a73SSteven Rostedt 	for (i = 0; i < pages; i++) {
628493762fcSSteven Rostedt 		pg->next = (void *)get_zeroed_page(GFP_KERNEL);
629493762fcSSteven Rostedt 		if (!pg->next)
630318e0a73SSteven Rostedt 			goto out_free;
631493762fcSSteven Rostedt 		pg = pg->next;
632493762fcSSteven Rostedt 	}
633493762fcSSteven Rostedt 
634493762fcSSteven Rostedt 	return 0;
635318e0a73SSteven Rostedt 
636318e0a73SSteven Rostedt  out_free:
637318e0a73SSteven Rostedt 	pg = stat->start;
638318e0a73SSteven Rostedt 	while (pg) {
639318e0a73SSteven Rostedt 		unsigned long tmp = (unsigned long)pg;
640318e0a73SSteven Rostedt 
641318e0a73SSteven Rostedt 		pg = pg->next;
642318e0a73SSteven Rostedt 		free_page(tmp);
643318e0a73SSteven Rostedt 	}
644318e0a73SSteven Rostedt 
645318e0a73SSteven Rostedt 	free_page((unsigned long)stat->pages);
646318e0a73SSteven Rostedt 	stat->pages = NULL;
647318e0a73SSteven Rostedt 	stat->start = NULL;
648318e0a73SSteven Rostedt 
649318e0a73SSteven Rostedt 	return -ENOMEM;
650493762fcSSteven Rostedt }
651493762fcSSteven Rostedt 
652cafb168aSSteven Rostedt static int ftrace_profile_init_cpu(int cpu)
653493762fcSSteven Rostedt {
654cafb168aSSteven Rostedt 	struct ftrace_profile_stat *stat;
655493762fcSSteven Rostedt 	int size;
656493762fcSSteven Rostedt 
657cafb168aSSteven Rostedt 	stat = &per_cpu(ftrace_profile_stats, cpu);
658cafb168aSSteven Rostedt 
659cafb168aSSteven Rostedt 	if (stat->hash) {
660493762fcSSteven Rostedt 		/* If the profile is already created, simply reset it */
661cafb168aSSteven Rostedt 		ftrace_profile_reset(stat);
662493762fcSSteven Rostedt 		return 0;
663493762fcSSteven Rostedt 	}
664493762fcSSteven Rostedt 
665493762fcSSteven Rostedt 	/*
666493762fcSSteven Rostedt 	 * We are profiling all functions, but usually only a few thousand
667493762fcSSteven Rostedt 	 * functions are hit. We'll make a hash of 1024 items.
668493762fcSSteven Rostedt 	 */
669493762fcSSteven Rostedt 	size = FTRACE_PROFILE_HASH_SIZE;
670493762fcSSteven Rostedt 
671cafb168aSSteven Rostedt 	stat->hash = kzalloc(sizeof(struct hlist_head) * size, GFP_KERNEL);
672493762fcSSteven Rostedt 
673cafb168aSSteven Rostedt 	if (!stat->hash)
674493762fcSSteven Rostedt 		return -ENOMEM;
675493762fcSSteven Rostedt 
676cafb168aSSteven Rostedt 	if (!ftrace_profile_bits) {
677493762fcSSteven Rostedt 		size--;
678493762fcSSteven Rostedt 
679493762fcSSteven Rostedt 		for (; size; size >>= 1)
680493762fcSSteven Rostedt 			ftrace_profile_bits++;
681cafb168aSSteven Rostedt 	}
682493762fcSSteven Rostedt 
683318e0a73SSteven Rostedt 	/* Preallocate the function profiling pages */
684cafb168aSSteven Rostedt 	if (ftrace_profile_pages_init(stat) < 0) {
685cafb168aSSteven Rostedt 		kfree(stat->hash);
686cafb168aSSteven Rostedt 		stat->hash = NULL;
687493762fcSSteven Rostedt 		return -ENOMEM;
688493762fcSSteven Rostedt 	}
689493762fcSSteven Rostedt 
690493762fcSSteven Rostedt 	return 0;
691493762fcSSteven Rostedt }
692493762fcSSteven Rostedt 
693cafb168aSSteven Rostedt static int ftrace_profile_init(void)
694cafb168aSSteven Rostedt {
695cafb168aSSteven Rostedt 	int cpu;
696cafb168aSSteven Rostedt 	int ret = 0;
697cafb168aSSteven Rostedt 
698cafb168aSSteven Rostedt 	for_each_online_cpu(cpu) {
699cafb168aSSteven Rostedt 		ret = ftrace_profile_init_cpu(cpu);
700cafb168aSSteven Rostedt 		if (ret)
701cafb168aSSteven Rostedt 			break;
702cafb168aSSteven Rostedt 	}
703cafb168aSSteven Rostedt 
704cafb168aSSteven Rostedt 	return ret;
705cafb168aSSteven Rostedt }
706cafb168aSSteven Rostedt 
707493762fcSSteven Rostedt /* interrupts must be disabled */
708cafb168aSSteven Rostedt static struct ftrace_profile *
709cafb168aSSteven Rostedt ftrace_find_profiled_func(struct ftrace_profile_stat *stat, unsigned long ip)
710493762fcSSteven Rostedt {
711493762fcSSteven Rostedt 	struct ftrace_profile *rec;
712493762fcSSteven Rostedt 	struct hlist_head *hhd;
713493762fcSSteven Rostedt 	struct hlist_node *n;
714493762fcSSteven Rostedt 	unsigned long key;
715493762fcSSteven Rostedt 
716493762fcSSteven Rostedt 	key = hash_long(ip, ftrace_profile_bits);
717cafb168aSSteven Rostedt 	hhd = &stat->hash[key];
718493762fcSSteven Rostedt 
719493762fcSSteven Rostedt 	if (hlist_empty(hhd))
720493762fcSSteven Rostedt 		return NULL;
721493762fcSSteven Rostedt 
722493762fcSSteven Rostedt 	hlist_for_each_entry_rcu(rec, n, hhd, node) {
723493762fcSSteven Rostedt 		if (rec->ip == ip)
724493762fcSSteven Rostedt 			return rec;
725493762fcSSteven Rostedt 	}
726493762fcSSteven Rostedt 
727493762fcSSteven Rostedt 	return NULL;
728493762fcSSteven Rostedt }
729493762fcSSteven Rostedt 
730cafb168aSSteven Rostedt static void ftrace_add_profile(struct ftrace_profile_stat *stat,
731cafb168aSSteven Rostedt 			       struct ftrace_profile *rec)
732493762fcSSteven Rostedt {
733493762fcSSteven Rostedt 	unsigned long key;
734493762fcSSteven Rostedt 
735493762fcSSteven Rostedt 	key = hash_long(rec->ip, ftrace_profile_bits);
736cafb168aSSteven Rostedt 	hlist_add_head_rcu(&rec->node, &stat->hash[key]);
737493762fcSSteven Rostedt }
738493762fcSSteven Rostedt 
739318e0a73SSteven Rostedt /*
740318e0a73SSteven Rostedt  * The memory is already allocated, this simply finds a new record to use.
741318e0a73SSteven Rostedt  */
742493762fcSSteven Rostedt static struct ftrace_profile *
743318e0a73SSteven Rostedt ftrace_profile_alloc(struct ftrace_profile_stat *stat, unsigned long ip)
744493762fcSSteven Rostedt {
745493762fcSSteven Rostedt 	struct ftrace_profile *rec = NULL;
746493762fcSSteven Rostedt 
747318e0a73SSteven Rostedt 	/* prevent recursion (from NMIs) */
748cafb168aSSteven Rostedt 	if (atomic_inc_return(&stat->disabled) != 1)
749493762fcSSteven Rostedt 		goto out;
750493762fcSSteven Rostedt 
751493762fcSSteven Rostedt 	/*
752318e0a73SSteven Rostedt 	 * Try to find the function again since an NMI
753318e0a73SSteven Rostedt 	 * could have added it
754493762fcSSteven Rostedt 	 */
755cafb168aSSteven Rostedt 	rec = ftrace_find_profiled_func(stat, ip);
756493762fcSSteven Rostedt 	if (rec)
757cafb168aSSteven Rostedt 		goto out;
758493762fcSSteven Rostedt 
759cafb168aSSteven Rostedt 	if (stat->pages->index == PROFILES_PER_PAGE) {
760cafb168aSSteven Rostedt 		if (!stat->pages->next)
761cafb168aSSteven Rostedt 			goto out;
762cafb168aSSteven Rostedt 		stat->pages = stat->pages->next;
763493762fcSSteven Rostedt 	}
764493762fcSSteven Rostedt 
765cafb168aSSteven Rostedt 	rec = &stat->pages->records[stat->pages->index++];
766493762fcSSteven Rostedt 	rec->ip = ip;
767cafb168aSSteven Rostedt 	ftrace_add_profile(stat, rec);
768493762fcSSteven Rostedt 
769493762fcSSteven Rostedt  out:
770cafb168aSSteven Rostedt 	atomic_dec(&stat->disabled);
771493762fcSSteven Rostedt 
772493762fcSSteven Rostedt 	return rec;
773493762fcSSteven Rostedt }
774493762fcSSteven Rostedt 
775493762fcSSteven Rostedt static void
776493762fcSSteven Rostedt function_profile_call(unsigned long ip, unsigned long parent_ip)
777493762fcSSteven Rostedt {
778cafb168aSSteven Rostedt 	struct ftrace_profile_stat *stat;
779493762fcSSteven Rostedt 	struct ftrace_profile *rec;
780493762fcSSteven Rostedt 	unsigned long flags;
781493762fcSSteven Rostedt 
782493762fcSSteven Rostedt 	if (!ftrace_profile_enabled)
783493762fcSSteven Rostedt 		return;
784493762fcSSteven Rostedt 
785493762fcSSteven Rostedt 	local_irq_save(flags);
786cafb168aSSteven Rostedt 
787cafb168aSSteven Rostedt 	stat = &__get_cpu_var(ftrace_profile_stats);
7880f6ce3deSSteven Rostedt 	if (!stat->hash || !ftrace_profile_enabled)
789cafb168aSSteven Rostedt 		goto out;
790cafb168aSSteven Rostedt 
791cafb168aSSteven Rostedt 	rec = ftrace_find_profiled_func(stat, ip);
792493762fcSSteven Rostedt 	if (!rec) {
793318e0a73SSteven Rostedt 		rec = ftrace_profile_alloc(stat, ip);
794493762fcSSteven Rostedt 		if (!rec)
795493762fcSSteven Rostedt 			goto out;
796493762fcSSteven Rostedt 	}
797493762fcSSteven Rostedt 
798493762fcSSteven Rostedt 	rec->counter++;
799493762fcSSteven Rostedt  out:
800493762fcSSteven Rostedt 	local_irq_restore(flags);
801493762fcSSteven Rostedt }
802493762fcSSteven Rostedt 
8030706f1c4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
8040706f1c4SSteven Rostedt static int profile_graph_entry(struct ftrace_graph_ent *trace)
8050706f1c4SSteven Rostedt {
8060706f1c4SSteven Rostedt 	function_profile_call(trace->func, 0);
8070706f1c4SSteven Rostedt 	return 1;
8080706f1c4SSteven Rostedt }
8090706f1c4SSteven Rostedt 
8100706f1c4SSteven Rostedt static void profile_graph_return(struct ftrace_graph_ret *trace)
8110706f1c4SSteven Rostedt {
812cafb168aSSteven Rostedt 	struct ftrace_profile_stat *stat;
813a2a16d6aSSteven Rostedt 	unsigned long long calltime;
8140706f1c4SSteven Rostedt 	struct ftrace_profile *rec;
815cafb168aSSteven Rostedt 	unsigned long flags;
8160706f1c4SSteven Rostedt 
8170706f1c4SSteven Rostedt 	local_irq_save(flags);
818cafb168aSSteven Rostedt 	stat = &__get_cpu_var(ftrace_profile_stats);
8190f6ce3deSSteven Rostedt 	if (!stat->hash || !ftrace_profile_enabled)
820cafb168aSSteven Rostedt 		goto out;
821cafb168aSSteven Rostedt 
82237e44bc5SSteven Rostedt 	/* If the calltime was zero'd ignore it */
82337e44bc5SSteven Rostedt 	if (!trace->calltime)
82437e44bc5SSteven Rostedt 		goto out;
82537e44bc5SSteven Rostedt 
826a2a16d6aSSteven Rostedt 	calltime = trace->rettime - trace->calltime;
827a2a16d6aSSteven Rostedt 
828a2a16d6aSSteven Rostedt 	if (!(trace_flags & TRACE_ITER_GRAPH_TIME)) {
829a2a16d6aSSteven Rostedt 		int index;
830a2a16d6aSSteven Rostedt 
831a2a16d6aSSteven Rostedt 		index = trace->depth;
832a2a16d6aSSteven Rostedt 
833a2a16d6aSSteven Rostedt 		/* Append this call time to the parent time to subtract */
834a2a16d6aSSteven Rostedt 		if (index)
835a2a16d6aSSteven Rostedt 			current->ret_stack[index - 1].subtime += calltime;
836a2a16d6aSSteven Rostedt 
837a2a16d6aSSteven Rostedt 		if (current->ret_stack[index].subtime < calltime)
838a2a16d6aSSteven Rostedt 			calltime -= current->ret_stack[index].subtime;
839a2a16d6aSSteven Rostedt 		else
840a2a16d6aSSteven Rostedt 			calltime = 0;
841a2a16d6aSSteven Rostedt 	}
842a2a16d6aSSteven Rostedt 
843cafb168aSSteven Rostedt 	rec = ftrace_find_profiled_func(stat, trace->func);
844e330b3bcSChase Douglas 	if (rec) {
845a2a16d6aSSteven Rostedt 		rec->time += calltime;
846e330b3bcSChase Douglas 		rec->time_squared += calltime * calltime;
847e330b3bcSChase Douglas 	}
848a2a16d6aSSteven Rostedt 
849cafb168aSSteven Rostedt  out:
8500706f1c4SSteven Rostedt 	local_irq_restore(flags);
8510706f1c4SSteven Rostedt }
8520706f1c4SSteven Rostedt 
8530706f1c4SSteven Rostedt static int register_ftrace_profiler(void)
8540706f1c4SSteven Rostedt {
8550706f1c4SSteven Rostedt 	return register_ftrace_graph(&profile_graph_return,
8560706f1c4SSteven Rostedt 				     &profile_graph_entry);
8570706f1c4SSteven Rostedt }
8580706f1c4SSteven Rostedt 
8590706f1c4SSteven Rostedt static void unregister_ftrace_profiler(void)
8600706f1c4SSteven Rostedt {
8610706f1c4SSteven Rostedt 	unregister_ftrace_graph();
8620706f1c4SSteven Rostedt }
8630706f1c4SSteven Rostedt #else
864bd38c0e6SPaul McQuade static struct ftrace_ops ftrace_profile_ops __read_mostly = {
865493762fcSSteven Rostedt 	.func		= function_profile_call,
866493762fcSSteven Rostedt };
867493762fcSSteven Rostedt 
8680706f1c4SSteven Rostedt static int register_ftrace_profiler(void)
8690706f1c4SSteven Rostedt {
8700706f1c4SSteven Rostedt 	return register_ftrace_function(&ftrace_profile_ops);
8710706f1c4SSteven Rostedt }
8720706f1c4SSteven Rostedt 
8730706f1c4SSteven Rostedt static void unregister_ftrace_profiler(void)
8740706f1c4SSteven Rostedt {
8750706f1c4SSteven Rostedt 	unregister_ftrace_function(&ftrace_profile_ops);
8760706f1c4SSteven Rostedt }
8770706f1c4SSteven Rostedt #endif /* CONFIG_FUNCTION_GRAPH_TRACER */
8780706f1c4SSteven Rostedt 
879493762fcSSteven Rostedt static ssize_t
880493762fcSSteven Rostedt ftrace_profile_write(struct file *filp, const char __user *ubuf,
881493762fcSSteven Rostedt 		     size_t cnt, loff_t *ppos)
882493762fcSSteven Rostedt {
883493762fcSSteven Rostedt 	unsigned long val;
884493762fcSSteven Rostedt 	int ret;
885493762fcSSteven Rostedt 
88622fe9b54SPeter Huewe 	ret = kstrtoul_from_user(ubuf, cnt, 10, &val);
88722fe9b54SPeter Huewe 	if (ret)
888493762fcSSteven Rostedt 		return ret;
889493762fcSSteven Rostedt 
890493762fcSSteven Rostedt 	val = !!val;
891493762fcSSteven Rostedt 
892493762fcSSteven Rostedt 	mutex_lock(&ftrace_profile_lock);
893493762fcSSteven Rostedt 	if (ftrace_profile_enabled ^ val) {
894493762fcSSteven Rostedt 		if (val) {
895493762fcSSteven Rostedt 			ret = ftrace_profile_init();
896493762fcSSteven Rostedt 			if (ret < 0) {
897493762fcSSteven Rostedt 				cnt = ret;
898493762fcSSteven Rostedt 				goto out;
899493762fcSSteven Rostedt 			}
900493762fcSSteven Rostedt 
9010706f1c4SSteven Rostedt 			ret = register_ftrace_profiler();
9020706f1c4SSteven Rostedt 			if (ret < 0) {
9030706f1c4SSteven Rostedt 				cnt = ret;
9040706f1c4SSteven Rostedt 				goto out;
9050706f1c4SSteven Rostedt 			}
906493762fcSSteven Rostedt 			ftrace_profile_enabled = 1;
907493762fcSSteven Rostedt 		} else {
908493762fcSSteven Rostedt 			ftrace_profile_enabled = 0;
9090f6ce3deSSteven Rostedt 			/*
9100f6ce3deSSteven Rostedt 			 * unregister_ftrace_profiler calls stop_machine
9110f6ce3deSSteven Rostedt 			 * so this acts like an synchronize_sched.
9120f6ce3deSSteven Rostedt 			 */
9130706f1c4SSteven Rostedt 			unregister_ftrace_profiler();
914493762fcSSteven Rostedt 		}
915493762fcSSteven Rostedt 	}
916493762fcSSteven Rostedt  out:
917493762fcSSteven Rostedt 	mutex_unlock(&ftrace_profile_lock);
918493762fcSSteven Rostedt 
919cf8517cfSJiri Olsa 	*ppos += cnt;
920493762fcSSteven Rostedt 
921493762fcSSteven Rostedt 	return cnt;
922493762fcSSteven Rostedt }
923493762fcSSteven Rostedt 
924493762fcSSteven Rostedt static ssize_t
925493762fcSSteven Rostedt ftrace_profile_read(struct file *filp, char __user *ubuf,
926493762fcSSteven Rostedt 		     size_t cnt, loff_t *ppos)
927493762fcSSteven Rostedt {
928fb9fb015SSteven Rostedt 	char buf[64];		/* big enough to hold a number */
929493762fcSSteven Rostedt 	int r;
930493762fcSSteven Rostedt 
931493762fcSSteven Rostedt 	r = sprintf(buf, "%u\n", ftrace_profile_enabled);
932493762fcSSteven Rostedt 	return simple_read_from_buffer(ubuf, cnt, ppos, buf, r);
933493762fcSSteven Rostedt }
934493762fcSSteven Rostedt 
935493762fcSSteven Rostedt static const struct file_operations ftrace_profile_fops = {
936493762fcSSteven Rostedt 	.open		= tracing_open_generic,
937493762fcSSteven Rostedt 	.read		= ftrace_profile_read,
938493762fcSSteven Rostedt 	.write		= ftrace_profile_write,
9396038f373SArnd Bergmann 	.llseek		= default_llseek,
940493762fcSSteven Rostedt };
941493762fcSSteven Rostedt 
942cafb168aSSteven Rostedt /* used to initialize the real stat files */
943cafb168aSSteven Rostedt static struct tracer_stat function_stats __initdata = {
944cafb168aSSteven Rostedt 	.name		= "functions",
945cafb168aSSteven Rostedt 	.stat_start	= function_stat_start,
946cafb168aSSteven Rostedt 	.stat_next	= function_stat_next,
947cafb168aSSteven Rostedt 	.stat_cmp	= function_stat_cmp,
948cafb168aSSteven Rostedt 	.stat_headers	= function_stat_headers,
949cafb168aSSteven Rostedt 	.stat_show	= function_stat_show
950cafb168aSSteven Rostedt };
951cafb168aSSteven Rostedt 
9526ab5d668SSteven Rostedt static __init void ftrace_profile_debugfs(struct dentry *d_tracer)
953493762fcSSteven Rostedt {
954cafb168aSSteven Rostedt 	struct ftrace_profile_stat *stat;
955493762fcSSteven Rostedt 	struct dentry *entry;
956cafb168aSSteven Rostedt 	char *name;
957493762fcSSteven Rostedt 	int ret;
958cafb168aSSteven Rostedt 	int cpu;
959493762fcSSteven Rostedt 
960cafb168aSSteven Rostedt 	for_each_possible_cpu(cpu) {
961cafb168aSSteven Rostedt 		stat = &per_cpu(ftrace_profile_stats, cpu);
962cafb168aSSteven Rostedt 
963cafb168aSSteven Rostedt 		/* allocate enough for function name + cpu number */
964cafb168aSSteven Rostedt 		name = kmalloc(32, GFP_KERNEL);
965cafb168aSSteven Rostedt 		if (!name) {
966cafb168aSSteven Rostedt 			/*
967cafb168aSSteven Rostedt 			 * The files created are permanent, if something happens
968cafb168aSSteven Rostedt 			 * we still do not free memory.
969cafb168aSSteven Rostedt 			 */
970cafb168aSSteven Rostedt 			WARN(1,
971cafb168aSSteven Rostedt 			     "Could not allocate stat file for cpu %d\n",
972cafb168aSSteven Rostedt 			     cpu);
973493762fcSSteven Rostedt 			return;
974493762fcSSteven Rostedt 		}
975cafb168aSSteven Rostedt 		stat->stat = function_stats;
976cafb168aSSteven Rostedt 		snprintf(name, 32, "function%d", cpu);
977cafb168aSSteven Rostedt 		stat->stat.name = name;
978cafb168aSSteven Rostedt 		ret = register_stat_tracer(&stat->stat);
979cafb168aSSteven Rostedt 		if (ret) {
980cafb168aSSteven Rostedt 			WARN(1,
981cafb168aSSteven Rostedt 			     "Could not register function stat for cpu %d\n",
982cafb168aSSteven Rostedt 			     cpu);
983cafb168aSSteven Rostedt 			kfree(name);
984cafb168aSSteven Rostedt 			return;
985cafb168aSSteven Rostedt 		}
986cafb168aSSteven Rostedt 	}
987493762fcSSteven Rostedt 
988493762fcSSteven Rostedt 	entry = debugfs_create_file("function_profile_enabled", 0644,
989493762fcSSteven Rostedt 				    d_tracer, NULL, &ftrace_profile_fops);
990493762fcSSteven Rostedt 	if (!entry)
991493762fcSSteven Rostedt 		pr_warning("Could not create debugfs "
992493762fcSSteven Rostedt 			   "'function_profile_enabled' entry\n");
993493762fcSSteven Rostedt }
994493762fcSSteven Rostedt 
995493762fcSSteven Rostedt #else /* CONFIG_FUNCTION_PROFILER */
9966ab5d668SSteven Rostedt static __init void ftrace_profile_debugfs(struct dentry *d_tracer)
997493762fcSSteven Rostedt {
998493762fcSSteven Rostedt }
999493762fcSSteven Rostedt #endif /* CONFIG_FUNCTION_PROFILER */
1000493762fcSSteven Rostedt 
100173d3fd96SIngo Molnar static struct pid * const ftrace_swapper_pid = &init_struct_pid;
100273d3fd96SIngo Molnar 
10033d083395SSteven Rostedt #ifdef CONFIG_DYNAMIC_FTRACE
100473d3fd96SIngo Molnar 
100599ecdc43SSteven Rostedt #ifndef CONFIG_FTRACE_MCOUNT_RECORD
1006cb7be3b2SSteven Rostedt # error Dynamic ftrace depends on MCOUNT_RECORD
100799ecdc43SSteven Rostedt #endif
100899ecdc43SSteven Rostedt 
10098fc0c701SSteven Rostedt static struct hlist_head ftrace_func_hash[FTRACE_FUNC_HASHSIZE] __read_mostly;
10108fc0c701SSteven Rostedt 
1011b6887d79SSteven Rostedt struct ftrace_func_probe {
10128fc0c701SSteven Rostedt 	struct hlist_node	node;
1013b6887d79SSteven Rostedt 	struct ftrace_probe_ops	*ops;
10148fc0c701SSteven Rostedt 	unsigned long		flags;
10158fc0c701SSteven Rostedt 	unsigned long		ip;
10168fc0c701SSteven Rostedt 	void			*data;
10178fc0c701SSteven Rostedt 	struct rcu_head		rcu;
10188fc0c701SSteven Rostedt };
10198fc0c701SSteven Rostedt 
1020b448c4e3SSteven Rostedt struct ftrace_func_entry {
1021b448c4e3SSteven Rostedt 	struct hlist_node hlist;
1022b448c4e3SSteven Rostedt 	unsigned long ip;
1023b448c4e3SSteven Rostedt };
1024b448c4e3SSteven Rostedt 
1025b448c4e3SSteven Rostedt struct ftrace_hash {
1026b448c4e3SSteven Rostedt 	unsigned long		size_bits;
1027b448c4e3SSteven Rostedt 	struct hlist_head	*buckets;
1028b448c4e3SSteven Rostedt 	unsigned long		count;
102907fd5515SSteven Rostedt 	struct rcu_head		rcu;
1030b448c4e3SSteven Rostedt };
1031b448c4e3SSteven Rostedt 
103233dc9b12SSteven Rostedt /*
103333dc9b12SSteven Rostedt  * We make these constant because no one should touch them,
103433dc9b12SSteven Rostedt  * but they are used as the default "empty hash", to avoid allocating
103533dc9b12SSteven Rostedt  * it all the time. These are in a read only section such that if
103633dc9b12SSteven Rostedt  * anyone does try to modify it, it will cause an exception.
103733dc9b12SSteven Rostedt  */
103833dc9b12SSteven Rostedt static const struct hlist_head empty_buckets[1];
103933dc9b12SSteven Rostedt static const struct ftrace_hash empty_hash = {
104033dc9b12SSteven Rostedt 	.buckets = (struct hlist_head *)empty_buckets,
1041b448c4e3SSteven Rostedt };
104233dc9b12SSteven Rostedt #define EMPTY_HASH	((struct ftrace_hash *)&empty_hash)
10435072c59fSSteven Rostedt 
10442b499381SSteven Rostedt static struct ftrace_ops global_ops = {
1045f45948e8SSteven Rostedt 	.func			= ftrace_stub,
104633dc9b12SSteven Rostedt 	.notrace_hash		= EMPTY_HASH,
104733dc9b12SSteven Rostedt 	.filter_hash		= EMPTY_HASH,
1048f45948e8SSteven Rostedt };
1049f45948e8SSteven Rostedt 
105041c52c0dSSteven Rostedt static DEFINE_MUTEX(ftrace_regex_lock);
10513d083395SSteven Rostedt 
10523c1720f0SSteven Rostedt struct ftrace_page {
10533c1720f0SSteven Rostedt 	struct ftrace_page	*next;
1054a7900875SSteven Rostedt 	struct dyn_ftrace	*records;
1055431aa3fbSSteven Rostedt 	int			index;
1056a7900875SSteven Rostedt 	int			size;
1057aa5e5ceaSDavid Miller };
10583c1720f0SSteven Rostedt 
105985ae32aeSSteven Rostedt static struct ftrace_page *ftrace_new_pgs;
106085ae32aeSSteven Rostedt 
1061a7900875SSteven Rostedt #define ENTRY_SIZE sizeof(struct dyn_ftrace)
1062a7900875SSteven Rostedt #define ENTRIES_PER_PAGE (PAGE_SIZE / ENTRY_SIZE)
10633c1720f0SSteven Rostedt 
10643c1720f0SSteven Rostedt /* estimate from running different kernels */
10653c1720f0SSteven Rostedt #define NR_TO_INIT		10000
10663c1720f0SSteven Rostedt 
10673c1720f0SSteven Rostedt static struct ftrace_page	*ftrace_pages_start;
10683c1720f0SSteven Rostedt static struct ftrace_page	*ftrace_pages;
10693c1720f0SSteven Rostedt 
107006a51d93SSteven Rostedt static bool ftrace_hash_empty(struct ftrace_hash *hash)
107106a51d93SSteven Rostedt {
107206a51d93SSteven Rostedt 	return !hash || !hash->count;
107306a51d93SSteven Rostedt }
107406a51d93SSteven Rostedt 
1075b448c4e3SSteven Rostedt static struct ftrace_func_entry *
1076b448c4e3SSteven Rostedt ftrace_lookup_ip(struct ftrace_hash *hash, unsigned long ip)
1077b448c4e3SSteven Rostedt {
1078b448c4e3SSteven Rostedt 	unsigned long key;
1079b448c4e3SSteven Rostedt 	struct ftrace_func_entry *entry;
1080b448c4e3SSteven Rostedt 	struct hlist_head *hhd;
1081b448c4e3SSteven Rostedt 	struct hlist_node *n;
1082b448c4e3SSteven Rostedt 
108306a51d93SSteven Rostedt 	if (ftrace_hash_empty(hash))
1084b448c4e3SSteven Rostedt 		return NULL;
1085b448c4e3SSteven Rostedt 
1086b448c4e3SSteven Rostedt 	if (hash->size_bits > 0)
1087b448c4e3SSteven Rostedt 		key = hash_long(ip, hash->size_bits);
1088b448c4e3SSteven Rostedt 	else
1089b448c4e3SSteven Rostedt 		key = 0;
1090b448c4e3SSteven Rostedt 
1091b448c4e3SSteven Rostedt 	hhd = &hash->buckets[key];
1092b448c4e3SSteven Rostedt 
1093b448c4e3SSteven Rostedt 	hlist_for_each_entry_rcu(entry, n, hhd, hlist) {
1094b448c4e3SSteven Rostedt 		if (entry->ip == ip)
1095b448c4e3SSteven Rostedt 			return entry;
1096b448c4e3SSteven Rostedt 	}
1097b448c4e3SSteven Rostedt 	return NULL;
1098b448c4e3SSteven Rostedt }
1099b448c4e3SSteven Rostedt 
110033dc9b12SSteven Rostedt static void __add_hash_entry(struct ftrace_hash *hash,
110133dc9b12SSteven Rostedt 			     struct ftrace_func_entry *entry)
110233dc9b12SSteven Rostedt {
110333dc9b12SSteven Rostedt 	struct hlist_head *hhd;
110433dc9b12SSteven Rostedt 	unsigned long key;
110533dc9b12SSteven Rostedt 
110633dc9b12SSteven Rostedt 	if (hash->size_bits)
110733dc9b12SSteven Rostedt 		key = hash_long(entry->ip, hash->size_bits);
110833dc9b12SSteven Rostedt 	else
110933dc9b12SSteven Rostedt 		key = 0;
111033dc9b12SSteven Rostedt 
111133dc9b12SSteven Rostedt 	hhd = &hash->buckets[key];
111233dc9b12SSteven Rostedt 	hlist_add_head(&entry->hlist, hhd);
111333dc9b12SSteven Rostedt 	hash->count++;
111433dc9b12SSteven Rostedt }
111533dc9b12SSteven Rostedt 
1116b448c4e3SSteven Rostedt static int add_hash_entry(struct ftrace_hash *hash, unsigned long ip)
1117b448c4e3SSteven Rostedt {
1118b448c4e3SSteven Rostedt 	struct ftrace_func_entry *entry;
1119b448c4e3SSteven Rostedt 
1120b448c4e3SSteven Rostedt 	entry = kmalloc(sizeof(*entry), GFP_KERNEL);
1121b448c4e3SSteven Rostedt 	if (!entry)
1122b448c4e3SSteven Rostedt 		return -ENOMEM;
1123b448c4e3SSteven Rostedt 
1124b448c4e3SSteven Rostedt 	entry->ip = ip;
112533dc9b12SSteven Rostedt 	__add_hash_entry(hash, entry);
1126b448c4e3SSteven Rostedt 
1127b448c4e3SSteven Rostedt 	return 0;
1128b448c4e3SSteven Rostedt }
1129b448c4e3SSteven Rostedt 
1130b448c4e3SSteven Rostedt static void
113133dc9b12SSteven Rostedt free_hash_entry(struct ftrace_hash *hash,
113233dc9b12SSteven Rostedt 		  struct ftrace_func_entry *entry)
113333dc9b12SSteven Rostedt {
113433dc9b12SSteven Rostedt 	hlist_del(&entry->hlist);
113533dc9b12SSteven Rostedt 	kfree(entry);
113633dc9b12SSteven Rostedt 	hash->count--;
113733dc9b12SSteven Rostedt }
113833dc9b12SSteven Rostedt 
113933dc9b12SSteven Rostedt static void
1140b448c4e3SSteven Rostedt remove_hash_entry(struct ftrace_hash *hash,
1141b448c4e3SSteven Rostedt 		  struct ftrace_func_entry *entry)
1142b448c4e3SSteven Rostedt {
1143b448c4e3SSteven Rostedt 	hlist_del(&entry->hlist);
1144b448c4e3SSteven Rostedt 	hash->count--;
1145b448c4e3SSteven Rostedt }
1146b448c4e3SSteven Rostedt 
1147b448c4e3SSteven Rostedt static void ftrace_hash_clear(struct ftrace_hash *hash)
1148b448c4e3SSteven Rostedt {
1149b448c4e3SSteven Rostedt 	struct hlist_head *hhd;
1150b448c4e3SSteven Rostedt 	struct hlist_node *tp, *tn;
1151b448c4e3SSteven Rostedt 	struct ftrace_func_entry *entry;
1152b448c4e3SSteven Rostedt 	int size = 1 << hash->size_bits;
1153b448c4e3SSteven Rostedt 	int i;
1154b448c4e3SSteven Rostedt 
115533dc9b12SSteven Rostedt 	if (!hash->count)
115633dc9b12SSteven Rostedt 		return;
115733dc9b12SSteven Rostedt 
1158b448c4e3SSteven Rostedt 	for (i = 0; i < size; i++) {
1159b448c4e3SSteven Rostedt 		hhd = &hash->buckets[i];
1160b448c4e3SSteven Rostedt 		hlist_for_each_entry_safe(entry, tp, tn, hhd, hlist)
116133dc9b12SSteven Rostedt 			free_hash_entry(hash, entry);
1162b448c4e3SSteven Rostedt 	}
1163b448c4e3SSteven Rostedt 	FTRACE_WARN_ON(hash->count);
1164b448c4e3SSteven Rostedt }
1165b448c4e3SSteven Rostedt 
116633dc9b12SSteven Rostedt static void free_ftrace_hash(struct ftrace_hash *hash)
116733dc9b12SSteven Rostedt {
116833dc9b12SSteven Rostedt 	if (!hash || hash == EMPTY_HASH)
116933dc9b12SSteven Rostedt 		return;
117033dc9b12SSteven Rostedt 	ftrace_hash_clear(hash);
117133dc9b12SSteven Rostedt 	kfree(hash->buckets);
117233dc9b12SSteven Rostedt 	kfree(hash);
117333dc9b12SSteven Rostedt }
117433dc9b12SSteven Rostedt 
117507fd5515SSteven Rostedt static void __free_ftrace_hash_rcu(struct rcu_head *rcu)
117607fd5515SSteven Rostedt {
117707fd5515SSteven Rostedt 	struct ftrace_hash *hash;
117807fd5515SSteven Rostedt 
117907fd5515SSteven Rostedt 	hash = container_of(rcu, struct ftrace_hash, rcu);
118007fd5515SSteven Rostedt 	free_ftrace_hash(hash);
118107fd5515SSteven Rostedt }
118207fd5515SSteven Rostedt 
118307fd5515SSteven Rostedt static void free_ftrace_hash_rcu(struct ftrace_hash *hash)
118407fd5515SSteven Rostedt {
118507fd5515SSteven Rostedt 	if (!hash || hash == EMPTY_HASH)
118607fd5515SSteven Rostedt 		return;
118707fd5515SSteven Rostedt 	call_rcu_sched(&hash->rcu, __free_ftrace_hash_rcu);
118807fd5515SSteven Rostedt }
118907fd5515SSteven Rostedt 
11905500fa51SJiri Olsa void ftrace_free_filter(struct ftrace_ops *ops)
11915500fa51SJiri Olsa {
11925500fa51SJiri Olsa 	free_ftrace_hash(ops->filter_hash);
11935500fa51SJiri Olsa 	free_ftrace_hash(ops->notrace_hash);
11945500fa51SJiri Olsa }
11955500fa51SJiri Olsa 
119633dc9b12SSteven Rostedt static struct ftrace_hash *alloc_ftrace_hash(int size_bits)
119733dc9b12SSteven Rostedt {
119833dc9b12SSteven Rostedt 	struct ftrace_hash *hash;
119933dc9b12SSteven Rostedt 	int size;
120033dc9b12SSteven Rostedt 
120133dc9b12SSteven Rostedt 	hash = kzalloc(sizeof(*hash), GFP_KERNEL);
120233dc9b12SSteven Rostedt 	if (!hash)
120333dc9b12SSteven Rostedt 		return NULL;
120433dc9b12SSteven Rostedt 
120533dc9b12SSteven Rostedt 	size = 1 << size_bits;
120647b0edcbSThomas Meyer 	hash->buckets = kcalloc(size, sizeof(*hash->buckets), GFP_KERNEL);
120733dc9b12SSteven Rostedt 
120833dc9b12SSteven Rostedt 	if (!hash->buckets) {
120933dc9b12SSteven Rostedt 		kfree(hash);
121033dc9b12SSteven Rostedt 		return NULL;
121133dc9b12SSteven Rostedt 	}
121233dc9b12SSteven Rostedt 
121333dc9b12SSteven Rostedt 	hash->size_bits = size_bits;
121433dc9b12SSteven Rostedt 
121533dc9b12SSteven Rostedt 	return hash;
121633dc9b12SSteven Rostedt }
121733dc9b12SSteven Rostedt 
121833dc9b12SSteven Rostedt static struct ftrace_hash *
121933dc9b12SSteven Rostedt alloc_and_copy_ftrace_hash(int size_bits, struct ftrace_hash *hash)
122033dc9b12SSteven Rostedt {
122133dc9b12SSteven Rostedt 	struct ftrace_func_entry *entry;
122233dc9b12SSteven Rostedt 	struct ftrace_hash *new_hash;
122333dc9b12SSteven Rostedt 	struct hlist_node *tp;
122433dc9b12SSteven Rostedt 	int size;
122533dc9b12SSteven Rostedt 	int ret;
122633dc9b12SSteven Rostedt 	int i;
122733dc9b12SSteven Rostedt 
122833dc9b12SSteven Rostedt 	new_hash = alloc_ftrace_hash(size_bits);
122933dc9b12SSteven Rostedt 	if (!new_hash)
123033dc9b12SSteven Rostedt 		return NULL;
123133dc9b12SSteven Rostedt 
123233dc9b12SSteven Rostedt 	/* Empty hash? */
123306a51d93SSteven Rostedt 	if (ftrace_hash_empty(hash))
123433dc9b12SSteven Rostedt 		return new_hash;
123533dc9b12SSteven Rostedt 
123633dc9b12SSteven Rostedt 	size = 1 << hash->size_bits;
123733dc9b12SSteven Rostedt 	for (i = 0; i < size; i++) {
123833dc9b12SSteven Rostedt 		hlist_for_each_entry(entry, tp, &hash->buckets[i], hlist) {
123933dc9b12SSteven Rostedt 			ret = add_hash_entry(new_hash, entry->ip);
124033dc9b12SSteven Rostedt 			if (ret < 0)
124133dc9b12SSteven Rostedt 				goto free_hash;
124233dc9b12SSteven Rostedt 		}
124333dc9b12SSteven Rostedt 	}
124433dc9b12SSteven Rostedt 
124533dc9b12SSteven Rostedt 	FTRACE_WARN_ON(new_hash->count != hash->count);
124633dc9b12SSteven Rostedt 
124733dc9b12SSteven Rostedt 	return new_hash;
124833dc9b12SSteven Rostedt 
124933dc9b12SSteven Rostedt  free_hash:
125033dc9b12SSteven Rostedt 	free_ftrace_hash(new_hash);
125133dc9b12SSteven Rostedt 	return NULL;
125233dc9b12SSteven Rostedt }
125333dc9b12SSteven Rostedt 
125441fb61c2SSteven Rostedt static void
125541fb61c2SSteven Rostedt ftrace_hash_rec_disable(struct ftrace_ops *ops, int filter_hash);
125641fb61c2SSteven Rostedt static void
125741fb61c2SSteven Rostedt ftrace_hash_rec_enable(struct ftrace_ops *ops, int filter_hash);
125841fb61c2SSteven Rostedt 
125933dc9b12SSteven Rostedt static int
126041fb61c2SSteven Rostedt ftrace_hash_move(struct ftrace_ops *ops, int enable,
126141fb61c2SSteven Rostedt 		 struct ftrace_hash **dst, struct ftrace_hash *src)
126233dc9b12SSteven Rostedt {
126333dc9b12SSteven Rostedt 	struct ftrace_func_entry *entry;
126433dc9b12SSteven Rostedt 	struct hlist_node *tp, *tn;
126533dc9b12SSteven Rostedt 	struct hlist_head *hhd;
126607fd5515SSteven Rostedt 	struct ftrace_hash *old_hash;
126707fd5515SSteven Rostedt 	struct ftrace_hash *new_hash;
126833dc9b12SSteven Rostedt 	unsigned long key;
126933dc9b12SSteven Rostedt 	int size = src->count;
127033dc9b12SSteven Rostedt 	int bits = 0;
127141fb61c2SSteven Rostedt 	int ret;
127233dc9b12SSteven Rostedt 	int i;
127333dc9b12SSteven Rostedt 
127433dc9b12SSteven Rostedt 	/*
127541fb61c2SSteven Rostedt 	 * Remove the current set, update the hash and add
127641fb61c2SSteven Rostedt 	 * them back.
127741fb61c2SSteven Rostedt 	 */
127841fb61c2SSteven Rostedt 	ftrace_hash_rec_disable(ops, enable);
127941fb61c2SSteven Rostedt 
128041fb61c2SSteven Rostedt 	/*
128133dc9b12SSteven Rostedt 	 * If the new source is empty, just free dst and assign it
128233dc9b12SSteven Rostedt 	 * the empty_hash.
128333dc9b12SSteven Rostedt 	 */
128433dc9b12SSteven Rostedt 	if (!src->count) {
128507fd5515SSteven Rostedt 		free_ftrace_hash_rcu(*dst);
128607fd5515SSteven Rostedt 		rcu_assign_pointer(*dst, EMPTY_HASH);
1287d4d34b98SSteven Rostedt 		/* still need to update the function records */
1288d4d34b98SSteven Rostedt 		ret = 0;
1289d4d34b98SSteven Rostedt 		goto out;
129033dc9b12SSteven Rostedt 	}
129133dc9b12SSteven Rostedt 
129233dc9b12SSteven Rostedt 	/*
129333dc9b12SSteven Rostedt 	 * Make the hash size about 1/2 the # found
129433dc9b12SSteven Rostedt 	 */
129533dc9b12SSteven Rostedt 	for (size /= 2; size; size >>= 1)
129633dc9b12SSteven Rostedt 		bits++;
129733dc9b12SSteven Rostedt 
129833dc9b12SSteven Rostedt 	/* Don't allocate too much */
129933dc9b12SSteven Rostedt 	if (bits > FTRACE_HASH_MAX_BITS)
130033dc9b12SSteven Rostedt 		bits = FTRACE_HASH_MAX_BITS;
130133dc9b12SSteven Rostedt 
130241fb61c2SSteven Rostedt 	ret = -ENOMEM;
130307fd5515SSteven Rostedt 	new_hash = alloc_ftrace_hash(bits);
130407fd5515SSteven Rostedt 	if (!new_hash)
130541fb61c2SSteven Rostedt 		goto out;
130633dc9b12SSteven Rostedt 
130733dc9b12SSteven Rostedt 	size = 1 << src->size_bits;
130833dc9b12SSteven Rostedt 	for (i = 0; i < size; i++) {
130933dc9b12SSteven Rostedt 		hhd = &src->buckets[i];
131033dc9b12SSteven Rostedt 		hlist_for_each_entry_safe(entry, tp, tn, hhd, hlist) {
131133dc9b12SSteven Rostedt 			if (bits > 0)
131233dc9b12SSteven Rostedt 				key = hash_long(entry->ip, bits);
131333dc9b12SSteven Rostedt 			else
131433dc9b12SSteven Rostedt 				key = 0;
131533dc9b12SSteven Rostedt 			remove_hash_entry(src, entry);
131607fd5515SSteven Rostedt 			__add_hash_entry(new_hash, entry);
131733dc9b12SSteven Rostedt 		}
131833dc9b12SSteven Rostedt 	}
131933dc9b12SSteven Rostedt 
132007fd5515SSteven Rostedt 	old_hash = *dst;
132107fd5515SSteven Rostedt 	rcu_assign_pointer(*dst, new_hash);
132207fd5515SSteven Rostedt 	free_ftrace_hash_rcu(old_hash);
132307fd5515SSteven Rostedt 
132441fb61c2SSteven Rostedt 	ret = 0;
132541fb61c2SSteven Rostedt  out:
132641fb61c2SSteven Rostedt 	/*
132741fb61c2SSteven Rostedt 	 * Enable regardless of ret:
132841fb61c2SSteven Rostedt 	 *  On success, we enable the new hash.
132941fb61c2SSteven Rostedt 	 *  On failure, we re-enable the original hash.
133041fb61c2SSteven Rostedt 	 */
133141fb61c2SSteven Rostedt 	ftrace_hash_rec_enable(ops, enable);
133241fb61c2SSteven Rostedt 
133341fb61c2SSteven Rostedt 	return ret;
133433dc9b12SSteven Rostedt }
133533dc9b12SSteven Rostedt 
1336265c831cSSteven Rostedt /*
1337b848914cSSteven Rostedt  * Test the hashes for this ops to see if we want to call
1338b848914cSSteven Rostedt  * the ops->func or not.
1339b848914cSSteven Rostedt  *
1340b848914cSSteven Rostedt  * It's a match if the ip is in the ops->filter_hash or
1341b848914cSSteven Rostedt  * the filter_hash does not exist or is empty,
1342b848914cSSteven Rostedt  *  AND
1343b848914cSSteven Rostedt  * the ip is not in the ops->notrace_hash.
1344cdbe61bfSSteven Rostedt  *
1345cdbe61bfSSteven Rostedt  * This needs to be called with preemption disabled as
1346cdbe61bfSSteven Rostedt  * the hashes are freed with call_rcu_sched().
1347b848914cSSteven Rostedt  */
1348b848914cSSteven Rostedt static int
1349b848914cSSteven Rostedt ftrace_ops_test(struct ftrace_ops *ops, unsigned long ip)
1350b848914cSSteven Rostedt {
1351b848914cSSteven Rostedt 	struct ftrace_hash *filter_hash;
1352b848914cSSteven Rostedt 	struct ftrace_hash *notrace_hash;
1353b848914cSSteven Rostedt 	int ret;
1354b848914cSSteven Rostedt 
1355b848914cSSteven Rostedt 	filter_hash = rcu_dereference_raw(ops->filter_hash);
1356b848914cSSteven Rostedt 	notrace_hash = rcu_dereference_raw(ops->notrace_hash);
1357b848914cSSteven Rostedt 
135806a51d93SSteven Rostedt 	if ((ftrace_hash_empty(filter_hash) ||
1359b848914cSSteven Rostedt 	     ftrace_lookup_ip(filter_hash, ip)) &&
136006a51d93SSteven Rostedt 	    (ftrace_hash_empty(notrace_hash) ||
1361b848914cSSteven Rostedt 	     !ftrace_lookup_ip(notrace_hash, ip)))
1362b848914cSSteven Rostedt 		ret = 1;
1363b848914cSSteven Rostedt 	else
1364b848914cSSteven Rostedt 		ret = 0;
1365b848914cSSteven Rostedt 
1366b848914cSSteven Rostedt 	return ret;
1367b848914cSSteven Rostedt }
1368b848914cSSteven Rostedt 
1369b848914cSSteven Rostedt /*
1370265c831cSSteven Rostedt  * This is a double for. Do not use 'break' to break out of the loop,
1371265c831cSSteven Rostedt  * you must use a goto.
1372265c831cSSteven Rostedt  */
1373265c831cSSteven Rostedt #define do_for_each_ftrace_rec(pg, rec)					\
1374265c831cSSteven Rostedt 	for (pg = ftrace_pages_start; pg; pg = pg->next) {		\
1375265c831cSSteven Rostedt 		int _____i;						\
1376265c831cSSteven Rostedt 		for (_____i = 0; _____i < pg->index; _____i++) {	\
1377265c831cSSteven Rostedt 			rec = &pg->records[_____i];
1378265c831cSSteven Rostedt 
1379265c831cSSteven Rostedt #define while_for_each_ftrace_rec()		\
1380265c831cSSteven Rostedt 		}				\
1381265c831cSSteven Rostedt 	}
1382ecea656dSAbhishek Sagar 
13835855feadSSteven Rostedt 
13845855feadSSteven Rostedt static int ftrace_cmp_recs(const void *a, const void *b)
13855855feadSSteven Rostedt {
13865855feadSSteven Rostedt 	const struct dyn_ftrace *reca = a;
13875855feadSSteven Rostedt 	const struct dyn_ftrace *recb = b;
13885855feadSSteven Rostedt 
13895855feadSSteven Rostedt 	if (reca->ip > recb->ip)
13905855feadSSteven Rostedt 		return 1;
13915855feadSSteven Rostedt 	if (reca->ip < recb->ip)
13925855feadSSteven Rostedt 		return -1;
13935855feadSSteven Rostedt 	return 0;
13945855feadSSteven Rostedt }
13955855feadSSteven Rostedt 
1396c88fd863SSteven Rostedt /**
1397c88fd863SSteven Rostedt  * ftrace_location - return true if the ip giving is a traced location
1398c88fd863SSteven Rostedt  * @ip: the instruction pointer to check
1399c88fd863SSteven Rostedt  *
1400c88fd863SSteven Rostedt  * Returns 1 if @ip given is a pointer to a ftrace location.
1401c88fd863SSteven Rostedt  * That is, the instruction that is either a NOP or call to
1402c88fd863SSteven Rostedt  * the function tracer. It checks the ftrace internal tables to
1403c88fd863SSteven Rostedt  * determine if the address belongs or not.
1404c88fd863SSteven Rostedt  */
1405c88fd863SSteven Rostedt int ftrace_location(unsigned long ip)
1406c88fd863SSteven Rostedt {
1407c88fd863SSteven Rostedt 	struct ftrace_page *pg;
1408c88fd863SSteven Rostedt 	struct dyn_ftrace *rec;
14095855feadSSteven Rostedt 	struct dyn_ftrace key;
1410c88fd863SSteven Rostedt 
14115855feadSSteven Rostedt 	key.ip = ip;
14125855feadSSteven Rostedt 
14135855feadSSteven Rostedt 	for (pg = ftrace_pages_start; pg; pg = pg->next) {
14145855feadSSteven Rostedt 		rec = bsearch(&key, pg->records, pg->index,
14155855feadSSteven Rostedt 			      sizeof(struct dyn_ftrace),
14165855feadSSteven Rostedt 			      ftrace_cmp_recs);
14175855feadSSteven Rostedt 		if (rec)
1418c88fd863SSteven Rostedt 			return 1;
14195855feadSSteven Rostedt 	}
1420c88fd863SSteven Rostedt 
1421c88fd863SSteven Rostedt 	return 0;
1422c88fd863SSteven Rostedt }
1423c88fd863SSteven Rostedt 
1424ed926f9bSSteven Rostedt static void __ftrace_hash_rec_update(struct ftrace_ops *ops,
1425ed926f9bSSteven Rostedt 				     int filter_hash,
1426ed926f9bSSteven Rostedt 				     bool inc)
1427ed926f9bSSteven Rostedt {
1428ed926f9bSSteven Rostedt 	struct ftrace_hash *hash;
1429ed926f9bSSteven Rostedt 	struct ftrace_hash *other_hash;
1430ed926f9bSSteven Rostedt 	struct ftrace_page *pg;
1431ed926f9bSSteven Rostedt 	struct dyn_ftrace *rec;
1432ed926f9bSSteven Rostedt 	int count = 0;
1433ed926f9bSSteven Rostedt 	int all = 0;
1434ed926f9bSSteven Rostedt 
1435ed926f9bSSteven Rostedt 	/* Only update if the ops has been registered */
1436ed926f9bSSteven Rostedt 	if (!(ops->flags & FTRACE_OPS_FL_ENABLED))
1437ed926f9bSSteven Rostedt 		return;
1438ed926f9bSSteven Rostedt 
1439ed926f9bSSteven Rostedt 	/*
1440ed926f9bSSteven Rostedt 	 * In the filter_hash case:
1441ed926f9bSSteven Rostedt 	 *   If the count is zero, we update all records.
1442ed926f9bSSteven Rostedt 	 *   Otherwise we just update the items in the hash.
1443ed926f9bSSteven Rostedt 	 *
1444ed926f9bSSteven Rostedt 	 * In the notrace_hash case:
1445ed926f9bSSteven Rostedt 	 *   We enable the update in the hash.
1446ed926f9bSSteven Rostedt 	 *   As disabling notrace means enabling the tracing,
1447ed926f9bSSteven Rostedt 	 *   and enabling notrace means disabling, the inc variable
1448ed926f9bSSteven Rostedt 	 *   gets inversed.
1449ed926f9bSSteven Rostedt 	 */
1450ed926f9bSSteven Rostedt 	if (filter_hash) {
1451ed926f9bSSteven Rostedt 		hash = ops->filter_hash;
1452ed926f9bSSteven Rostedt 		other_hash = ops->notrace_hash;
145306a51d93SSteven Rostedt 		if (ftrace_hash_empty(hash))
1454ed926f9bSSteven Rostedt 			all = 1;
1455ed926f9bSSteven Rostedt 	} else {
1456ed926f9bSSteven Rostedt 		inc = !inc;
1457ed926f9bSSteven Rostedt 		hash = ops->notrace_hash;
1458ed926f9bSSteven Rostedt 		other_hash = ops->filter_hash;
1459ed926f9bSSteven Rostedt 		/*
1460ed926f9bSSteven Rostedt 		 * If the notrace hash has no items,
1461ed926f9bSSteven Rostedt 		 * then there's nothing to do.
1462ed926f9bSSteven Rostedt 		 */
146306a51d93SSteven Rostedt 		if (ftrace_hash_empty(hash))
1464ed926f9bSSteven Rostedt 			return;
1465ed926f9bSSteven Rostedt 	}
1466ed926f9bSSteven Rostedt 
1467ed926f9bSSteven Rostedt 	do_for_each_ftrace_rec(pg, rec) {
1468ed926f9bSSteven Rostedt 		int in_other_hash = 0;
1469ed926f9bSSteven Rostedt 		int in_hash = 0;
1470ed926f9bSSteven Rostedt 		int match = 0;
1471ed926f9bSSteven Rostedt 
1472ed926f9bSSteven Rostedt 		if (all) {
1473ed926f9bSSteven Rostedt 			/*
1474ed926f9bSSteven Rostedt 			 * Only the filter_hash affects all records.
1475ed926f9bSSteven Rostedt 			 * Update if the record is not in the notrace hash.
1476ed926f9bSSteven Rostedt 			 */
1477b848914cSSteven Rostedt 			if (!other_hash || !ftrace_lookup_ip(other_hash, rec->ip))
1478ed926f9bSSteven Rostedt 				match = 1;
1479ed926f9bSSteven Rostedt 		} else {
148006a51d93SSteven Rostedt 			in_hash = !!ftrace_lookup_ip(hash, rec->ip);
148106a51d93SSteven Rostedt 			in_other_hash = !!ftrace_lookup_ip(other_hash, rec->ip);
1482ed926f9bSSteven Rostedt 
1483ed926f9bSSteven Rostedt 			/*
1484ed926f9bSSteven Rostedt 			 *
1485ed926f9bSSteven Rostedt 			 */
1486ed926f9bSSteven Rostedt 			if (filter_hash && in_hash && !in_other_hash)
1487ed926f9bSSteven Rostedt 				match = 1;
1488ed926f9bSSteven Rostedt 			else if (!filter_hash && in_hash &&
148906a51d93SSteven Rostedt 				 (in_other_hash || ftrace_hash_empty(other_hash)))
1490ed926f9bSSteven Rostedt 				match = 1;
1491ed926f9bSSteven Rostedt 		}
1492ed926f9bSSteven Rostedt 		if (!match)
1493ed926f9bSSteven Rostedt 			continue;
1494ed926f9bSSteven Rostedt 
1495ed926f9bSSteven Rostedt 		if (inc) {
1496ed926f9bSSteven Rostedt 			rec->flags++;
1497ed926f9bSSteven Rostedt 			if (FTRACE_WARN_ON((rec->flags & ~FTRACE_FL_MASK) == FTRACE_REF_MAX))
1498ed926f9bSSteven Rostedt 				return;
1499ed926f9bSSteven Rostedt 		} else {
1500ed926f9bSSteven Rostedt 			if (FTRACE_WARN_ON((rec->flags & ~FTRACE_FL_MASK) == 0))
1501ed926f9bSSteven Rostedt 				return;
1502ed926f9bSSteven Rostedt 			rec->flags--;
1503ed926f9bSSteven Rostedt 		}
1504ed926f9bSSteven Rostedt 		count++;
1505ed926f9bSSteven Rostedt 		/* Shortcut, if we handled all records, we are done. */
1506ed926f9bSSteven Rostedt 		if (!all && count == hash->count)
1507ed926f9bSSteven Rostedt 			return;
1508ed926f9bSSteven Rostedt 	} while_for_each_ftrace_rec();
1509ed926f9bSSteven Rostedt }
1510ed926f9bSSteven Rostedt 
1511ed926f9bSSteven Rostedt static void ftrace_hash_rec_disable(struct ftrace_ops *ops,
1512ed926f9bSSteven Rostedt 				    int filter_hash)
1513ed926f9bSSteven Rostedt {
1514ed926f9bSSteven Rostedt 	__ftrace_hash_rec_update(ops, filter_hash, 0);
1515ed926f9bSSteven Rostedt }
1516ed926f9bSSteven Rostedt 
1517ed926f9bSSteven Rostedt static void ftrace_hash_rec_enable(struct ftrace_ops *ops,
1518ed926f9bSSteven Rostedt 				   int filter_hash)
1519ed926f9bSSteven Rostedt {
1520ed926f9bSSteven Rostedt 	__ftrace_hash_rec_update(ops, filter_hash, 1);
1521ed926f9bSSteven Rostedt }
1522ed926f9bSSteven Rostedt 
1523e309b41dSIngo Molnar static struct dyn_ftrace *ftrace_alloc_dyn_node(unsigned long ip)
15243c1720f0SSteven Rostedt {
1525a7900875SSteven Rostedt 	if (ftrace_pages->index == ftrace_pages->size) {
1526a7900875SSteven Rostedt 		/* We should have allocated enough */
1527a7900875SSteven Rostedt 		if (WARN_ON(!ftrace_pages->next))
15283c1720f0SSteven Rostedt 			return NULL;
15293c1720f0SSteven Rostedt 		ftrace_pages = ftrace_pages->next;
15303c1720f0SSteven Rostedt 	}
15313c1720f0SSteven Rostedt 
15323c1720f0SSteven Rostedt 	return &ftrace_pages->records[ftrace_pages->index++];
15333c1720f0SSteven Rostedt }
15343c1720f0SSteven Rostedt 
153508f5ac90SSteven Rostedt static struct dyn_ftrace *
1536d61f82d0SSteven Rostedt ftrace_record_ip(unsigned long ip)
15373d083395SSteven Rostedt {
153808f5ac90SSteven Rostedt 	struct dyn_ftrace *rec;
15393d083395SSteven Rostedt 
1540f3c7ac40SSteven Rostedt 	if (ftrace_disabled)
154108f5ac90SSteven Rostedt 		return NULL;
1542d61f82d0SSteven Rostedt 
154308f5ac90SSteven Rostedt 	rec = ftrace_alloc_dyn_node(ip);
154408f5ac90SSteven Rostedt 	if (!rec)
154508f5ac90SSteven Rostedt 		return NULL;
15463d083395SSteven Rostedt 
154708f5ac90SSteven Rostedt 	rec->ip = ip;
15483d083395SSteven Rostedt 
154908f5ac90SSteven Rostedt 	return rec;
15503d083395SSteven Rostedt }
15513d083395SSteven Rostedt 
155205736a42SSteven Rostedt static void print_ip_ins(const char *fmt, unsigned char *p)
155305736a42SSteven Rostedt {
155405736a42SSteven Rostedt 	int i;
155505736a42SSteven Rostedt 
155605736a42SSteven Rostedt 	printk(KERN_CONT "%s", fmt);
155705736a42SSteven Rostedt 
155805736a42SSteven Rostedt 	for (i = 0; i < MCOUNT_INSN_SIZE; i++)
155905736a42SSteven Rostedt 		printk(KERN_CONT "%s%02x", i ? ":" : "", p[i]);
156005736a42SSteven Rostedt }
156105736a42SSteven Rostedt 
1562c88fd863SSteven Rostedt /**
1563c88fd863SSteven Rostedt  * ftrace_bug - report and shutdown function tracer
1564c88fd863SSteven Rostedt  * @failed: The failed type (EFAULT, EINVAL, EPERM)
1565c88fd863SSteven Rostedt  * @ip: The address that failed
1566c88fd863SSteven Rostedt  *
1567c88fd863SSteven Rostedt  * The arch code that enables or disables the function tracing
1568c88fd863SSteven Rostedt  * can call ftrace_bug() when it has detected a problem in
1569c88fd863SSteven Rostedt  * modifying the code. @failed should be one of either:
1570c88fd863SSteven Rostedt  * EFAULT - if the problem happens on reading the @ip address
1571c88fd863SSteven Rostedt  * EINVAL - if what is read at @ip is not what was expected
1572c88fd863SSteven Rostedt  * EPERM - if the problem happens on writting to the @ip address
1573c88fd863SSteven Rostedt  */
1574c88fd863SSteven Rostedt void ftrace_bug(int failed, unsigned long ip)
15753c1720f0SSteven Rostedt {
1576b17e8a37SSteven Rostedt 	switch (failed) {
1577593eb8a2SSteven Rostedt 	case -EFAULT:
15786912896eSSteven Rostedt 		FTRACE_WARN_ON_ONCE(1);
157905736a42SSteven Rostedt 		pr_info("ftrace faulted on modifying ");
158005736a42SSteven Rostedt 		print_ip_sym(ip);
158105736a42SSteven Rostedt 		break;
1582593eb8a2SSteven Rostedt 	case -EINVAL:
15836912896eSSteven Rostedt 		FTRACE_WARN_ON_ONCE(1);
158405736a42SSteven Rostedt 		pr_info("ftrace failed to modify ");
158505736a42SSteven Rostedt 		print_ip_sym(ip);
158605736a42SSteven Rostedt 		print_ip_ins(" actual: ", (unsigned char *)ip);
158705736a42SSteven Rostedt 		printk(KERN_CONT "\n");
158805736a42SSteven Rostedt 		break;
1589593eb8a2SSteven Rostedt 	case -EPERM:
15906912896eSSteven Rostedt 		FTRACE_WARN_ON_ONCE(1);
1591593eb8a2SSteven Rostedt 		pr_info("ftrace faulted on writing ");
1592593eb8a2SSteven Rostedt 		print_ip_sym(ip);
1593593eb8a2SSteven Rostedt 		break;
1594593eb8a2SSteven Rostedt 	default:
15956912896eSSteven Rostedt 		FTRACE_WARN_ON_ONCE(1);
1596593eb8a2SSteven Rostedt 		pr_info("ftrace faulted on unknown error ");
1597593eb8a2SSteven Rostedt 		print_ip_sym(ip);
159805736a42SSteven Rostedt 	}
1599b17e8a37SSteven Rostedt }
160005736a42SSteven Rostedt 
16013d083395SSteven Rostedt 
16022cfa1978SMasami Hiramatsu /* Return 1 if the address range is reserved for ftrace */
16032cfa1978SMasami Hiramatsu int ftrace_text_reserved(void *start, void *end)
16042cfa1978SMasami Hiramatsu {
16052cfa1978SMasami Hiramatsu 	struct dyn_ftrace *rec;
16062cfa1978SMasami Hiramatsu 	struct ftrace_page *pg;
16072cfa1978SMasami Hiramatsu 
16082cfa1978SMasami Hiramatsu 	do_for_each_ftrace_rec(pg, rec) {
16092cfa1978SMasami Hiramatsu 		if (rec->ip <= (unsigned long)end &&
16102cfa1978SMasami Hiramatsu 		    rec->ip + MCOUNT_INSN_SIZE > (unsigned long)start)
16112cfa1978SMasami Hiramatsu 			return 1;
16122cfa1978SMasami Hiramatsu 	} while_for_each_ftrace_rec();
16132cfa1978SMasami Hiramatsu 	return 0;
16142cfa1978SMasami Hiramatsu }
16152cfa1978SMasami Hiramatsu 
1616c88fd863SSteven Rostedt static int ftrace_check_record(struct dyn_ftrace *rec, int enable, int update)
16173d083395SSteven Rostedt {
161864fbcd16SXiao Guangrong 	unsigned long flag = 0UL;
1619e7d3737eSFrederic Weisbecker 
16203d083395SSteven Rostedt 	/*
162130fb6aa7SJiri Olsa 	 * If we are updating calls:
16223d083395SSteven Rostedt 	 *
1623ed926f9bSSteven Rostedt 	 *   If the record has a ref count, then we need to enable it
1624ed926f9bSSteven Rostedt 	 *   because someone is using it.
16253d083395SSteven Rostedt 	 *
1626ed926f9bSSteven Rostedt 	 *   Otherwise we make sure its disabled.
1627ed926f9bSSteven Rostedt 	 *
162830fb6aa7SJiri Olsa 	 * If we are disabling calls, then disable all records that
1629ed926f9bSSteven Rostedt 	 * are enabled.
16303d083395SSteven Rostedt 	 */
1631c88fd863SSteven Rostedt 	if (enable && (rec->flags & ~FTRACE_FL_MASK))
163264fbcd16SXiao Guangrong 		flag = FTRACE_FL_ENABLED;
16333d083395SSteven Rostedt 
163464fbcd16SXiao Guangrong 	/* If the state of this record hasn't changed, then do nothing */
163564fbcd16SXiao Guangrong 	if ((rec->flags & FTRACE_FL_ENABLED) == flag)
1636c88fd863SSteven Rostedt 		return FTRACE_UPDATE_IGNORE;
163764fbcd16SXiao Guangrong 
163864fbcd16SXiao Guangrong 	if (flag) {
1639c88fd863SSteven Rostedt 		if (update)
164064fbcd16SXiao Guangrong 			rec->flags |= FTRACE_FL_ENABLED;
1641c88fd863SSteven Rostedt 		return FTRACE_UPDATE_MAKE_CALL;
164264fbcd16SXiao Guangrong 	}
164364fbcd16SXiao Guangrong 
1644c88fd863SSteven Rostedt 	if (update)
164564fbcd16SXiao Guangrong 		rec->flags &= ~FTRACE_FL_ENABLED;
1646c88fd863SSteven Rostedt 
1647c88fd863SSteven Rostedt 	return FTRACE_UPDATE_MAKE_NOP;
1648c88fd863SSteven Rostedt }
1649c88fd863SSteven Rostedt 
1650c88fd863SSteven Rostedt /**
1651c88fd863SSteven Rostedt  * ftrace_update_record, set a record that now is tracing or not
1652c88fd863SSteven Rostedt  * @rec: the record to update
1653c88fd863SSteven Rostedt  * @enable: set to 1 if the record is tracing, zero to force disable
1654c88fd863SSteven Rostedt  *
1655c88fd863SSteven Rostedt  * The records that represent all functions that can be traced need
1656c88fd863SSteven Rostedt  * to be updated when tracing has been enabled.
1657c88fd863SSteven Rostedt  */
1658c88fd863SSteven Rostedt int ftrace_update_record(struct dyn_ftrace *rec, int enable)
1659c88fd863SSteven Rostedt {
1660c88fd863SSteven Rostedt 	return ftrace_check_record(rec, enable, 1);
1661c88fd863SSteven Rostedt }
1662c88fd863SSteven Rostedt 
1663c88fd863SSteven Rostedt /**
1664c88fd863SSteven Rostedt  * ftrace_test_record, check if the record has been enabled or not
1665c88fd863SSteven Rostedt  * @rec: the record to test
1666c88fd863SSteven Rostedt  * @enable: set to 1 to check if enabled, 0 if it is disabled
1667c88fd863SSteven Rostedt  *
1668c88fd863SSteven Rostedt  * The arch code may need to test if a record is already set to
1669c88fd863SSteven Rostedt  * tracing to determine how to modify the function code that it
1670c88fd863SSteven Rostedt  * represents.
1671c88fd863SSteven Rostedt  */
1672c88fd863SSteven Rostedt int ftrace_test_record(struct dyn_ftrace *rec, int enable)
1673c88fd863SSteven Rostedt {
1674c88fd863SSteven Rostedt 	return ftrace_check_record(rec, enable, 0);
1675c88fd863SSteven Rostedt }
1676c88fd863SSteven Rostedt 
1677c88fd863SSteven Rostedt static int
1678c88fd863SSteven Rostedt __ftrace_replace_code(struct dyn_ftrace *rec, int enable)
1679c88fd863SSteven Rostedt {
1680c88fd863SSteven Rostedt 	unsigned long ftrace_addr;
1681c88fd863SSteven Rostedt 	int ret;
1682c88fd863SSteven Rostedt 
1683c88fd863SSteven Rostedt 	ftrace_addr = (unsigned long)FTRACE_ADDR;
1684c88fd863SSteven Rostedt 
1685c88fd863SSteven Rostedt 	ret = ftrace_update_record(rec, enable);
1686c88fd863SSteven Rostedt 
1687c88fd863SSteven Rostedt 	switch (ret) {
1688c88fd863SSteven Rostedt 	case FTRACE_UPDATE_IGNORE:
1689c88fd863SSteven Rostedt 		return 0;
1690c88fd863SSteven Rostedt 
1691c88fd863SSteven Rostedt 	case FTRACE_UPDATE_MAKE_CALL:
1692c88fd863SSteven Rostedt 		return ftrace_make_call(rec, ftrace_addr);
1693c88fd863SSteven Rostedt 
1694c88fd863SSteven Rostedt 	case FTRACE_UPDATE_MAKE_NOP:
1695e7d3737eSFrederic Weisbecker 		return ftrace_make_nop(NULL, rec, ftrace_addr);
16963d083395SSteven Rostedt 	}
16973d083395SSteven Rostedt 
1698c88fd863SSteven Rostedt 	return -1; /* unknow ftrace bug */
1699c88fd863SSteven Rostedt }
1700c88fd863SSteven Rostedt 
170130fb6aa7SJiri Olsa static void ftrace_replace_code(int update)
17023d083395SSteven Rostedt {
17033d083395SSteven Rostedt 	struct dyn_ftrace *rec;
17043d083395SSteven Rostedt 	struct ftrace_page *pg;
17056a24a244SSteven Rostedt 	int failed;
17063d083395SSteven Rostedt 
170745a4a237SSteven Rostedt 	if (unlikely(ftrace_disabled))
170845a4a237SSteven Rostedt 		return;
170945a4a237SSteven Rostedt 
1710265c831cSSteven Rostedt 	do_for_each_ftrace_rec(pg, rec) {
171130fb6aa7SJiri Olsa 		failed = __ftrace_replace_code(rec, update);
1712fa9d13cfSZhaolei 		if (failed) {
171331e88909SSteven Rostedt 			ftrace_bug(failed, rec->ip);
17144377245aSSteven Rostedt 			/* Stop processing */
17154377245aSSteven Rostedt 			return;
17164377245aSSteven Rostedt 		}
1717265c831cSSteven Rostedt 	} while_for_each_ftrace_rec();
17183d083395SSteven Rostedt }
17193c1720f0SSteven Rostedt 
1720c88fd863SSteven Rostedt struct ftrace_rec_iter {
1721c88fd863SSteven Rostedt 	struct ftrace_page	*pg;
1722c88fd863SSteven Rostedt 	int			index;
1723c88fd863SSteven Rostedt };
1724c88fd863SSteven Rostedt 
1725c88fd863SSteven Rostedt /**
1726c88fd863SSteven Rostedt  * ftrace_rec_iter_start, start up iterating over traced functions
1727c88fd863SSteven Rostedt  *
1728c88fd863SSteven Rostedt  * Returns an iterator handle that is used to iterate over all
1729c88fd863SSteven Rostedt  * the records that represent address locations where functions
1730c88fd863SSteven Rostedt  * are traced.
1731c88fd863SSteven Rostedt  *
1732c88fd863SSteven Rostedt  * May return NULL if no records are available.
1733c88fd863SSteven Rostedt  */
1734c88fd863SSteven Rostedt struct ftrace_rec_iter *ftrace_rec_iter_start(void)
1735c88fd863SSteven Rostedt {
1736c88fd863SSteven Rostedt 	/*
1737c88fd863SSteven Rostedt 	 * We only use a single iterator.
1738c88fd863SSteven Rostedt 	 * Protected by the ftrace_lock mutex.
1739c88fd863SSteven Rostedt 	 */
1740c88fd863SSteven Rostedt 	static struct ftrace_rec_iter ftrace_rec_iter;
1741c88fd863SSteven Rostedt 	struct ftrace_rec_iter *iter = &ftrace_rec_iter;
1742c88fd863SSteven Rostedt 
1743c88fd863SSteven Rostedt 	iter->pg = ftrace_pages_start;
1744c88fd863SSteven Rostedt 	iter->index = 0;
1745c88fd863SSteven Rostedt 
1746c88fd863SSteven Rostedt 	/* Could have empty pages */
1747c88fd863SSteven Rostedt 	while (iter->pg && !iter->pg->index)
1748c88fd863SSteven Rostedt 		iter->pg = iter->pg->next;
1749c88fd863SSteven Rostedt 
1750c88fd863SSteven Rostedt 	if (!iter->pg)
1751c88fd863SSteven Rostedt 		return NULL;
1752c88fd863SSteven Rostedt 
1753c88fd863SSteven Rostedt 	return iter;
1754c88fd863SSteven Rostedt }
1755c88fd863SSteven Rostedt 
1756c88fd863SSteven Rostedt /**
1757c88fd863SSteven Rostedt  * ftrace_rec_iter_next, get the next record to process.
1758c88fd863SSteven Rostedt  * @iter: The handle to the iterator.
1759c88fd863SSteven Rostedt  *
1760c88fd863SSteven Rostedt  * Returns the next iterator after the given iterator @iter.
1761c88fd863SSteven Rostedt  */
1762c88fd863SSteven Rostedt struct ftrace_rec_iter *ftrace_rec_iter_next(struct ftrace_rec_iter *iter)
1763c88fd863SSteven Rostedt {
1764c88fd863SSteven Rostedt 	iter->index++;
1765c88fd863SSteven Rostedt 
1766c88fd863SSteven Rostedt 	if (iter->index >= iter->pg->index) {
1767c88fd863SSteven Rostedt 		iter->pg = iter->pg->next;
1768c88fd863SSteven Rostedt 		iter->index = 0;
1769c88fd863SSteven Rostedt 
1770c88fd863SSteven Rostedt 		/* Could have empty pages */
1771c88fd863SSteven Rostedt 		while (iter->pg && !iter->pg->index)
1772c88fd863SSteven Rostedt 			iter->pg = iter->pg->next;
1773c88fd863SSteven Rostedt 	}
1774c88fd863SSteven Rostedt 
1775c88fd863SSteven Rostedt 	if (!iter->pg)
1776c88fd863SSteven Rostedt 		return NULL;
1777c88fd863SSteven Rostedt 
1778c88fd863SSteven Rostedt 	return iter;
1779c88fd863SSteven Rostedt }
1780c88fd863SSteven Rostedt 
1781c88fd863SSteven Rostedt /**
1782c88fd863SSteven Rostedt  * ftrace_rec_iter_record, get the record at the iterator location
1783c88fd863SSteven Rostedt  * @iter: The current iterator location
1784c88fd863SSteven Rostedt  *
1785c88fd863SSteven Rostedt  * Returns the record that the current @iter is at.
1786c88fd863SSteven Rostedt  */
1787c88fd863SSteven Rostedt struct dyn_ftrace *ftrace_rec_iter_record(struct ftrace_rec_iter *iter)
1788c88fd863SSteven Rostedt {
1789c88fd863SSteven Rostedt 	return &iter->pg->records[iter->index];
1790c88fd863SSteven Rostedt }
1791c88fd863SSteven Rostedt 
17923b47bfc1SSteven Rostedt static int
179331e88909SSteven Rostedt ftrace_code_disable(struct module *mod, struct dyn_ftrace *rec)
17943c1720f0SSteven Rostedt {
179537ad5084SSteven Rostedt 	unsigned long ip;
1796492a7ea5SAbhishek Sagar 	int ret;
179737ad5084SSteven Rostedt 
1798492a7ea5SAbhishek Sagar 	ip = rec->ip;
17993c1720f0SSteven Rostedt 
180045a4a237SSteven Rostedt 	if (unlikely(ftrace_disabled))
180145a4a237SSteven Rostedt 		return 0;
180245a4a237SSteven Rostedt 
180325aac9dcSShaohua Li 	ret = ftrace_make_nop(mod, rec, MCOUNT_ADDR);
18043d083395SSteven Rostedt 	if (ret) {
180531e88909SSteven Rostedt 		ftrace_bug(ret, ip);
18063d083395SSteven Rostedt 		return 0;
1807d61f82d0SSteven Rostedt 	}
1808d61f82d0SSteven Rostedt 	return 1;
18093d083395SSteven Rostedt }
18103d083395SSteven Rostedt 
1811000ab691SSteven Rostedt /*
1812000ab691SSteven Rostedt  * archs can override this function if they must do something
1813000ab691SSteven Rostedt  * before the modifying code is performed.
1814000ab691SSteven Rostedt  */
1815000ab691SSteven Rostedt int __weak ftrace_arch_code_modify_prepare(void)
1816000ab691SSteven Rostedt {
1817000ab691SSteven Rostedt 	return 0;
1818000ab691SSteven Rostedt }
1819000ab691SSteven Rostedt 
1820000ab691SSteven Rostedt /*
1821000ab691SSteven Rostedt  * archs can override this function if they must do something
1822000ab691SSteven Rostedt  * after the modifying code is performed.
1823000ab691SSteven Rostedt  */
1824000ab691SSteven Rostedt int __weak ftrace_arch_code_modify_post_process(void)
1825000ab691SSteven Rostedt {
1826000ab691SSteven Rostedt 	return 0;
1827000ab691SSteven Rostedt }
1828000ab691SSteven Rostedt 
18293d083395SSteven Rostedt static int __ftrace_modify_code(void *data)
18303d083395SSteven Rostedt {
18313d083395SSteven Rostedt 	int *command = data;
18323d083395SSteven Rostedt 
183330fb6aa7SJiri Olsa 	if (*command & FTRACE_UPDATE_CALLS)
18343d083395SSteven Rostedt 		ftrace_replace_code(1);
1835a3583244SSteven Rostedt 	else if (*command & FTRACE_DISABLE_CALLS)
18363d083395SSteven Rostedt 		ftrace_replace_code(0);
18373d083395SSteven Rostedt 
18383d083395SSteven Rostedt 	if (*command & FTRACE_UPDATE_TRACE_FUNC)
18393d083395SSteven Rostedt 		ftrace_update_ftrace_func(ftrace_trace_function);
18403d083395SSteven Rostedt 
18415a45cfe1SSteven Rostedt 	if (*command & FTRACE_START_FUNC_RET)
18425a45cfe1SSteven Rostedt 		ftrace_enable_ftrace_graph_caller();
18435a45cfe1SSteven Rostedt 	else if (*command & FTRACE_STOP_FUNC_RET)
18445a45cfe1SSteven Rostedt 		ftrace_disable_ftrace_graph_caller();
18455a45cfe1SSteven Rostedt 
1846c88fd863SSteven Rostedt 	return 0;
1847c88fd863SSteven Rostedt }
1848c88fd863SSteven Rostedt 
1849c88fd863SSteven Rostedt /**
1850c88fd863SSteven Rostedt  * ftrace_run_stop_machine, go back to the stop machine method
1851c88fd863SSteven Rostedt  * @command: The command to tell ftrace what to do
1852c88fd863SSteven Rostedt  *
1853c88fd863SSteven Rostedt  * If an arch needs to fall back to the stop machine method, the
1854c88fd863SSteven Rostedt  * it can call this function.
1855c88fd863SSteven Rostedt  */
1856c88fd863SSteven Rostedt void ftrace_run_stop_machine(int command)
1857c88fd863SSteven Rostedt {
1858c88fd863SSteven Rostedt 	stop_machine(__ftrace_modify_code, &command, NULL);
1859c88fd863SSteven Rostedt }
1860c88fd863SSteven Rostedt 
1861c88fd863SSteven Rostedt /**
1862c88fd863SSteven Rostedt  * arch_ftrace_update_code, modify the code to trace or not trace
1863c88fd863SSteven Rostedt  * @command: The command that needs to be done
1864c88fd863SSteven Rostedt  *
1865c88fd863SSteven Rostedt  * Archs can override this function if it does not need to
1866c88fd863SSteven Rostedt  * run stop_machine() to modify code.
1867c88fd863SSteven Rostedt  */
1868c88fd863SSteven Rostedt void __weak arch_ftrace_update_code(int command)
1869c88fd863SSteven Rostedt {
1870c88fd863SSteven Rostedt 	ftrace_run_stop_machine(command);
1871c88fd863SSteven Rostedt }
1872c88fd863SSteven Rostedt 
1873c88fd863SSteven Rostedt static void ftrace_run_update_code(int command)
1874c88fd863SSteven Rostedt {
1875c88fd863SSteven Rostedt 	int ret;
1876c88fd863SSteven Rostedt 
1877c88fd863SSteven Rostedt 	ret = ftrace_arch_code_modify_prepare();
1878c88fd863SSteven Rostedt 	FTRACE_WARN_ON(ret);
1879c88fd863SSteven Rostedt 	if (ret)
1880c88fd863SSteven Rostedt 		return;
1881c88fd863SSteven Rostedt 	/*
1882c88fd863SSteven Rostedt 	 * Do not call function tracer while we update the code.
1883c88fd863SSteven Rostedt 	 * We are in stop machine.
1884c88fd863SSteven Rostedt 	 */
1885c88fd863SSteven Rostedt 	function_trace_stop++;
1886c88fd863SSteven Rostedt 
1887c88fd863SSteven Rostedt 	/*
1888c88fd863SSteven Rostedt 	 * By default we use stop_machine() to modify the code.
1889c88fd863SSteven Rostedt 	 * But archs can do what ever they want as long as it
1890c88fd863SSteven Rostedt 	 * is safe. The stop_machine() is the safest, but also
1891c88fd863SSteven Rostedt 	 * produces the most overhead.
1892c88fd863SSteven Rostedt 	 */
1893c88fd863SSteven Rostedt 	arch_ftrace_update_code(command);
1894c88fd863SSteven Rostedt 
18956331c28cSSteven Rostedt #ifndef CONFIG_HAVE_FUNCTION_TRACE_MCOUNT_TEST
18966331c28cSSteven Rostedt 	/*
18976331c28cSSteven Rostedt 	 * For archs that call ftrace_test_stop_func(), we must
18986331c28cSSteven Rostedt 	 * wait till after we update all the function callers
18996331c28cSSteven Rostedt 	 * before we update the callback. This keeps different
19006331c28cSSteven Rostedt 	 * ops that record different functions from corrupting
19016331c28cSSteven Rostedt 	 * each other.
19026331c28cSSteven Rostedt 	 */
19036331c28cSSteven Rostedt 	__ftrace_trace_function = __ftrace_trace_function_delay;
19046331c28cSSteven Rostedt #endif
19056331c28cSSteven Rostedt 	function_trace_stop--;
19066331c28cSSteven Rostedt 
1907000ab691SSteven Rostedt 	ret = ftrace_arch_code_modify_post_process();
1908000ab691SSteven Rostedt 	FTRACE_WARN_ON(ret);
19093d083395SSteven Rostedt }
19103d083395SSteven Rostedt 
19113d083395SSteven Rostedt static ftrace_func_t saved_ftrace_func;
191260a7ecf4SSteven Rostedt static int ftrace_start_up;
1913b848914cSSteven Rostedt static int global_start_up;
1914df4fc315SSteven Rostedt 
1915df4fc315SSteven Rostedt static void ftrace_startup_enable(int command)
1916df4fc315SSteven Rostedt {
1917df4fc315SSteven Rostedt 	if (saved_ftrace_func != ftrace_trace_function) {
1918df4fc315SSteven Rostedt 		saved_ftrace_func = ftrace_trace_function;
1919df4fc315SSteven Rostedt 		command |= FTRACE_UPDATE_TRACE_FUNC;
1920df4fc315SSteven Rostedt 	}
1921df4fc315SSteven Rostedt 
1922df4fc315SSteven Rostedt 	if (!command || !ftrace_enabled)
1923df4fc315SSteven Rostedt 		return;
1924df4fc315SSteven Rostedt 
1925df4fc315SSteven Rostedt 	ftrace_run_update_code(command);
1926df4fc315SSteven Rostedt }
19273d083395SSteven Rostedt 
1928a1cd6173SSteven Rostedt static int ftrace_startup(struct ftrace_ops *ops, int command)
19293d083395SSteven Rostedt {
1930b848914cSSteven Rostedt 	bool hash_enable = true;
1931b848914cSSteven Rostedt 
19324eebcc81SSteven Rostedt 	if (unlikely(ftrace_disabled))
1933a1cd6173SSteven Rostedt 		return -ENODEV;
19344eebcc81SSteven Rostedt 
193560a7ecf4SSteven Rostedt 	ftrace_start_up++;
193630fb6aa7SJiri Olsa 	command |= FTRACE_UPDATE_CALLS;
19373d083395SSteven Rostedt 
1938b848914cSSteven Rostedt 	/* ops marked global share the filter hashes */
1939b848914cSSteven Rostedt 	if (ops->flags & FTRACE_OPS_FL_GLOBAL) {
1940b848914cSSteven Rostedt 		ops = &global_ops;
1941b848914cSSteven Rostedt 		/* Don't update hash if global is already set */
1942b848914cSSteven Rostedt 		if (global_start_up)
1943b848914cSSteven Rostedt 			hash_enable = false;
1944b848914cSSteven Rostedt 		global_start_up++;
1945b848914cSSteven Rostedt 	}
1946b848914cSSteven Rostedt 
1947ed926f9bSSteven Rostedt 	ops->flags |= FTRACE_OPS_FL_ENABLED;
1948b848914cSSteven Rostedt 	if (hash_enable)
1949ed926f9bSSteven Rostedt 		ftrace_hash_rec_enable(ops, 1);
1950ed926f9bSSteven Rostedt 
1951df4fc315SSteven Rostedt 	ftrace_startup_enable(command);
1952a1cd6173SSteven Rostedt 
1953a1cd6173SSteven Rostedt 	return 0;
19543d083395SSteven Rostedt }
19553d083395SSteven Rostedt 
1956bd69c30bSSteven Rostedt static void ftrace_shutdown(struct ftrace_ops *ops, int command)
19573d083395SSteven Rostedt {
1958b848914cSSteven Rostedt 	bool hash_disable = true;
1959b848914cSSteven Rostedt 
19604eebcc81SSteven Rostedt 	if (unlikely(ftrace_disabled))
19614eebcc81SSteven Rostedt 		return;
19624eebcc81SSteven Rostedt 
196360a7ecf4SSteven Rostedt 	ftrace_start_up--;
19649ea1a153SFrederic Weisbecker 	/*
19659ea1a153SFrederic Weisbecker 	 * Just warn in case of unbalance, no need to kill ftrace, it's not
19669ea1a153SFrederic Weisbecker 	 * critical but the ftrace_call callers may be never nopped again after
19679ea1a153SFrederic Weisbecker 	 * further ftrace uses.
19689ea1a153SFrederic Weisbecker 	 */
19699ea1a153SFrederic Weisbecker 	WARN_ON_ONCE(ftrace_start_up < 0);
19709ea1a153SFrederic Weisbecker 
1971b848914cSSteven Rostedt 	if (ops->flags & FTRACE_OPS_FL_GLOBAL) {
1972b848914cSSteven Rostedt 		ops = &global_ops;
1973b848914cSSteven Rostedt 		global_start_up--;
1974b848914cSSteven Rostedt 		WARN_ON_ONCE(global_start_up < 0);
1975b848914cSSteven Rostedt 		/* Don't update hash if global still has users */
1976b848914cSSteven Rostedt 		if (global_start_up) {
1977b848914cSSteven Rostedt 			WARN_ON_ONCE(!ftrace_start_up);
1978b848914cSSteven Rostedt 			hash_disable = false;
1979b848914cSSteven Rostedt 		}
1980b848914cSSteven Rostedt 	}
1981b848914cSSteven Rostedt 
1982b848914cSSteven Rostedt 	if (hash_disable)
1983ed926f9bSSteven Rostedt 		ftrace_hash_rec_disable(ops, 1);
1984ed926f9bSSteven Rostedt 
1985b848914cSSteven Rostedt 	if (ops != &global_ops || !global_start_up)
1986ed926f9bSSteven Rostedt 		ops->flags &= ~FTRACE_OPS_FL_ENABLED;
1987b848914cSSteven Rostedt 
198830fb6aa7SJiri Olsa 	command |= FTRACE_UPDATE_CALLS;
1989d61f82d0SSteven Rostedt 
1990d61f82d0SSteven Rostedt 	if (saved_ftrace_func != ftrace_trace_function) {
1991d61f82d0SSteven Rostedt 		saved_ftrace_func = ftrace_trace_function;
1992d61f82d0SSteven Rostedt 		command |= FTRACE_UPDATE_TRACE_FUNC;
1993d61f82d0SSteven Rostedt 	}
1994d61f82d0SSteven Rostedt 
1995d61f82d0SSteven Rostedt 	if (!command || !ftrace_enabled)
1996e6ea44e9SSteven Rostedt 		return;
19973d083395SSteven Rostedt 
1998d61f82d0SSteven Rostedt 	ftrace_run_update_code(command);
19993d083395SSteven Rostedt }
20003d083395SSteven Rostedt 
2001e309b41dSIngo Molnar static void ftrace_startup_sysctl(void)
2002b0fc494fSSteven Rostedt {
20034eebcc81SSteven Rostedt 	if (unlikely(ftrace_disabled))
20044eebcc81SSteven Rostedt 		return;
20054eebcc81SSteven Rostedt 
2006d61f82d0SSteven Rostedt 	/* Force update next time */
2007d61f82d0SSteven Rostedt 	saved_ftrace_func = NULL;
200860a7ecf4SSteven Rostedt 	/* ftrace_start_up is true if we want ftrace running */
200960a7ecf4SSteven Rostedt 	if (ftrace_start_up)
201030fb6aa7SJiri Olsa 		ftrace_run_update_code(FTRACE_UPDATE_CALLS);
2011b0fc494fSSteven Rostedt }
2012b0fc494fSSteven Rostedt 
2013e309b41dSIngo Molnar static void ftrace_shutdown_sysctl(void)
2014b0fc494fSSteven Rostedt {
20154eebcc81SSteven Rostedt 	if (unlikely(ftrace_disabled))
20164eebcc81SSteven Rostedt 		return;
20174eebcc81SSteven Rostedt 
201860a7ecf4SSteven Rostedt 	/* ftrace_start_up is true if ftrace is running */
201960a7ecf4SSteven Rostedt 	if (ftrace_start_up)
202079e406d7SSteven Rostedt 		ftrace_run_update_code(FTRACE_DISABLE_CALLS);
2021b0fc494fSSteven Rostedt }
2022b0fc494fSSteven Rostedt 
20233d083395SSteven Rostedt static cycle_t		ftrace_update_time;
20243d083395SSteven Rostedt static unsigned long	ftrace_update_cnt;
20253d083395SSteven Rostedt unsigned long		ftrace_update_tot_cnt;
20263d083395SSteven Rostedt 
2027f7bc8b61SSteven Rostedt static int ops_traces_mod(struct ftrace_ops *ops)
2028f7bc8b61SSteven Rostedt {
2029f7bc8b61SSteven Rostedt 	struct ftrace_hash *hash;
2030f7bc8b61SSteven Rostedt 
2031f7bc8b61SSteven Rostedt 	hash = ops->filter_hash;
203206a51d93SSteven Rostedt 	return ftrace_hash_empty(hash);
2033f7bc8b61SSteven Rostedt }
2034f7bc8b61SSteven Rostedt 
203531e88909SSteven Rostedt static int ftrace_update_code(struct module *mod)
20363d083395SSteven Rostedt {
203785ae32aeSSteven Rostedt 	struct ftrace_page *pg;
2038e94142a6SLai Jiangshan 	struct dyn_ftrace *p;
2039f22f9a89SAbhishek Sagar 	cycle_t start, stop;
2040f7bc8b61SSteven Rostedt 	unsigned long ref = 0;
204185ae32aeSSteven Rostedt 	int i;
2042f7bc8b61SSteven Rostedt 
2043f7bc8b61SSteven Rostedt 	/*
2044f7bc8b61SSteven Rostedt 	 * When adding a module, we need to check if tracers are
2045f7bc8b61SSteven Rostedt 	 * currently enabled and if they are set to trace all functions.
2046f7bc8b61SSteven Rostedt 	 * If they are, we need to enable the module functions as well
2047f7bc8b61SSteven Rostedt 	 * as update the reference counts for those function records.
2048f7bc8b61SSteven Rostedt 	 */
2049f7bc8b61SSteven Rostedt 	if (mod) {
2050f7bc8b61SSteven Rostedt 		struct ftrace_ops *ops;
2051f7bc8b61SSteven Rostedt 
2052f7bc8b61SSteven Rostedt 		for (ops = ftrace_ops_list;
2053f7bc8b61SSteven Rostedt 		     ops != &ftrace_list_end; ops = ops->next) {
2054f7bc8b61SSteven Rostedt 			if (ops->flags & FTRACE_OPS_FL_ENABLED &&
2055f7bc8b61SSteven Rostedt 			    ops_traces_mod(ops))
2056f7bc8b61SSteven Rostedt 				ref++;
2057f7bc8b61SSteven Rostedt 		}
2058f7bc8b61SSteven Rostedt 	}
20593d083395SSteven Rostedt 
2060750ed1a4SIngo Molnar 	start = ftrace_now(raw_smp_processor_id());
20613d083395SSteven Rostedt 	ftrace_update_cnt = 0;
20623d083395SSteven Rostedt 
206385ae32aeSSteven Rostedt 	for (pg = ftrace_new_pgs; pg; pg = pg->next) {
2064f22f9a89SAbhishek Sagar 
206585ae32aeSSteven Rostedt 		for (i = 0; i < pg->index; i++) {
206608f5ac90SSteven Rostedt 			/* If something went wrong, bail without enabling anything */
206708f5ac90SSteven Rostedt 			if (unlikely(ftrace_disabled))
206808f5ac90SSteven Rostedt 				return -1;
20693d083395SSteven Rostedt 
207085ae32aeSSteven Rostedt 			p = &pg->records[i];
2071f7bc8b61SSteven Rostedt 			p->flags = ref;
2072f22f9a89SAbhishek Sagar 
20735cb084bbSJiri Olsa 			/*
207425985edcSLucas De Marchi 			 * Do the initial record conversion from mcount jump
20755cb084bbSJiri Olsa 			 * to the NOP instructions.
20765cb084bbSJiri Olsa 			 */
207732082309SSteven Rostedt 			if (!ftrace_code_disable(mod, p))
2078d2c8c3eaSSteven Rostedt 				break;
20795cb084bbSJiri Olsa 
20803d083395SSteven Rostedt 			ftrace_update_cnt++;
20815cb084bbSJiri Olsa 
20825cb084bbSJiri Olsa 			/*
20835cb084bbSJiri Olsa 			 * If the tracing is enabled, go ahead and enable the record.
20845cb084bbSJiri Olsa 			 *
20855cb084bbSJiri Olsa 			 * The reason not to enable the record immediatelly is the
20865cb084bbSJiri Olsa 			 * inherent check of ftrace_make_nop/ftrace_make_call for
20875cb084bbSJiri Olsa 			 * correct previous instructions.  Making first the NOP
20885cb084bbSJiri Olsa 			 * conversion puts the module to the correct state, thus
20895cb084bbSJiri Olsa 			 * passing the ftrace_make_call check.
20905cb084bbSJiri Olsa 			 */
2091f7bc8b61SSteven Rostedt 			if (ftrace_start_up && ref) {
20925cb084bbSJiri Olsa 				int failed = __ftrace_replace_code(p, 1);
209332082309SSteven Rostedt 				if (failed)
20945cb084bbSJiri Olsa 					ftrace_bug(failed, p->ip);
20955cb084bbSJiri Olsa 			}
20965cb084bbSJiri Olsa 		}
209785ae32aeSSteven Rostedt 	}
209885ae32aeSSteven Rostedt 
209985ae32aeSSteven Rostedt 	ftrace_new_pgs = NULL;
21003d083395SSteven Rostedt 
2101750ed1a4SIngo Molnar 	stop = ftrace_now(raw_smp_processor_id());
21023d083395SSteven Rostedt 	ftrace_update_time = stop - start;
21033d083395SSteven Rostedt 	ftrace_update_tot_cnt += ftrace_update_cnt;
21043d083395SSteven Rostedt 
210516444a8aSArnaldo Carvalho de Melo 	return 0;
210616444a8aSArnaldo Carvalho de Melo }
210716444a8aSArnaldo Carvalho de Melo 
2108a7900875SSteven Rostedt static int ftrace_allocate_records(struct ftrace_page *pg, int count)
21093c1720f0SSteven Rostedt {
2110a7900875SSteven Rostedt 	int order;
21113c1720f0SSteven Rostedt 	int cnt;
21123c1720f0SSteven Rostedt 
2113a7900875SSteven Rostedt 	if (WARN_ON(!count))
2114a7900875SSteven Rostedt 		return -EINVAL;
2115a7900875SSteven Rostedt 
2116a7900875SSteven Rostedt 	order = get_count_order(DIV_ROUND_UP(count, ENTRIES_PER_PAGE));
21173c1720f0SSteven Rostedt 
21183c1720f0SSteven Rostedt 	/*
2119a7900875SSteven Rostedt 	 * We want to fill as much as possible. No more than a page
2120a7900875SSteven Rostedt 	 * may be empty.
21213c1720f0SSteven Rostedt 	 */
2122a7900875SSteven Rostedt 	while ((PAGE_SIZE << order) / ENTRY_SIZE >= count + ENTRIES_PER_PAGE)
2123a7900875SSteven Rostedt 		order--;
21243c1720f0SSteven Rostedt 
2125a7900875SSteven Rostedt  again:
2126a7900875SSteven Rostedt 	pg->records = (void *)__get_free_pages(GFP_KERNEL | __GFP_ZERO, order);
2127a7900875SSteven Rostedt 
2128a7900875SSteven Rostedt 	if (!pg->records) {
2129a7900875SSteven Rostedt 		/* if we can't allocate this size, try something smaller */
2130a7900875SSteven Rostedt 		if (!order)
2131a7900875SSteven Rostedt 			return -ENOMEM;
2132a7900875SSteven Rostedt 		order >>= 1;
2133a7900875SSteven Rostedt 		goto again;
2134a7900875SSteven Rostedt 	}
2135a7900875SSteven Rostedt 
2136a7900875SSteven Rostedt 	cnt = (PAGE_SIZE << order) / ENTRY_SIZE;
2137a7900875SSteven Rostedt 	pg->size = cnt;
2138a7900875SSteven Rostedt 
2139a7900875SSteven Rostedt 	if (cnt > count)
2140a7900875SSteven Rostedt 		cnt = count;
2141a7900875SSteven Rostedt 
2142a7900875SSteven Rostedt 	return cnt;
2143a7900875SSteven Rostedt }
2144a7900875SSteven Rostedt 
2145a7900875SSteven Rostedt static struct ftrace_page *
2146a7900875SSteven Rostedt ftrace_allocate_pages(unsigned long num_to_init)
2147a7900875SSteven Rostedt {
2148a7900875SSteven Rostedt 	struct ftrace_page *start_pg;
2149a7900875SSteven Rostedt 	struct ftrace_page *pg;
2150a7900875SSteven Rostedt 	int order;
2151a7900875SSteven Rostedt 	int cnt;
2152a7900875SSteven Rostedt 
2153a7900875SSteven Rostedt 	if (!num_to_init)
2154a7900875SSteven Rostedt 		return 0;
2155a7900875SSteven Rostedt 
2156a7900875SSteven Rostedt 	start_pg = pg = kzalloc(sizeof(*pg), GFP_KERNEL);
2157a7900875SSteven Rostedt 	if (!pg)
2158a7900875SSteven Rostedt 		return NULL;
2159a7900875SSteven Rostedt 
2160a7900875SSteven Rostedt 	/*
2161a7900875SSteven Rostedt 	 * Try to allocate as much as possible in one continues
2162a7900875SSteven Rostedt 	 * location that fills in all of the space. We want to
2163a7900875SSteven Rostedt 	 * waste as little space as possible.
2164a7900875SSteven Rostedt 	 */
2165a7900875SSteven Rostedt 	for (;;) {
2166a7900875SSteven Rostedt 		cnt = ftrace_allocate_records(pg, num_to_init);
2167a7900875SSteven Rostedt 		if (cnt < 0)
2168a7900875SSteven Rostedt 			goto free_pages;
2169a7900875SSteven Rostedt 
2170a7900875SSteven Rostedt 		num_to_init -= cnt;
2171a7900875SSteven Rostedt 		if (!num_to_init)
2172a7900875SSteven Rostedt 			break;
2173a7900875SSteven Rostedt 
2174a7900875SSteven Rostedt 		pg->next = kzalloc(sizeof(*pg), GFP_KERNEL);
2175a7900875SSteven Rostedt 		if (!pg->next)
2176a7900875SSteven Rostedt 			goto free_pages;
2177a7900875SSteven Rostedt 
2178a7900875SSteven Rostedt 		pg = pg->next;
2179a7900875SSteven Rostedt 	}
2180a7900875SSteven Rostedt 
2181a7900875SSteven Rostedt 	return start_pg;
2182a7900875SSteven Rostedt 
2183a7900875SSteven Rostedt  free_pages:
2184a7900875SSteven Rostedt 	while (start_pg) {
2185a7900875SSteven Rostedt 		order = get_count_order(pg->size / ENTRIES_PER_PAGE);
2186a7900875SSteven Rostedt 		free_pages((unsigned long)pg->records, order);
2187a7900875SSteven Rostedt 		start_pg = pg->next;
2188a7900875SSteven Rostedt 		kfree(pg);
2189a7900875SSteven Rostedt 		pg = start_pg;
2190a7900875SSteven Rostedt 	}
2191a7900875SSteven Rostedt 	pr_info("ftrace: FAILED to allocate memory for functions\n");
2192a7900875SSteven Rostedt 	return NULL;
2193a7900875SSteven Rostedt }
2194a7900875SSteven Rostedt 
2195a7900875SSteven Rostedt static int __init ftrace_dyn_table_alloc(unsigned long num_to_init)
2196a7900875SSteven Rostedt {
2197a7900875SSteven Rostedt 	int cnt;
2198a7900875SSteven Rostedt 
2199a7900875SSteven Rostedt 	if (!num_to_init) {
2200a7900875SSteven Rostedt 		pr_info("ftrace: No functions to be traced?\n");
2201a7900875SSteven Rostedt 		return -1;
2202a7900875SSteven Rostedt 	}
22033c1720f0SSteven Rostedt 
220468bf21aaSSteven Rostedt 	cnt = num_to_init / ENTRIES_PER_PAGE;
220508f5ac90SSteven Rostedt 	pr_info("ftrace: allocating %ld entries in %d pages\n",
22065821e1b7Swalimis 		num_to_init, cnt + 1);
22073c1720f0SSteven Rostedt 
22083c1720f0SSteven Rostedt 	return 0;
22093c1720f0SSteven Rostedt }
22103c1720f0SSteven Rostedt 
22115072c59fSSteven Rostedt #define FTRACE_BUFF_MAX (KSYM_SYMBOL_LEN+4) /* room for wildcards */
22125072c59fSSteven Rostedt 
22135072c59fSSteven Rostedt struct ftrace_iterator {
221498c4fd04SSteven Rostedt 	loff_t				pos;
22152bccfffdSSteven Rostedt 	loff_t				func_pos;
22165072c59fSSteven Rostedt 	struct ftrace_page		*pg;
22174aeb6967SSteven Rostedt 	struct dyn_ftrace		*func;
22184aeb6967SSteven Rostedt 	struct ftrace_func_probe	*probe;
22194aeb6967SSteven Rostedt 	struct trace_parser		parser;
22201cf41dd7SSteven Rostedt 	struct ftrace_hash		*hash;
222133dc9b12SSteven Rostedt 	struct ftrace_ops		*ops;
22228fc0c701SSteven Rostedt 	int				hidx;
2223431aa3fbSSteven Rostedt 	int				idx;
22245072c59fSSteven Rostedt 	unsigned			flags;
22255072c59fSSteven Rostedt };
22265072c59fSSteven Rostedt 
2227e309b41dSIngo Molnar static void *
22284aeb6967SSteven Rostedt t_hash_next(struct seq_file *m, loff_t *pos)
22298fc0c701SSteven Rostedt {
22308fc0c701SSteven Rostedt 	struct ftrace_iterator *iter = m->private;
22314aeb6967SSteven Rostedt 	struct hlist_node *hnd = NULL;
22328fc0c701SSteven Rostedt 	struct hlist_head *hhd;
22338fc0c701SSteven Rostedt 
22348fc0c701SSteven Rostedt 	(*pos)++;
223598c4fd04SSteven Rostedt 	iter->pos = *pos;
22368fc0c701SSteven Rostedt 
22374aeb6967SSteven Rostedt 	if (iter->probe)
22384aeb6967SSteven Rostedt 		hnd = &iter->probe->node;
22398fc0c701SSteven Rostedt  retry:
22408fc0c701SSteven Rostedt 	if (iter->hidx >= FTRACE_FUNC_HASHSIZE)
22418fc0c701SSteven Rostedt 		return NULL;
22428fc0c701SSteven Rostedt 
22438fc0c701SSteven Rostedt 	hhd = &ftrace_func_hash[iter->hidx];
22448fc0c701SSteven Rostedt 
22458fc0c701SSteven Rostedt 	if (hlist_empty(hhd)) {
22468fc0c701SSteven Rostedt 		iter->hidx++;
22478fc0c701SSteven Rostedt 		hnd = NULL;
22488fc0c701SSteven Rostedt 		goto retry;
22498fc0c701SSteven Rostedt 	}
22508fc0c701SSteven Rostedt 
22518fc0c701SSteven Rostedt 	if (!hnd)
22528fc0c701SSteven Rostedt 		hnd = hhd->first;
22538fc0c701SSteven Rostedt 	else {
22548fc0c701SSteven Rostedt 		hnd = hnd->next;
22558fc0c701SSteven Rostedt 		if (!hnd) {
22568fc0c701SSteven Rostedt 			iter->hidx++;
22578fc0c701SSteven Rostedt 			goto retry;
22588fc0c701SSteven Rostedt 		}
22598fc0c701SSteven Rostedt 	}
22608fc0c701SSteven Rostedt 
22614aeb6967SSteven Rostedt 	if (WARN_ON_ONCE(!hnd))
22624aeb6967SSteven Rostedt 		return NULL;
22634aeb6967SSteven Rostedt 
22644aeb6967SSteven Rostedt 	iter->probe = hlist_entry(hnd, struct ftrace_func_probe, node);
22654aeb6967SSteven Rostedt 
22664aeb6967SSteven Rostedt 	return iter;
22678fc0c701SSteven Rostedt }
22688fc0c701SSteven Rostedt 
22698fc0c701SSteven Rostedt static void *t_hash_start(struct seq_file *m, loff_t *pos)
22708fc0c701SSteven Rostedt {
22718fc0c701SSteven Rostedt 	struct ftrace_iterator *iter = m->private;
22728fc0c701SSteven Rostedt 	void *p = NULL;
2273d82d6244SLi Zefan 	loff_t l;
2274d82d6244SLi Zefan 
227569a3083cSSteven Rostedt 	if (!(iter->flags & FTRACE_ITER_DO_HASH))
227669a3083cSSteven Rostedt 		return NULL;
227769a3083cSSteven Rostedt 
22782bccfffdSSteven Rostedt 	if (iter->func_pos > *pos)
22792bccfffdSSteven Rostedt 		return NULL;
22808fc0c701SSteven Rostedt 
2281d82d6244SLi Zefan 	iter->hidx = 0;
22822bccfffdSSteven Rostedt 	for (l = 0; l <= (*pos - iter->func_pos); ) {
22834aeb6967SSteven Rostedt 		p = t_hash_next(m, &l);
2284d82d6244SLi Zefan 		if (!p)
2285d82d6244SLi Zefan 			break;
2286d82d6244SLi Zefan 	}
22874aeb6967SSteven Rostedt 	if (!p)
22884aeb6967SSteven Rostedt 		return NULL;
22894aeb6967SSteven Rostedt 
229098c4fd04SSteven Rostedt 	/* Only set this if we have an item */
229198c4fd04SSteven Rostedt 	iter->flags |= FTRACE_ITER_HASH;
229298c4fd04SSteven Rostedt 
22934aeb6967SSteven Rostedt 	return iter;
22948fc0c701SSteven Rostedt }
22958fc0c701SSteven Rostedt 
22964aeb6967SSteven Rostedt static int
22974aeb6967SSteven Rostedt t_hash_show(struct seq_file *m, struct ftrace_iterator *iter)
22988fc0c701SSteven Rostedt {
2299b6887d79SSteven Rostedt 	struct ftrace_func_probe *rec;
23008fc0c701SSteven Rostedt 
23014aeb6967SSteven Rostedt 	rec = iter->probe;
23024aeb6967SSteven Rostedt 	if (WARN_ON_ONCE(!rec))
23034aeb6967SSteven Rostedt 		return -EIO;
23048fc0c701SSteven Rostedt 
2305809dcf29SSteven Rostedt 	if (rec->ops->print)
2306809dcf29SSteven Rostedt 		return rec->ops->print(m, rec->ip, rec->ops, rec->data);
2307809dcf29SSteven Rostedt 
2308b375a11aSSteven Rostedt 	seq_printf(m, "%ps:%ps", (void *)rec->ip, (void *)rec->ops->func);
23098fc0c701SSteven Rostedt 
23108fc0c701SSteven Rostedt 	if (rec->data)
23118fc0c701SSteven Rostedt 		seq_printf(m, ":%p", rec->data);
23128fc0c701SSteven Rostedt 	seq_putc(m, '\n');
23138fc0c701SSteven Rostedt 
23148fc0c701SSteven Rostedt 	return 0;
23158fc0c701SSteven Rostedt }
23168fc0c701SSteven Rostedt 
23178fc0c701SSteven Rostedt static void *
23185072c59fSSteven Rostedt t_next(struct seq_file *m, void *v, loff_t *pos)
23195072c59fSSteven Rostedt {
23205072c59fSSteven Rostedt 	struct ftrace_iterator *iter = m->private;
2321fc13cb0cSSteven Rostedt 	struct ftrace_ops *ops = iter->ops;
23225072c59fSSteven Rostedt 	struct dyn_ftrace *rec = NULL;
23235072c59fSSteven Rostedt 
232445a4a237SSteven Rostedt 	if (unlikely(ftrace_disabled))
232545a4a237SSteven Rostedt 		return NULL;
232645a4a237SSteven Rostedt 
23278fc0c701SSteven Rostedt 	if (iter->flags & FTRACE_ITER_HASH)
23284aeb6967SSteven Rostedt 		return t_hash_next(m, pos);
23298fc0c701SSteven Rostedt 
23305072c59fSSteven Rostedt 	(*pos)++;
23311106b699SJiri Olsa 	iter->pos = iter->func_pos = *pos;
23325072c59fSSteven Rostedt 
23330c75a3edSSteven Rostedt 	if (iter->flags & FTRACE_ITER_PRINTALL)
233457c072c7SSteven Rostedt 		return t_hash_start(m, pos);
23350c75a3edSSteven Rostedt 
23365072c59fSSteven Rostedt  retry:
23375072c59fSSteven Rostedt 	if (iter->idx >= iter->pg->index) {
23385072c59fSSteven Rostedt 		if (iter->pg->next) {
23395072c59fSSteven Rostedt 			iter->pg = iter->pg->next;
23405072c59fSSteven Rostedt 			iter->idx = 0;
23415072c59fSSteven Rostedt 			goto retry;
23425072c59fSSteven Rostedt 		}
23435072c59fSSteven Rostedt 	} else {
23445072c59fSSteven Rostedt 		rec = &iter->pg->records[iter->idx++];
234532082309SSteven Rostedt 		if (((iter->flags & FTRACE_ITER_FILTER) &&
2346f45948e8SSteven Rostedt 		     !(ftrace_lookup_ip(ops->filter_hash, rec->ip))) ||
23470183fb1cSSteven Rostedt 
234841c52c0dSSteven Rostedt 		    ((iter->flags & FTRACE_ITER_NOTRACE) &&
2349647bcd03SSteven Rostedt 		     !ftrace_lookup_ip(ops->notrace_hash, rec->ip)) ||
2350647bcd03SSteven Rostedt 
2351647bcd03SSteven Rostedt 		    ((iter->flags & FTRACE_ITER_ENABLED) &&
2352647bcd03SSteven Rostedt 		     !(rec->flags & ~FTRACE_FL_MASK))) {
2353647bcd03SSteven Rostedt 
23545072c59fSSteven Rostedt 			rec = NULL;
23555072c59fSSteven Rostedt 			goto retry;
23565072c59fSSteven Rostedt 		}
23575072c59fSSteven Rostedt 	}
23585072c59fSSteven Rostedt 
23594aeb6967SSteven Rostedt 	if (!rec)
236057c072c7SSteven Rostedt 		return t_hash_start(m, pos);
23614aeb6967SSteven Rostedt 
23624aeb6967SSteven Rostedt 	iter->func = rec;
23634aeb6967SSteven Rostedt 
23644aeb6967SSteven Rostedt 	return iter;
23655072c59fSSteven Rostedt }
23665072c59fSSteven Rostedt 
236798c4fd04SSteven Rostedt static void reset_iter_read(struct ftrace_iterator *iter)
236898c4fd04SSteven Rostedt {
236998c4fd04SSteven Rostedt 	iter->pos = 0;
237098c4fd04SSteven Rostedt 	iter->func_pos = 0;
237198c4fd04SSteven Rostedt 	iter->flags &= ~(FTRACE_ITER_PRINTALL & FTRACE_ITER_HASH);
23725072c59fSSteven Rostedt }
23735072c59fSSteven Rostedt 
23745072c59fSSteven Rostedt static void *t_start(struct seq_file *m, loff_t *pos)
23755072c59fSSteven Rostedt {
23765072c59fSSteven Rostedt 	struct ftrace_iterator *iter = m->private;
2377fc13cb0cSSteven Rostedt 	struct ftrace_ops *ops = iter->ops;
23785072c59fSSteven Rostedt 	void *p = NULL;
2379694ce0a5SLi Zefan 	loff_t l;
23805072c59fSSteven Rostedt 
23818fc0c701SSteven Rostedt 	mutex_lock(&ftrace_lock);
238245a4a237SSteven Rostedt 
238345a4a237SSteven Rostedt 	if (unlikely(ftrace_disabled))
238445a4a237SSteven Rostedt 		return NULL;
238545a4a237SSteven Rostedt 
23860c75a3edSSteven Rostedt 	/*
238798c4fd04SSteven Rostedt 	 * If an lseek was done, then reset and start from beginning.
238898c4fd04SSteven Rostedt 	 */
238998c4fd04SSteven Rostedt 	if (*pos < iter->pos)
239098c4fd04SSteven Rostedt 		reset_iter_read(iter);
239198c4fd04SSteven Rostedt 
239298c4fd04SSteven Rostedt 	/*
23930c75a3edSSteven Rostedt 	 * For set_ftrace_filter reading, if we have the filter
23940c75a3edSSteven Rostedt 	 * off, we can short cut and just print out that all
23950c75a3edSSteven Rostedt 	 * functions are enabled.
23960c75a3edSSteven Rostedt 	 */
239706a51d93SSteven Rostedt 	if (iter->flags & FTRACE_ITER_FILTER &&
239806a51d93SSteven Rostedt 	    ftrace_hash_empty(ops->filter_hash)) {
23990c75a3edSSteven Rostedt 		if (*pos > 0)
24008fc0c701SSteven Rostedt 			return t_hash_start(m, pos);
24010c75a3edSSteven Rostedt 		iter->flags |= FTRACE_ITER_PRINTALL;
2402df091625SChris Wright 		/* reset in case of seek/pread */
2403df091625SChris Wright 		iter->flags &= ~FTRACE_ITER_HASH;
24040c75a3edSSteven Rostedt 		return iter;
24050c75a3edSSteven Rostedt 	}
24060c75a3edSSteven Rostedt 
24078fc0c701SSteven Rostedt 	if (iter->flags & FTRACE_ITER_HASH)
24088fc0c701SSteven Rostedt 		return t_hash_start(m, pos);
24098fc0c701SSteven Rostedt 
241098c4fd04SSteven Rostedt 	/*
241198c4fd04SSteven Rostedt 	 * Unfortunately, we need to restart at ftrace_pages_start
241298c4fd04SSteven Rostedt 	 * every time we let go of the ftrace_mutex. This is because
241398c4fd04SSteven Rostedt 	 * those pointers can change without the lock.
241498c4fd04SSteven Rostedt 	 */
2415694ce0a5SLi Zefan 	iter->pg = ftrace_pages_start;
2416694ce0a5SLi Zefan 	iter->idx = 0;
2417694ce0a5SLi Zefan 	for (l = 0; l <= *pos; ) {
2418694ce0a5SLi Zefan 		p = t_next(m, p, &l);
2419694ce0a5SLi Zefan 		if (!p)
2420694ce0a5SLi Zefan 			break;
242150cdaf08SLiming Wang 	}
24225821e1b7Swalimis 
242369a3083cSSteven Rostedt 	if (!p)
24248fc0c701SSteven Rostedt 		return t_hash_start(m, pos);
24258fc0c701SSteven Rostedt 
24264aeb6967SSteven Rostedt 	return iter;
24275072c59fSSteven Rostedt }
24285072c59fSSteven Rostedt 
24295072c59fSSteven Rostedt static void t_stop(struct seq_file *m, void *p)
24305072c59fSSteven Rostedt {
24318fc0c701SSteven Rostedt 	mutex_unlock(&ftrace_lock);
24325072c59fSSteven Rostedt }
24335072c59fSSteven Rostedt 
24345072c59fSSteven Rostedt static int t_show(struct seq_file *m, void *v)
24355072c59fSSteven Rostedt {
24360c75a3edSSteven Rostedt 	struct ftrace_iterator *iter = m->private;
24374aeb6967SSteven Rostedt 	struct dyn_ftrace *rec;
24385072c59fSSteven Rostedt 
24398fc0c701SSteven Rostedt 	if (iter->flags & FTRACE_ITER_HASH)
24404aeb6967SSteven Rostedt 		return t_hash_show(m, iter);
24418fc0c701SSteven Rostedt 
24420c75a3edSSteven Rostedt 	if (iter->flags & FTRACE_ITER_PRINTALL) {
24430c75a3edSSteven Rostedt 		seq_printf(m, "#### all functions enabled ####\n");
24440c75a3edSSteven Rostedt 		return 0;
24450c75a3edSSteven Rostedt 	}
24460c75a3edSSteven Rostedt 
24474aeb6967SSteven Rostedt 	rec = iter->func;
24484aeb6967SSteven Rostedt 
24495072c59fSSteven Rostedt 	if (!rec)
24505072c59fSSteven Rostedt 		return 0;
24515072c59fSSteven Rostedt 
2452647bcd03SSteven Rostedt 	seq_printf(m, "%ps", (void *)rec->ip);
2453647bcd03SSteven Rostedt 	if (iter->flags & FTRACE_ITER_ENABLED)
2454647bcd03SSteven Rostedt 		seq_printf(m, " (%ld)",
2455647bcd03SSteven Rostedt 			   rec->flags & ~FTRACE_FL_MASK);
2456647bcd03SSteven Rostedt 	seq_printf(m, "\n");
24575072c59fSSteven Rostedt 
24585072c59fSSteven Rostedt 	return 0;
24595072c59fSSteven Rostedt }
24605072c59fSSteven Rostedt 
246188e9d34cSJames Morris static const struct seq_operations show_ftrace_seq_ops = {
24625072c59fSSteven Rostedt 	.start = t_start,
24635072c59fSSteven Rostedt 	.next = t_next,
24645072c59fSSteven Rostedt 	.stop = t_stop,
24655072c59fSSteven Rostedt 	.show = t_show,
24665072c59fSSteven Rostedt };
24675072c59fSSteven Rostedt 
2468e309b41dSIngo Molnar static int
24695072c59fSSteven Rostedt ftrace_avail_open(struct inode *inode, struct file *file)
24705072c59fSSteven Rostedt {
24715072c59fSSteven Rostedt 	struct ftrace_iterator *iter;
24725072c59fSSteven Rostedt 	int ret;
24735072c59fSSteven Rostedt 
24744eebcc81SSteven Rostedt 	if (unlikely(ftrace_disabled))
24754eebcc81SSteven Rostedt 		return -ENODEV;
24764eebcc81SSteven Rostedt 
24775072c59fSSteven Rostedt 	iter = kzalloc(sizeof(*iter), GFP_KERNEL);
24785072c59fSSteven Rostedt 	if (!iter)
24795072c59fSSteven Rostedt 		return -ENOMEM;
24805072c59fSSteven Rostedt 
24815072c59fSSteven Rostedt 	iter->pg = ftrace_pages_start;
2482fc13cb0cSSteven Rostedt 	iter->ops = &global_ops;
24835072c59fSSteven Rostedt 
24845072c59fSSteven Rostedt 	ret = seq_open(file, &show_ftrace_seq_ops);
24855072c59fSSteven Rostedt 	if (!ret) {
24865072c59fSSteven Rostedt 		struct seq_file *m = file->private_data;
24874bf39a94SIngo Molnar 
24885072c59fSSteven Rostedt 		m->private = iter;
24894bf39a94SIngo Molnar 	} else {
24905072c59fSSteven Rostedt 		kfree(iter);
24914bf39a94SIngo Molnar 	}
24925072c59fSSteven Rostedt 
24935072c59fSSteven Rostedt 	return ret;
24945072c59fSSteven Rostedt }
24955072c59fSSteven Rostedt 
2496647bcd03SSteven Rostedt static int
2497647bcd03SSteven Rostedt ftrace_enabled_open(struct inode *inode, struct file *file)
2498647bcd03SSteven Rostedt {
2499647bcd03SSteven Rostedt 	struct ftrace_iterator *iter;
2500647bcd03SSteven Rostedt 	int ret;
2501647bcd03SSteven Rostedt 
2502647bcd03SSteven Rostedt 	if (unlikely(ftrace_disabled))
2503647bcd03SSteven Rostedt 		return -ENODEV;
2504647bcd03SSteven Rostedt 
2505647bcd03SSteven Rostedt 	iter = kzalloc(sizeof(*iter), GFP_KERNEL);
2506647bcd03SSteven Rostedt 	if (!iter)
2507647bcd03SSteven Rostedt 		return -ENOMEM;
2508647bcd03SSteven Rostedt 
2509647bcd03SSteven Rostedt 	iter->pg = ftrace_pages_start;
2510647bcd03SSteven Rostedt 	iter->flags = FTRACE_ITER_ENABLED;
2511fc13cb0cSSteven Rostedt 	iter->ops = &global_ops;
2512647bcd03SSteven Rostedt 
2513647bcd03SSteven Rostedt 	ret = seq_open(file, &show_ftrace_seq_ops);
2514647bcd03SSteven Rostedt 	if (!ret) {
2515647bcd03SSteven Rostedt 		struct seq_file *m = file->private_data;
2516647bcd03SSteven Rostedt 
2517647bcd03SSteven Rostedt 		m->private = iter;
2518647bcd03SSteven Rostedt 	} else {
2519647bcd03SSteven Rostedt 		kfree(iter);
2520647bcd03SSteven Rostedt 	}
2521647bcd03SSteven Rostedt 
2522647bcd03SSteven Rostedt 	return ret;
2523647bcd03SSteven Rostedt }
2524647bcd03SSteven Rostedt 
25251cf41dd7SSteven Rostedt static void ftrace_filter_reset(struct ftrace_hash *hash)
25265072c59fSSteven Rostedt {
252752baf119SSteven Rostedt 	mutex_lock(&ftrace_lock);
25281cf41dd7SSteven Rostedt 	ftrace_hash_clear(hash);
252952baf119SSteven Rostedt 	mutex_unlock(&ftrace_lock);
25305072c59fSSteven Rostedt }
25315072c59fSSteven Rostedt 
2532fc13cb0cSSteven Rostedt /**
2533fc13cb0cSSteven Rostedt  * ftrace_regex_open - initialize function tracer filter files
2534fc13cb0cSSteven Rostedt  * @ops: The ftrace_ops that hold the hash filters
2535fc13cb0cSSteven Rostedt  * @flag: The type of filter to process
2536fc13cb0cSSteven Rostedt  * @inode: The inode, usually passed in to your open routine
2537fc13cb0cSSteven Rostedt  * @file: The file, usually passed in to your open routine
2538fc13cb0cSSteven Rostedt  *
2539fc13cb0cSSteven Rostedt  * ftrace_regex_open() initializes the filter files for the
2540fc13cb0cSSteven Rostedt  * @ops. Depending on @flag it may process the filter hash or
2541fc13cb0cSSteven Rostedt  * the notrace hash of @ops. With this called from the open
2542fc13cb0cSSteven Rostedt  * routine, you can use ftrace_filter_write() for the write
2543fc13cb0cSSteven Rostedt  * routine if @flag has FTRACE_ITER_FILTER set, or
2544fc13cb0cSSteven Rostedt  * ftrace_notrace_write() if @flag has FTRACE_ITER_NOTRACE set.
2545fc13cb0cSSteven Rostedt  * ftrace_regex_lseek() should be used as the lseek routine, and
2546fc13cb0cSSteven Rostedt  * release must call ftrace_regex_release().
2547fc13cb0cSSteven Rostedt  */
2548fc13cb0cSSteven Rostedt int
2549f45948e8SSteven Rostedt ftrace_regex_open(struct ftrace_ops *ops, int flag,
25501cf41dd7SSteven Rostedt 		  struct inode *inode, struct file *file)
25515072c59fSSteven Rostedt {
25525072c59fSSteven Rostedt 	struct ftrace_iterator *iter;
2553f45948e8SSteven Rostedt 	struct ftrace_hash *hash;
25545072c59fSSteven Rostedt 	int ret = 0;
25555072c59fSSteven Rostedt 
25564eebcc81SSteven Rostedt 	if (unlikely(ftrace_disabled))
25574eebcc81SSteven Rostedt 		return -ENODEV;
25584eebcc81SSteven Rostedt 
25595072c59fSSteven Rostedt 	iter = kzalloc(sizeof(*iter), GFP_KERNEL);
25605072c59fSSteven Rostedt 	if (!iter)
25615072c59fSSteven Rostedt 		return -ENOMEM;
25625072c59fSSteven Rostedt 
2563689fd8b6S[email protected] 	if (trace_parser_get_init(&iter->parser, FTRACE_BUFF_MAX)) {
2564689fd8b6S[email protected] 		kfree(iter);
2565689fd8b6S[email protected] 		return -ENOMEM;
2566689fd8b6S[email protected] 	}
2567689fd8b6S[email protected] 
2568f45948e8SSteven Rostedt 	if (flag & FTRACE_ITER_NOTRACE)
2569f45948e8SSteven Rostedt 		hash = ops->notrace_hash;
2570f45948e8SSteven Rostedt 	else
2571f45948e8SSteven Rostedt 		hash = ops->filter_hash;
2572f45948e8SSteven Rostedt 
257333dc9b12SSteven Rostedt 	iter->ops = ops;
257433dc9b12SSteven Rostedt 	iter->flags = flag;
257533dc9b12SSteven Rostedt 
257633dc9b12SSteven Rostedt 	if (file->f_mode & FMODE_WRITE) {
257733dc9b12SSteven Rostedt 		mutex_lock(&ftrace_lock);
257833dc9b12SSteven Rostedt 		iter->hash = alloc_and_copy_ftrace_hash(FTRACE_HASH_DEFAULT_BITS, hash);
257933dc9b12SSteven Rostedt 		mutex_unlock(&ftrace_lock);
258033dc9b12SSteven Rostedt 
258133dc9b12SSteven Rostedt 		if (!iter->hash) {
258233dc9b12SSteven Rostedt 			trace_parser_put(&iter->parser);
258333dc9b12SSteven Rostedt 			kfree(iter);
258433dc9b12SSteven Rostedt 			return -ENOMEM;
258533dc9b12SSteven Rostedt 		}
258633dc9b12SSteven Rostedt 	}
25871cf41dd7SSteven Rostedt 
258841c52c0dSSteven Rostedt 	mutex_lock(&ftrace_regex_lock);
258933dc9b12SSteven Rostedt 
25905072c59fSSteven Rostedt 	if ((file->f_mode & FMODE_WRITE) &&
25918650ae32SSteven Rostedt 	    (file->f_flags & O_TRUNC))
259233dc9b12SSteven Rostedt 		ftrace_filter_reset(iter->hash);
25935072c59fSSteven Rostedt 
25945072c59fSSteven Rostedt 	if (file->f_mode & FMODE_READ) {
25955072c59fSSteven Rostedt 		iter->pg = ftrace_pages_start;
25965072c59fSSteven Rostedt 
25975072c59fSSteven Rostedt 		ret = seq_open(file, &show_ftrace_seq_ops);
25985072c59fSSteven Rostedt 		if (!ret) {
25995072c59fSSteven Rostedt 			struct seq_file *m = file->private_data;
26005072c59fSSteven Rostedt 			m->private = iter;
260179fe249cSLi Zefan 		} else {
260233dc9b12SSteven Rostedt 			/* Failed */
260333dc9b12SSteven Rostedt 			free_ftrace_hash(iter->hash);
260479fe249cSLi Zefan 			trace_parser_put(&iter->parser);
26055072c59fSSteven Rostedt 			kfree(iter);
260679fe249cSLi Zefan 		}
26075072c59fSSteven Rostedt 	} else
26085072c59fSSteven Rostedt 		file->private_data = iter;
260941c52c0dSSteven Rostedt 	mutex_unlock(&ftrace_regex_lock);
26105072c59fSSteven Rostedt 
26115072c59fSSteven Rostedt 	return ret;
26125072c59fSSteven Rostedt }
26135072c59fSSteven Rostedt 
261441c52c0dSSteven Rostedt static int
261541c52c0dSSteven Rostedt ftrace_filter_open(struct inode *inode, struct file *file)
261641c52c0dSSteven Rostedt {
261769a3083cSSteven Rostedt 	return ftrace_regex_open(&global_ops,
261869a3083cSSteven Rostedt 			FTRACE_ITER_FILTER | FTRACE_ITER_DO_HASH,
26191cf41dd7SSteven Rostedt 			inode, file);
262041c52c0dSSteven Rostedt }
262141c52c0dSSteven Rostedt 
262241c52c0dSSteven Rostedt static int
262341c52c0dSSteven Rostedt ftrace_notrace_open(struct inode *inode, struct file *file)
262441c52c0dSSteven Rostedt {
2625f45948e8SSteven Rostedt 	return ftrace_regex_open(&global_ops, FTRACE_ITER_NOTRACE,
26261cf41dd7SSteven Rostedt 				 inode, file);
262741c52c0dSSteven Rostedt }
262841c52c0dSSteven Rostedt 
2629fc13cb0cSSteven Rostedt loff_t
263041c52c0dSSteven Rostedt ftrace_regex_lseek(struct file *file, loff_t offset, int origin)
26315072c59fSSteven Rostedt {
26325072c59fSSteven Rostedt 	loff_t ret;
26335072c59fSSteven Rostedt 
26345072c59fSSteven Rostedt 	if (file->f_mode & FMODE_READ)
26355072c59fSSteven Rostedt 		ret = seq_lseek(file, offset, origin);
26365072c59fSSteven Rostedt 	else
26375072c59fSSteven Rostedt 		file->f_pos = ret = 1;
26385072c59fSSteven Rostedt 
26395072c59fSSteven Rostedt 	return ret;
26405072c59fSSteven Rostedt }
26415072c59fSSteven Rostedt 
264264e7c440SSteven Rostedt static int ftrace_match(char *str, char *regex, int len, int type)
26439f4801e3SSteven Rostedt {
26449f4801e3SSteven Rostedt 	int matched = 0;
2645751e9983SLi Zefan 	int slen;
26469f4801e3SSteven Rostedt 
26479f4801e3SSteven Rostedt 	switch (type) {
26489f4801e3SSteven Rostedt 	case MATCH_FULL:
26499f4801e3SSteven Rostedt 		if (strcmp(str, regex) == 0)
26509f4801e3SSteven Rostedt 			matched = 1;
26519f4801e3SSteven Rostedt 		break;
26529f4801e3SSteven Rostedt 	case MATCH_FRONT_ONLY:
26539f4801e3SSteven Rostedt 		if (strncmp(str, regex, len) == 0)
26549f4801e3SSteven Rostedt 			matched = 1;
26559f4801e3SSteven Rostedt 		break;
26569f4801e3SSteven Rostedt 	case MATCH_MIDDLE_ONLY:
26579f4801e3SSteven Rostedt 		if (strstr(str, regex))
26589f4801e3SSteven Rostedt 			matched = 1;
26599f4801e3SSteven Rostedt 		break;
26609f4801e3SSteven Rostedt 	case MATCH_END_ONLY:
2661751e9983SLi Zefan 		slen = strlen(str);
2662751e9983SLi Zefan 		if (slen >= len && memcmp(str + slen - len, regex, len) == 0)
26639f4801e3SSteven Rostedt 			matched = 1;
26649f4801e3SSteven Rostedt 		break;
26659f4801e3SSteven Rostedt 	}
26669f4801e3SSteven Rostedt 
26679f4801e3SSteven Rostedt 	return matched;
26689f4801e3SSteven Rostedt }
26699f4801e3SSteven Rostedt 
2670b448c4e3SSteven Rostedt static int
26711cf41dd7SSteven Rostedt enter_record(struct ftrace_hash *hash, struct dyn_ftrace *rec, int not)
267264e7c440SSteven Rostedt {
2673b448c4e3SSteven Rostedt 	struct ftrace_func_entry *entry;
2674b448c4e3SSteven Rostedt 	int ret = 0;
2675b448c4e3SSteven Rostedt 
26761cf41dd7SSteven Rostedt 	entry = ftrace_lookup_ip(hash, rec->ip);
2677b448c4e3SSteven Rostedt 	if (not) {
2678b448c4e3SSteven Rostedt 		/* Do nothing if it doesn't exist */
2679b448c4e3SSteven Rostedt 		if (!entry)
2680b448c4e3SSteven Rostedt 			return 0;
2681b448c4e3SSteven Rostedt 
268233dc9b12SSteven Rostedt 		free_hash_entry(hash, entry);
2683b448c4e3SSteven Rostedt 	} else {
2684b448c4e3SSteven Rostedt 		/* Do nothing if it exists */
2685b448c4e3SSteven Rostedt 		if (entry)
2686b448c4e3SSteven Rostedt 			return 0;
2687b448c4e3SSteven Rostedt 
2688b448c4e3SSteven Rostedt 		ret = add_hash_entry(hash, rec->ip);
2689b448c4e3SSteven Rostedt 	}
2690b448c4e3SSteven Rostedt 	return ret;
2691996e87beSSteven Rostedt }
2692996e87beSSteven Rostedt 
269364e7c440SSteven Rostedt static int
2694b9df92d2SSteven Rostedt ftrace_match_record(struct dyn_ftrace *rec, char *mod,
2695b9df92d2SSteven Rostedt 		    char *regex, int len, int type)
269664e7c440SSteven Rostedt {
269764e7c440SSteven Rostedt 	char str[KSYM_SYMBOL_LEN];
2698b9df92d2SSteven Rostedt 	char *modname;
269964e7c440SSteven Rostedt 
2700b9df92d2SSteven Rostedt 	kallsyms_lookup(rec->ip, NULL, NULL, &modname, str);
2701b9df92d2SSteven Rostedt 
2702b9df92d2SSteven Rostedt 	if (mod) {
2703b9df92d2SSteven Rostedt 		/* module lookup requires matching the module */
2704b9df92d2SSteven Rostedt 		if (!modname || strcmp(modname, mod))
2705b9df92d2SSteven Rostedt 			return 0;
2706b9df92d2SSteven Rostedt 
2707b9df92d2SSteven Rostedt 		/* blank search means to match all funcs in the mod */
2708b9df92d2SSteven Rostedt 		if (!len)
2709b9df92d2SSteven Rostedt 			return 1;
2710b9df92d2SSteven Rostedt 	}
2711b9df92d2SSteven Rostedt 
271264e7c440SSteven Rostedt 	return ftrace_match(str, regex, len, type);
271364e7c440SSteven Rostedt }
271464e7c440SSteven Rostedt 
27151cf41dd7SSteven Rostedt static int
27161cf41dd7SSteven Rostedt match_records(struct ftrace_hash *hash, char *buff,
27171cf41dd7SSteven Rostedt 	      int len, char *mod, int not)
27189f4801e3SSteven Rostedt {
2719b9df92d2SSteven Rostedt 	unsigned search_len = 0;
27209f4801e3SSteven Rostedt 	struct ftrace_page *pg;
27219f4801e3SSteven Rostedt 	struct dyn_ftrace *rec;
2722b9df92d2SSteven Rostedt 	int type = MATCH_FULL;
2723b9df92d2SSteven Rostedt 	char *search = buff;
2724311d16daSLi Zefan 	int found = 0;
2725b448c4e3SSteven Rostedt 	int ret;
27269f4801e3SSteven Rostedt 
2727b9df92d2SSteven Rostedt 	if (len) {
27283f6fe06dSFrederic Weisbecker 		type = filter_parse_regex(buff, len, &search, &not);
27299f4801e3SSteven Rostedt 		search_len = strlen(search);
2730b9df92d2SSteven Rostedt 	}
2731b9df92d2SSteven Rostedt 
273252baf119SSteven Rostedt 	mutex_lock(&ftrace_lock);
2733b9df92d2SSteven Rostedt 
2734b9df92d2SSteven Rostedt 	if (unlikely(ftrace_disabled))
2735b9df92d2SSteven Rostedt 		goto out_unlock;
2736b9df92d2SSteven Rostedt 
2737265c831cSSteven Rostedt 	do_for_each_ftrace_rec(pg, rec) {
2738b9df92d2SSteven Rostedt 		if (ftrace_match_record(rec, mod, search, search_len, type)) {
27391cf41dd7SSteven Rostedt 			ret = enter_record(hash, rec, not);
2740b448c4e3SSteven Rostedt 			if (ret < 0) {
2741b448c4e3SSteven Rostedt 				found = ret;
2742b448c4e3SSteven Rostedt 				goto out_unlock;
2743b448c4e3SSteven Rostedt 			}
2744311d16daSLi Zefan 			found = 1;
27455072c59fSSteven Rostedt 		}
2746265c831cSSteven Rostedt 	} while_for_each_ftrace_rec();
2747b9df92d2SSteven Rostedt  out_unlock:
274852baf119SSteven Rostedt 	mutex_unlock(&ftrace_lock);
2749311d16daSLi Zefan 
2750311d16daSLi Zefan 	return found;
27515072c59fSSteven Rostedt }
27525072c59fSSteven Rostedt 
275364e7c440SSteven Rostedt static int
27541cf41dd7SSteven Rostedt ftrace_match_records(struct ftrace_hash *hash, char *buff, int len)
275564e7c440SSteven Rostedt {
27561cf41dd7SSteven Rostedt 	return match_records(hash, buff, len, NULL, 0);
275764e7c440SSteven Rostedt }
275864e7c440SSteven Rostedt 
27591cf41dd7SSteven Rostedt static int
27601cf41dd7SSteven Rostedt ftrace_match_module_records(struct ftrace_hash *hash, char *buff, char *mod)
276164e7c440SSteven Rostedt {
276264e7c440SSteven Rostedt 	int not = 0;
27636a24a244SSteven Rostedt 
276464e7c440SSteven Rostedt 	/* blank or '*' mean the same */
276564e7c440SSteven Rostedt 	if (strcmp(buff, "*") == 0)
276664e7c440SSteven Rostedt 		buff[0] = 0;
276764e7c440SSteven Rostedt 
276864e7c440SSteven Rostedt 	/* handle the case of 'dont filter this module' */
276964e7c440SSteven Rostedt 	if (strcmp(buff, "!") == 0 || strcmp(buff, "!*") == 0) {
277064e7c440SSteven Rostedt 		buff[0] = 0;
277164e7c440SSteven Rostedt 		not = 1;
277264e7c440SSteven Rostedt 	}
277364e7c440SSteven Rostedt 
27741cf41dd7SSteven Rostedt 	return match_records(hash, buff, strlen(buff), mod, not);
277564e7c440SSteven Rostedt }
277664e7c440SSteven Rostedt 
2777f6180773SSteven Rostedt /*
2778f6180773SSteven Rostedt  * We register the module command as a template to show others how
2779f6180773SSteven Rostedt  * to register the a command as well.
2780f6180773SSteven Rostedt  */
2781f6180773SSteven Rostedt 
2782f6180773SSteven Rostedt static int
278343dd61c9SSteven Rostedt ftrace_mod_callback(struct ftrace_hash *hash,
278443dd61c9SSteven Rostedt 		    char *func, char *cmd, char *param, int enable)
2785f6180773SSteven Rostedt {
2786f6180773SSteven Rostedt 	char *mod;
2787b448c4e3SSteven Rostedt 	int ret = -EINVAL;
2788f6180773SSteven Rostedt 
2789f6180773SSteven Rostedt 	/*
2790f6180773SSteven Rostedt 	 * cmd == 'mod' because we only registered this func
2791f6180773SSteven Rostedt 	 * for the 'mod' ftrace_func_command.
2792f6180773SSteven Rostedt 	 * But if you register one func with multiple commands,
2793f6180773SSteven Rostedt 	 * you can tell which command was used by the cmd
2794f6180773SSteven Rostedt 	 * parameter.
2795f6180773SSteven Rostedt 	 */
2796f6180773SSteven Rostedt 
2797f6180773SSteven Rostedt 	/* we must have a module name */
2798f6180773SSteven Rostedt 	if (!param)
2799b448c4e3SSteven Rostedt 		return ret;
2800f6180773SSteven Rostedt 
2801f6180773SSteven Rostedt 	mod = strsep(&param, ":");
2802f6180773SSteven Rostedt 	if (!strlen(mod))
2803b448c4e3SSteven Rostedt 		return ret;
2804f6180773SSteven Rostedt 
28051cf41dd7SSteven Rostedt 	ret = ftrace_match_module_records(hash, func, mod);
2806b448c4e3SSteven Rostedt 	if (!ret)
2807b448c4e3SSteven Rostedt 		ret = -EINVAL;
2808b448c4e3SSteven Rostedt 	if (ret < 0)
2809b448c4e3SSteven Rostedt 		return ret;
2810b448c4e3SSteven Rostedt 
2811f6180773SSteven Rostedt 	return 0;
2812f6180773SSteven Rostedt }
2813f6180773SSteven Rostedt 
2814f6180773SSteven Rostedt static struct ftrace_func_command ftrace_mod_cmd = {
2815f6180773SSteven Rostedt 	.name			= "mod",
2816f6180773SSteven Rostedt 	.func			= ftrace_mod_callback,
2817f6180773SSteven Rostedt };
2818f6180773SSteven Rostedt 
2819f6180773SSteven Rostedt static int __init ftrace_mod_cmd_init(void)
2820f6180773SSteven Rostedt {
2821f6180773SSteven Rostedt 	return register_ftrace_command(&ftrace_mod_cmd);
2822f6180773SSteven Rostedt }
2823f6180773SSteven Rostedt device_initcall(ftrace_mod_cmd_init);
2824f6180773SSteven Rostedt 
282559df055fSSteven Rostedt static void
2826b6887d79SSteven Rostedt function_trace_probe_call(unsigned long ip, unsigned long parent_ip)
282759df055fSSteven Rostedt {
2828b6887d79SSteven Rostedt 	struct ftrace_func_probe *entry;
282959df055fSSteven Rostedt 	struct hlist_head *hhd;
283059df055fSSteven Rostedt 	struct hlist_node *n;
283159df055fSSteven Rostedt 	unsigned long key;
283259df055fSSteven Rostedt 
283359df055fSSteven Rostedt 	key = hash_long(ip, FTRACE_HASH_BITS);
283459df055fSSteven Rostedt 
283559df055fSSteven Rostedt 	hhd = &ftrace_func_hash[key];
283659df055fSSteven Rostedt 
283759df055fSSteven Rostedt 	if (hlist_empty(hhd))
283859df055fSSteven Rostedt 		return;
283959df055fSSteven Rostedt 
284059df055fSSteven Rostedt 	/*
284159df055fSSteven Rostedt 	 * Disable preemption for these calls to prevent a RCU grace
284259df055fSSteven Rostedt 	 * period. This syncs the hash iteration and freeing of items
284359df055fSSteven Rostedt 	 * on the hash. rcu_read_lock is too dangerous here.
284459df055fSSteven Rostedt 	 */
28455168ae50SSteven Rostedt 	preempt_disable_notrace();
284659df055fSSteven Rostedt 	hlist_for_each_entry_rcu(entry, n, hhd, node) {
284759df055fSSteven Rostedt 		if (entry->ip == ip)
284859df055fSSteven Rostedt 			entry->ops->func(ip, parent_ip, &entry->data);
284959df055fSSteven Rostedt 	}
28505168ae50SSteven Rostedt 	preempt_enable_notrace();
285159df055fSSteven Rostedt }
285259df055fSSteven Rostedt 
2853b6887d79SSteven Rostedt static struct ftrace_ops trace_probe_ops __read_mostly =
285459df055fSSteven Rostedt {
2855b6887d79SSteven Rostedt 	.func		= function_trace_probe_call,
285659df055fSSteven Rostedt };
285759df055fSSteven Rostedt 
2858b6887d79SSteven Rostedt static int ftrace_probe_registered;
285959df055fSSteven Rostedt 
2860b6887d79SSteven Rostedt static void __enable_ftrace_function_probe(void)
286159df055fSSteven Rostedt {
2862b848914cSSteven Rostedt 	int ret;
286359df055fSSteven Rostedt 	int i;
286459df055fSSteven Rostedt 
2865b6887d79SSteven Rostedt 	if (ftrace_probe_registered)
286659df055fSSteven Rostedt 		return;
286759df055fSSteven Rostedt 
286859df055fSSteven Rostedt 	for (i = 0; i < FTRACE_FUNC_HASHSIZE; i++) {
286959df055fSSteven Rostedt 		struct hlist_head *hhd = &ftrace_func_hash[i];
287059df055fSSteven Rostedt 		if (hhd->first)
287159df055fSSteven Rostedt 			break;
287259df055fSSteven Rostedt 	}
287359df055fSSteven Rostedt 	/* Nothing registered? */
287459df055fSSteven Rostedt 	if (i == FTRACE_FUNC_HASHSIZE)
287559df055fSSteven Rostedt 		return;
287659df055fSSteven Rostedt 
2877b848914cSSteven Rostedt 	ret = __register_ftrace_function(&trace_probe_ops);
2878b848914cSSteven Rostedt 	if (!ret)
2879a1cd6173SSteven Rostedt 		ret = ftrace_startup(&trace_probe_ops, 0);
2880b848914cSSteven Rostedt 
2881b6887d79SSteven Rostedt 	ftrace_probe_registered = 1;
288259df055fSSteven Rostedt }
288359df055fSSteven Rostedt 
2884b6887d79SSteven Rostedt static void __disable_ftrace_function_probe(void)
288559df055fSSteven Rostedt {
2886b848914cSSteven Rostedt 	int ret;
288759df055fSSteven Rostedt 	int i;
288859df055fSSteven Rostedt 
2889b6887d79SSteven Rostedt 	if (!ftrace_probe_registered)
289059df055fSSteven Rostedt 		return;
289159df055fSSteven Rostedt 
289259df055fSSteven Rostedt 	for (i = 0; i < FTRACE_FUNC_HASHSIZE; i++) {
289359df055fSSteven Rostedt 		struct hlist_head *hhd = &ftrace_func_hash[i];
289459df055fSSteven Rostedt 		if (hhd->first)
289559df055fSSteven Rostedt 			return;
289659df055fSSteven Rostedt 	}
289759df055fSSteven Rostedt 
289859df055fSSteven Rostedt 	/* no more funcs left */
2899b848914cSSteven Rostedt 	ret = __unregister_ftrace_function(&trace_probe_ops);
2900b848914cSSteven Rostedt 	if (!ret)
2901b848914cSSteven Rostedt 		ftrace_shutdown(&trace_probe_ops, 0);
2902b848914cSSteven Rostedt 
2903b6887d79SSteven Rostedt 	ftrace_probe_registered = 0;
290459df055fSSteven Rostedt }
290559df055fSSteven Rostedt 
290659df055fSSteven Rostedt 
290759df055fSSteven Rostedt static void ftrace_free_entry_rcu(struct rcu_head *rhp)
290859df055fSSteven Rostedt {
2909b6887d79SSteven Rostedt 	struct ftrace_func_probe *entry =
2910b6887d79SSteven Rostedt 		container_of(rhp, struct ftrace_func_probe, rcu);
291159df055fSSteven Rostedt 
291259df055fSSteven Rostedt 	if (entry->ops->free)
291359df055fSSteven Rostedt 		entry->ops->free(&entry->data);
291459df055fSSteven Rostedt 	kfree(entry);
291559df055fSSteven Rostedt }
291659df055fSSteven Rostedt 
291759df055fSSteven Rostedt 
291859df055fSSteven Rostedt int
2919b6887d79SSteven Rostedt register_ftrace_function_probe(char *glob, struct ftrace_probe_ops *ops,
292059df055fSSteven Rostedt 			      void *data)
292159df055fSSteven Rostedt {
2922b6887d79SSteven Rostedt 	struct ftrace_func_probe *entry;
292359df055fSSteven Rostedt 	struct ftrace_page *pg;
292459df055fSSteven Rostedt 	struct dyn_ftrace *rec;
292559df055fSSteven Rostedt 	int type, len, not;
29266a24a244SSteven Rostedt 	unsigned long key;
292759df055fSSteven Rostedt 	int count = 0;
292859df055fSSteven Rostedt 	char *search;
292959df055fSSteven Rostedt 
29303f6fe06dSFrederic Weisbecker 	type = filter_parse_regex(glob, strlen(glob), &search, &not);
293159df055fSSteven Rostedt 	len = strlen(search);
293259df055fSSteven Rostedt 
2933b6887d79SSteven Rostedt 	/* we do not support '!' for function probes */
293459df055fSSteven Rostedt 	if (WARN_ON(not))
293559df055fSSteven Rostedt 		return -EINVAL;
293659df055fSSteven Rostedt 
293759df055fSSteven Rostedt 	mutex_lock(&ftrace_lock);
293859df055fSSteven Rostedt 
293945a4a237SSteven Rostedt 	if (unlikely(ftrace_disabled))
294045a4a237SSteven Rostedt 		goto out_unlock;
294145a4a237SSteven Rostedt 
294259df055fSSteven Rostedt 	do_for_each_ftrace_rec(pg, rec) {
294359df055fSSteven Rostedt 
2944b9df92d2SSteven Rostedt 		if (!ftrace_match_record(rec, NULL, search, len, type))
294559df055fSSteven Rostedt 			continue;
294659df055fSSteven Rostedt 
294759df055fSSteven Rostedt 		entry = kmalloc(sizeof(*entry), GFP_KERNEL);
294859df055fSSteven Rostedt 		if (!entry) {
2949b6887d79SSteven Rostedt 			/* If we did not process any, then return error */
295059df055fSSteven Rostedt 			if (!count)
295159df055fSSteven Rostedt 				count = -ENOMEM;
295259df055fSSteven Rostedt 			goto out_unlock;
295359df055fSSteven Rostedt 		}
295459df055fSSteven Rostedt 
295559df055fSSteven Rostedt 		count++;
295659df055fSSteven Rostedt 
295759df055fSSteven Rostedt 		entry->data = data;
295859df055fSSteven Rostedt 
295959df055fSSteven Rostedt 		/*
296059df055fSSteven Rostedt 		 * The caller might want to do something special
296159df055fSSteven Rostedt 		 * for each function we find. We call the callback
296259df055fSSteven Rostedt 		 * to give the caller an opportunity to do so.
296359df055fSSteven Rostedt 		 */
296459df055fSSteven Rostedt 		if (ops->callback) {
296559df055fSSteven Rostedt 			if (ops->callback(rec->ip, &entry->data) < 0) {
296659df055fSSteven Rostedt 				/* caller does not like this func */
296759df055fSSteven Rostedt 				kfree(entry);
296859df055fSSteven Rostedt 				continue;
296959df055fSSteven Rostedt 			}
297059df055fSSteven Rostedt 		}
297159df055fSSteven Rostedt 
297259df055fSSteven Rostedt 		entry->ops = ops;
297359df055fSSteven Rostedt 		entry->ip = rec->ip;
297459df055fSSteven Rostedt 
297559df055fSSteven Rostedt 		key = hash_long(entry->ip, FTRACE_HASH_BITS);
297659df055fSSteven Rostedt 		hlist_add_head_rcu(&entry->node, &ftrace_func_hash[key]);
297759df055fSSteven Rostedt 
297859df055fSSteven Rostedt 	} while_for_each_ftrace_rec();
2979b6887d79SSteven Rostedt 	__enable_ftrace_function_probe();
298059df055fSSteven Rostedt 
298159df055fSSteven Rostedt  out_unlock:
298259df055fSSteven Rostedt 	mutex_unlock(&ftrace_lock);
298359df055fSSteven Rostedt 
298459df055fSSteven Rostedt 	return count;
298559df055fSSteven Rostedt }
298659df055fSSteven Rostedt 
298759df055fSSteven Rostedt enum {
2988b6887d79SSteven Rostedt 	PROBE_TEST_FUNC		= 1,
2989b6887d79SSteven Rostedt 	PROBE_TEST_DATA		= 2
299059df055fSSteven Rostedt };
299159df055fSSteven Rostedt 
299259df055fSSteven Rostedt static void
2993b6887d79SSteven Rostedt __unregister_ftrace_function_probe(char *glob, struct ftrace_probe_ops *ops,
299459df055fSSteven Rostedt 				  void *data, int flags)
299559df055fSSteven Rostedt {
2996b6887d79SSteven Rostedt 	struct ftrace_func_probe *entry;
299759df055fSSteven Rostedt 	struct hlist_node *n, *tmp;
299859df055fSSteven Rostedt 	char str[KSYM_SYMBOL_LEN];
299959df055fSSteven Rostedt 	int type = MATCH_FULL;
300059df055fSSteven Rostedt 	int i, len = 0;
300159df055fSSteven Rostedt 	char *search;
300259df055fSSteven Rostedt 
3003b36461daSAtsushi Tsuji 	if (glob && (strcmp(glob, "*") == 0 || !strlen(glob)))
300459df055fSSteven Rostedt 		glob = NULL;
3005b36461daSAtsushi Tsuji 	else if (glob) {
300659df055fSSteven Rostedt 		int not;
300759df055fSSteven Rostedt 
30083f6fe06dSFrederic Weisbecker 		type = filter_parse_regex(glob, strlen(glob), &search, &not);
300959df055fSSteven Rostedt 		len = strlen(search);
301059df055fSSteven Rostedt 
3011b6887d79SSteven Rostedt 		/* we do not support '!' for function probes */
301259df055fSSteven Rostedt 		if (WARN_ON(not))
301359df055fSSteven Rostedt 			return;
301459df055fSSteven Rostedt 	}
301559df055fSSteven Rostedt 
301659df055fSSteven Rostedt 	mutex_lock(&ftrace_lock);
301759df055fSSteven Rostedt 	for (i = 0; i < FTRACE_FUNC_HASHSIZE; i++) {
301859df055fSSteven Rostedt 		struct hlist_head *hhd = &ftrace_func_hash[i];
301959df055fSSteven Rostedt 
302059df055fSSteven Rostedt 		hlist_for_each_entry_safe(entry, n, tmp, hhd, node) {
302159df055fSSteven Rostedt 
302259df055fSSteven Rostedt 			/* break up if statements for readability */
3023b6887d79SSteven Rostedt 			if ((flags & PROBE_TEST_FUNC) && entry->ops != ops)
302459df055fSSteven Rostedt 				continue;
302559df055fSSteven Rostedt 
3026b6887d79SSteven Rostedt 			if ((flags & PROBE_TEST_DATA) && entry->data != data)
302759df055fSSteven Rostedt 				continue;
302859df055fSSteven Rostedt 
302959df055fSSteven Rostedt 			/* do this last, since it is the most expensive */
303059df055fSSteven Rostedt 			if (glob) {
303159df055fSSteven Rostedt 				kallsyms_lookup(entry->ip, NULL, NULL,
303259df055fSSteven Rostedt 						NULL, str);
303359df055fSSteven Rostedt 				if (!ftrace_match(str, glob, len, type))
303459df055fSSteven Rostedt 					continue;
303559df055fSSteven Rostedt 			}
303659df055fSSteven Rostedt 
303759df055fSSteven Rostedt 			hlist_del(&entry->node);
303859df055fSSteven Rostedt 			call_rcu(&entry->rcu, ftrace_free_entry_rcu);
303959df055fSSteven Rostedt 		}
304059df055fSSteven Rostedt 	}
3041b6887d79SSteven Rostedt 	__disable_ftrace_function_probe();
304259df055fSSteven Rostedt 	mutex_unlock(&ftrace_lock);
304359df055fSSteven Rostedt }
304459df055fSSteven Rostedt 
304559df055fSSteven Rostedt void
3046b6887d79SSteven Rostedt unregister_ftrace_function_probe(char *glob, struct ftrace_probe_ops *ops,
304759df055fSSteven Rostedt 				void *data)
304859df055fSSteven Rostedt {
3049b6887d79SSteven Rostedt 	__unregister_ftrace_function_probe(glob, ops, data,
3050b6887d79SSteven Rostedt 					  PROBE_TEST_FUNC | PROBE_TEST_DATA);
305159df055fSSteven Rostedt }
305259df055fSSteven Rostedt 
305359df055fSSteven Rostedt void
3054b6887d79SSteven Rostedt unregister_ftrace_function_probe_func(char *glob, struct ftrace_probe_ops *ops)
305559df055fSSteven Rostedt {
3056b6887d79SSteven Rostedt 	__unregister_ftrace_function_probe(glob, ops, NULL, PROBE_TEST_FUNC);
305759df055fSSteven Rostedt }
305859df055fSSteven Rostedt 
3059b6887d79SSteven Rostedt void unregister_ftrace_function_probe_all(char *glob)
306059df055fSSteven Rostedt {
3061b6887d79SSteven Rostedt 	__unregister_ftrace_function_probe(glob, NULL, NULL, 0);
306259df055fSSteven Rostedt }
306359df055fSSteven Rostedt 
3064f6180773SSteven Rostedt static LIST_HEAD(ftrace_commands);
3065f6180773SSteven Rostedt static DEFINE_MUTEX(ftrace_cmd_mutex);
3066f6180773SSteven Rostedt 
3067f6180773SSteven Rostedt int register_ftrace_command(struct ftrace_func_command *cmd)
3068f6180773SSteven Rostedt {
3069f6180773SSteven Rostedt 	struct ftrace_func_command *p;
3070f6180773SSteven Rostedt 	int ret = 0;
3071f6180773SSteven Rostedt 
3072f6180773SSteven Rostedt 	mutex_lock(&ftrace_cmd_mutex);
3073f6180773SSteven Rostedt 	list_for_each_entry(p, &ftrace_commands, list) {
3074f6180773SSteven Rostedt 		if (strcmp(cmd->name, p->name) == 0) {
3075f6180773SSteven Rostedt 			ret = -EBUSY;
3076f6180773SSteven Rostedt 			goto out_unlock;
3077f6180773SSteven Rostedt 		}
3078f6180773SSteven Rostedt 	}
3079f6180773SSteven Rostedt 	list_add(&cmd->list, &ftrace_commands);
3080f6180773SSteven Rostedt  out_unlock:
3081f6180773SSteven Rostedt 	mutex_unlock(&ftrace_cmd_mutex);
3082f6180773SSteven Rostedt 
3083f6180773SSteven Rostedt 	return ret;
3084f6180773SSteven Rostedt }
3085f6180773SSteven Rostedt 
3086f6180773SSteven Rostedt int unregister_ftrace_command(struct ftrace_func_command *cmd)
3087f6180773SSteven Rostedt {
3088f6180773SSteven Rostedt 	struct ftrace_func_command *p, *n;
3089f6180773SSteven Rostedt 	int ret = -ENODEV;
3090f6180773SSteven Rostedt 
3091f6180773SSteven Rostedt 	mutex_lock(&ftrace_cmd_mutex);
3092f6180773SSteven Rostedt 	list_for_each_entry_safe(p, n, &ftrace_commands, list) {
3093f6180773SSteven Rostedt 		if (strcmp(cmd->name, p->name) == 0) {
3094f6180773SSteven Rostedt 			ret = 0;
3095f6180773SSteven Rostedt 			list_del_init(&p->list);
3096f6180773SSteven Rostedt 			goto out_unlock;
3097f6180773SSteven Rostedt 		}
3098f6180773SSteven Rostedt 	}
3099f6180773SSteven Rostedt  out_unlock:
3100f6180773SSteven Rostedt 	mutex_unlock(&ftrace_cmd_mutex);
3101f6180773SSteven Rostedt 
3102f6180773SSteven Rostedt 	return ret;
3103f6180773SSteven Rostedt }
3104f6180773SSteven Rostedt 
310533dc9b12SSteven Rostedt static int ftrace_process_regex(struct ftrace_hash *hash,
310633dc9b12SSteven Rostedt 				char *buff, int len, int enable)
310764e7c440SSteven Rostedt {
3108f6180773SSteven Rostedt 	char *func, *command, *next = buff;
31096a24a244SSteven Rostedt 	struct ftrace_func_command *p;
31100aff1c0cSGuoWen Li 	int ret = -EINVAL;
311164e7c440SSteven Rostedt 
311264e7c440SSteven Rostedt 	func = strsep(&next, ":");
311364e7c440SSteven Rostedt 
311464e7c440SSteven Rostedt 	if (!next) {
31151cf41dd7SSteven Rostedt 		ret = ftrace_match_records(hash, func, len);
3116b448c4e3SSteven Rostedt 		if (!ret)
3117b448c4e3SSteven Rostedt 			ret = -EINVAL;
3118b448c4e3SSteven Rostedt 		if (ret < 0)
3119311d16daSLi Zefan 			return ret;
3120b448c4e3SSteven Rostedt 		return 0;
312164e7c440SSteven Rostedt 	}
312264e7c440SSteven Rostedt 
3123f6180773SSteven Rostedt 	/* command found */
312464e7c440SSteven Rostedt 
312564e7c440SSteven Rostedt 	command = strsep(&next, ":");
312664e7c440SSteven Rostedt 
3127f6180773SSteven Rostedt 	mutex_lock(&ftrace_cmd_mutex);
3128f6180773SSteven Rostedt 	list_for_each_entry(p, &ftrace_commands, list) {
3129f6180773SSteven Rostedt 		if (strcmp(p->name, command) == 0) {
313043dd61c9SSteven Rostedt 			ret = p->func(hash, func, command, next, enable);
3131f6180773SSteven Rostedt 			goto out_unlock;
313264e7c440SSteven Rostedt 		}
3133f6180773SSteven Rostedt 	}
3134f6180773SSteven Rostedt  out_unlock:
3135f6180773SSteven Rostedt 	mutex_unlock(&ftrace_cmd_mutex);
313664e7c440SSteven Rostedt 
3137f6180773SSteven Rostedt 	return ret;
313864e7c440SSteven Rostedt }
313964e7c440SSteven Rostedt 
3140e309b41dSIngo Molnar static ssize_t
314141c52c0dSSteven Rostedt ftrace_regex_write(struct file *file, const char __user *ubuf,
314241c52c0dSSteven Rostedt 		   size_t cnt, loff_t *ppos, int enable)
31435072c59fSSteven Rostedt {
31445072c59fSSteven Rostedt 	struct ftrace_iterator *iter;
3145689fd8b6S[email protected] 	struct trace_parser *parser;
3146689fd8b6S[email protected] 	ssize_t ret, read;
31475072c59fSSteven Rostedt 
31484ba7978eSLi Zefan 	if (!cnt)
31495072c59fSSteven Rostedt 		return 0;
31505072c59fSSteven Rostedt 
315141c52c0dSSteven Rostedt 	mutex_lock(&ftrace_regex_lock);
31525072c59fSSteven Rostedt 
315345a4a237SSteven Rostedt 	ret = -ENODEV;
315445a4a237SSteven Rostedt 	if (unlikely(ftrace_disabled))
315545a4a237SSteven Rostedt 		goto out_unlock;
315645a4a237SSteven Rostedt 
31575072c59fSSteven Rostedt 	if (file->f_mode & FMODE_READ) {
31585072c59fSSteven Rostedt 		struct seq_file *m = file->private_data;
31595072c59fSSteven Rostedt 		iter = m->private;
31605072c59fSSteven Rostedt 	} else
31615072c59fSSteven Rostedt 		iter = file->private_data;
31625072c59fSSteven Rostedt 
3163689fd8b6S[email protected] 	parser = &iter->parser;
3164689fd8b6S[email protected] 	read = trace_get_user(parser, ubuf, cnt, ppos);
31655072c59fSSteven Rostedt 
31664ba7978eSLi Zefan 	if (read >= 0 && trace_parser_loaded(parser) &&
3167689fd8b6S[email protected] 	    !trace_parser_cont(parser)) {
316833dc9b12SSteven Rostedt 		ret = ftrace_process_regex(iter->hash, parser->buffer,
3169689fd8b6S[email protected] 					   parser->idx, enable);
3170313254a9SLi Zefan 		trace_parser_clear(parser);
31715072c59fSSteven Rostedt 		if (ret)
3172ed146b25SLi Zefan 			goto out_unlock;
31735072c59fSSteven Rostedt 	}
31745072c59fSSteven Rostedt 
31755072c59fSSteven Rostedt 	ret = read;
3176ed146b25SLi Zefan out_unlock:
317741c52c0dSSteven Rostedt 	mutex_unlock(&ftrace_regex_lock);
3178ed146b25SLi Zefan 
31795072c59fSSteven Rostedt 	return ret;
31805072c59fSSteven Rostedt }
31815072c59fSSteven Rostedt 
3182fc13cb0cSSteven Rostedt ssize_t
318341c52c0dSSteven Rostedt ftrace_filter_write(struct file *file, const char __user *ubuf,
318441c52c0dSSteven Rostedt 		    size_t cnt, loff_t *ppos)
318541c52c0dSSteven Rostedt {
318641c52c0dSSteven Rostedt 	return ftrace_regex_write(file, ubuf, cnt, ppos, 1);
318741c52c0dSSteven Rostedt }
318841c52c0dSSteven Rostedt 
3189fc13cb0cSSteven Rostedt ssize_t
319041c52c0dSSteven Rostedt ftrace_notrace_write(struct file *file, const char __user *ubuf,
319141c52c0dSSteven Rostedt 		     size_t cnt, loff_t *ppos)
319241c52c0dSSteven Rostedt {
319341c52c0dSSteven Rostedt 	return ftrace_regex_write(file, ubuf, cnt, ppos, 0);
319441c52c0dSSteven Rostedt }
319541c52c0dSSteven Rostedt 
319633dc9b12SSteven Rostedt static int
3197f45948e8SSteven Rostedt ftrace_set_regex(struct ftrace_ops *ops, unsigned char *buf, int len,
3198f45948e8SSteven Rostedt 		 int reset, int enable)
319941c52c0dSSteven Rostedt {
320033dc9b12SSteven Rostedt 	struct ftrace_hash **orig_hash;
3201f45948e8SSteven Rostedt 	struct ftrace_hash *hash;
320233dc9b12SSteven Rostedt 	int ret;
3203f45948e8SSteven Rostedt 
3204936e074bSSteven Rostedt 	/* All global ops uses the global ops filters */
3205936e074bSSteven Rostedt 	if (ops->flags & FTRACE_OPS_FL_GLOBAL)
3206936e074bSSteven Rostedt 		ops = &global_ops;
3207936e074bSSteven Rostedt 
320841c52c0dSSteven Rostedt 	if (unlikely(ftrace_disabled))
320933dc9b12SSteven Rostedt 		return -ENODEV;
321041c52c0dSSteven Rostedt 
3211f45948e8SSteven Rostedt 	if (enable)
321233dc9b12SSteven Rostedt 		orig_hash = &ops->filter_hash;
3213f45948e8SSteven Rostedt 	else
321433dc9b12SSteven Rostedt 		orig_hash = &ops->notrace_hash;
321533dc9b12SSteven Rostedt 
321633dc9b12SSteven Rostedt 	hash = alloc_and_copy_ftrace_hash(FTRACE_HASH_DEFAULT_BITS, *orig_hash);
321733dc9b12SSteven Rostedt 	if (!hash)
321833dc9b12SSteven Rostedt 		return -ENOMEM;
3219f45948e8SSteven Rostedt 
322041c52c0dSSteven Rostedt 	mutex_lock(&ftrace_regex_lock);
322141c52c0dSSteven Rostedt 	if (reset)
32221cf41dd7SSteven Rostedt 		ftrace_filter_reset(hash);
3223ac483c44SJiri Olsa 	if (buf && !ftrace_match_records(hash, buf, len)) {
3224ac483c44SJiri Olsa 		ret = -EINVAL;
3225ac483c44SJiri Olsa 		goto out_regex_unlock;
3226ac483c44SJiri Olsa 	}
322733dc9b12SSteven Rostedt 
322833dc9b12SSteven Rostedt 	mutex_lock(&ftrace_lock);
322941fb61c2SSteven Rostedt 	ret = ftrace_hash_move(ops, enable, orig_hash, hash);
3230072126f4SSteven Rostedt 	if (!ret && ops->flags & FTRACE_OPS_FL_ENABLED
3231072126f4SSteven Rostedt 	    && ftrace_enabled)
323230fb6aa7SJiri Olsa 		ftrace_run_update_code(FTRACE_UPDATE_CALLS);
3233072126f4SSteven Rostedt 
323433dc9b12SSteven Rostedt 	mutex_unlock(&ftrace_lock);
323533dc9b12SSteven Rostedt 
3236ac483c44SJiri Olsa  out_regex_unlock:
323741c52c0dSSteven Rostedt 	mutex_unlock(&ftrace_regex_lock);
323833dc9b12SSteven Rostedt 
323933dc9b12SSteven Rostedt 	free_ftrace_hash(hash);
324033dc9b12SSteven Rostedt 	return ret;
324141c52c0dSSteven Rostedt }
324241c52c0dSSteven Rostedt 
324377a2b37dSSteven Rostedt /**
324477a2b37dSSteven Rostedt  * ftrace_set_filter - set a function to filter on in ftrace
3245936e074bSSteven Rostedt  * @ops - the ops to set the filter with
324677a2b37dSSteven Rostedt  * @buf - the string that holds the function filter text.
324777a2b37dSSteven Rostedt  * @len - the length of the string.
324877a2b37dSSteven Rostedt  * @reset - non zero to reset all filters before applying this filter.
324977a2b37dSSteven Rostedt  *
325077a2b37dSSteven Rostedt  * Filters denote which functions should be enabled when tracing is enabled.
325177a2b37dSSteven Rostedt  * If @buf is NULL and reset is set, all functions will be enabled for tracing.
325277a2b37dSSteven Rostedt  */
3253ac483c44SJiri Olsa int ftrace_set_filter(struct ftrace_ops *ops, unsigned char *buf,
3254936e074bSSteven Rostedt 		       int len, int reset)
325577a2b37dSSteven Rostedt {
3256ac483c44SJiri Olsa 	return ftrace_set_regex(ops, buf, len, reset, 1);
325741c52c0dSSteven Rostedt }
3258936e074bSSteven Rostedt EXPORT_SYMBOL_GPL(ftrace_set_filter);
32594eebcc81SSteven Rostedt 
326041c52c0dSSteven Rostedt /**
326141c52c0dSSteven Rostedt  * ftrace_set_notrace - set a function to not trace in ftrace
3262936e074bSSteven Rostedt  * @ops - the ops to set the notrace filter with
326341c52c0dSSteven Rostedt  * @buf - the string that holds the function notrace text.
326441c52c0dSSteven Rostedt  * @len - the length of the string.
326541c52c0dSSteven Rostedt  * @reset - non zero to reset all filters before applying this filter.
326641c52c0dSSteven Rostedt  *
326741c52c0dSSteven Rostedt  * Notrace Filters denote which functions should not be enabled when tracing
326841c52c0dSSteven Rostedt  * is enabled. If @buf is NULL and reset is set, all functions will be enabled
326941c52c0dSSteven Rostedt  * for tracing.
327041c52c0dSSteven Rostedt  */
3271ac483c44SJiri Olsa int ftrace_set_notrace(struct ftrace_ops *ops, unsigned char *buf,
3272936e074bSSteven Rostedt 			int len, int reset)
3273936e074bSSteven Rostedt {
3274ac483c44SJiri Olsa 	return ftrace_set_regex(ops, buf, len, reset, 0);
3275936e074bSSteven Rostedt }
3276936e074bSSteven Rostedt EXPORT_SYMBOL_GPL(ftrace_set_notrace);
3277936e074bSSteven Rostedt /**
3278936e074bSSteven Rostedt  * ftrace_set_filter - set a function to filter on in ftrace
3279936e074bSSteven Rostedt  * @ops - the ops to set the filter with
3280936e074bSSteven Rostedt  * @buf - the string that holds the function filter text.
3281936e074bSSteven Rostedt  * @len - the length of the string.
3282936e074bSSteven Rostedt  * @reset - non zero to reset all filters before applying this filter.
3283936e074bSSteven Rostedt  *
3284936e074bSSteven Rostedt  * Filters denote which functions should be enabled when tracing is enabled.
3285936e074bSSteven Rostedt  * If @buf is NULL and reset is set, all functions will be enabled for tracing.
3286936e074bSSteven Rostedt  */
3287936e074bSSteven Rostedt void ftrace_set_global_filter(unsigned char *buf, int len, int reset)
3288936e074bSSteven Rostedt {
3289936e074bSSteven Rostedt 	ftrace_set_regex(&global_ops, buf, len, reset, 1);
3290936e074bSSteven Rostedt }
3291936e074bSSteven Rostedt EXPORT_SYMBOL_GPL(ftrace_set_global_filter);
3292936e074bSSteven Rostedt 
3293936e074bSSteven Rostedt /**
3294936e074bSSteven Rostedt  * ftrace_set_notrace - set a function to not trace in ftrace
3295936e074bSSteven Rostedt  * @ops - the ops to set the notrace filter with
3296936e074bSSteven Rostedt  * @buf - the string that holds the function notrace text.
3297936e074bSSteven Rostedt  * @len - the length of the string.
3298936e074bSSteven Rostedt  * @reset - non zero to reset all filters before applying this filter.
3299936e074bSSteven Rostedt  *
3300936e074bSSteven Rostedt  * Notrace Filters denote which functions should not be enabled when tracing
3301936e074bSSteven Rostedt  * is enabled. If @buf is NULL and reset is set, all functions will be enabled
3302936e074bSSteven Rostedt  * for tracing.
3303936e074bSSteven Rostedt  */
3304936e074bSSteven Rostedt void ftrace_set_global_notrace(unsigned char *buf, int len, int reset)
330541c52c0dSSteven Rostedt {
3306f45948e8SSteven Rostedt 	ftrace_set_regex(&global_ops, buf, len, reset, 0);
330777a2b37dSSteven Rostedt }
3308936e074bSSteven Rostedt EXPORT_SYMBOL_GPL(ftrace_set_global_notrace);
330977a2b37dSSteven Rostedt 
33102af15d6aSSteven Rostedt /*
33112af15d6aSSteven Rostedt  * command line interface to allow users to set filters on boot up.
33122af15d6aSSteven Rostedt  */
33132af15d6aSSteven Rostedt #define FTRACE_FILTER_SIZE		COMMAND_LINE_SIZE
33142af15d6aSSteven Rostedt static char ftrace_notrace_buf[FTRACE_FILTER_SIZE] __initdata;
33152af15d6aSSteven Rostedt static char ftrace_filter_buf[FTRACE_FILTER_SIZE] __initdata;
33162af15d6aSSteven Rostedt 
33172af15d6aSSteven Rostedt static int __init set_ftrace_notrace(char *str)
33182af15d6aSSteven Rostedt {
33192af15d6aSSteven Rostedt 	strncpy(ftrace_notrace_buf, str, FTRACE_FILTER_SIZE);
33202af15d6aSSteven Rostedt 	return 1;
33212af15d6aSSteven Rostedt }
33222af15d6aSSteven Rostedt __setup("ftrace_notrace=", set_ftrace_notrace);
33232af15d6aSSteven Rostedt 
33242af15d6aSSteven Rostedt static int __init set_ftrace_filter(char *str)
33252af15d6aSSteven Rostedt {
33262af15d6aSSteven Rostedt 	strncpy(ftrace_filter_buf, str, FTRACE_FILTER_SIZE);
33272af15d6aSSteven Rostedt 	return 1;
33282af15d6aSSteven Rostedt }
33292af15d6aSSteven Rostedt __setup("ftrace_filter=", set_ftrace_filter);
33302af15d6aSSteven Rostedt 
3331369bc18fSStefan Assmann #ifdef CONFIG_FUNCTION_GRAPH_TRACER
3332f6060f46SLai Jiangshan static char ftrace_graph_buf[FTRACE_FILTER_SIZE] __initdata;
3333801c29fdSSteven Rostedt static int ftrace_set_func(unsigned long *array, int *idx, char *buffer);
3334801c29fdSSteven Rostedt 
3335369bc18fSStefan Assmann static int __init set_graph_function(char *str)
3336369bc18fSStefan Assmann {
333706f43d66SFrederic Weisbecker 	strlcpy(ftrace_graph_buf, str, FTRACE_FILTER_SIZE);
3338369bc18fSStefan Assmann 	return 1;
3339369bc18fSStefan Assmann }
3340369bc18fSStefan Assmann __setup("ftrace_graph_filter=", set_graph_function);
3341369bc18fSStefan Assmann 
3342369bc18fSStefan Assmann static void __init set_ftrace_early_graph(char *buf)
3343369bc18fSStefan Assmann {
3344369bc18fSStefan Assmann 	int ret;
3345369bc18fSStefan Assmann 	char *func;
3346369bc18fSStefan Assmann 
3347369bc18fSStefan Assmann 	while (buf) {
3348369bc18fSStefan Assmann 		func = strsep(&buf, ",");
3349369bc18fSStefan Assmann 		/* we allow only one expression at a time */
3350369bc18fSStefan Assmann 		ret = ftrace_set_func(ftrace_graph_funcs, &ftrace_graph_count,
3351369bc18fSStefan Assmann 				      func);
3352369bc18fSStefan Assmann 		if (ret)
3353369bc18fSStefan Assmann 			printk(KERN_DEBUG "ftrace: function %s not "
3354369bc18fSStefan Assmann 					  "traceable\n", func);
3355369bc18fSStefan Assmann 	}
3356369bc18fSStefan Assmann }
3357369bc18fSStefan Assmann #endif /* CONFIG_FUNCTION_GRAPH_TRACER */
3358369bc18fSStefan Assmann 
33592a85a37fSSteven Rostedt void __init
33602a85a37fSSteven Rostedt ftrace_set_early_filter(struct ftrace_ops *ops, char *buf, int enable)
33612af15d6aSSteven Rostedt {
33622af15d6aSSteven Rostedt 	char *func;
33632af15d6aSSteven Rostedt 
33642af15d6aSSteven Rostedt 	while (buf) {
33652af15d6aSSteven Rostedt 		func = strsep(&buf, ",");
3366f45948e8SSteven Rostedt 		ftrace_set_regex(ops, func, strlen(func), 0, enable);
33672af15d6aSSteven Rostedt 	}
33682af15d6aSSteven Rostedt }
33692af15d6aSSteven Rostedt 
33702af15d6aSSteven Rostedt static void __init set_ftrace_early_filters(void)
33712af15d6aSSteven Rostedt {
33722af15d6aSSteven Rostedt 	if (ftrace_filter_buf[0])
33732a85a37fSSteven Rostedt 		ftrace_set_early_filter(&global_ops, ftrace_filter_buf, 1);
33742af15d6aSSteven Rostedt 	if (ftrace_notrace_buf[0])
33752a85a37fSSteven Rostedt 		ftrace_set_early_filter(&global_ops, ftrace_notrace_buf, 0);
3376369bc18fSStefan Assmann #ifdef CONFIG_FUNCTION_GRAPH_TRACER
3377369bc18fSStefan Assmann 	if (ftrace_graph_buf[0])
3378369bc18fSStefan Assmann 		set_ftrace_early_graph(ftrace_graph_buf);
3379369bc18fSStefan Assmann #endif /* CONFIG_FUNCTION_GRAPH_TRACER */
33802af15d6aSSteven Rostedt }
33812af15d6aSSteven Rostedt 
3382fc13cb0cSSteven Rostedt int ftrace_regex_release(struct inode *inode, struct file *file)
33835072c59fSSteven Rostedt {
33845072c59fSSteven Rostedt 	struct seq_file *m = (struct seq_file *)file->private_data;
33855072c59fSSteven Rostedt 	struct ftrace_iterator *iter;
338633dc9b12SSteven Rostedt 	struct ftrace_hash **orig_hash;
3387689fd8b6S[email protected] 	struct trace_parser *parser;
3388ed926f9bSSteven Rostedt 	int filter_hash;
338933dc9b12SSteven Rostedt 	int ret;
33905072c59fSSteven Rostedt 
339141c52c0dSSteven Rostedt 	mutex_lock(&ftrace_regex_lock);
33925072c59fSSteven Rostedt 	if (file->f_mode & FMODE_READ) {
33935072c59fSSteven Rostedt 		iter = m->private;
33945072c59fSSteven Rostedt 
33955072c59fSSteven Rostedt 		seq_release(inode, file);
33965072c59fSSteven Rostedt 	} else
33975072c59fSSteven Rostedt 		iter = file->private_data;
33985072c59fSSteven Rostedt 
3399689fd8b6S[email protected] 	parser = &iter->parser;
3400689fd8b6S[email protected] 	if (trace_parser_loaded(parser)) {
3401689fd8b6S[email protected] 		parser->buffer[parser->idx] = 0;
34021cf41dd7SSteven Rostedt 		ftrace_match_records(iter->hash, parser->buffer, parser->idx);
34035072c59fSSteven Rostedt 	}
34045072c59fSSteven Rostedt 
3405058e297dSSteven Rostedt 	trace_parser_put(parser);
3406058e297dSSteven Rostedt 
3407058e297dSSteven Rostedt 	if (file->f_mode & FMODE_WRITE) {
3408ed926f9bSSteven Rostedt 		filter_hash = !!(iter->flags & FTRACE_ITER_FILTER);
3409ed926f9bSSteven Rostedt 
3410ed926f9bSSteven Rostedt 		if (filter_hash)
341133dc9b12SSteven Rostedt 			orig_hash = &iter->ops->filter_hash;
3412ed926f9bSSteven Rostedt 		else
3413ed926f9bSSteven Rostedt 			orig_hash = &iter->ops->notrace_hash;
341433dc9b12SSteven Rostedt 
3415e6ea44e9SSteven Rostedt 		mutex_lock(&ftrace_lock);
341641fb61c2SSteven Rostedt 		ret = ftrace_hash_move(iter->ops, filter_hash,
341741fb61c2SSteven Rostedt 				       orig_hash, iter->hash);
341841fb61c2SSteven Rostedt 		if (!ret && (iter->ops->flags & FTRACE_OPS_FL_ENABLED)
3419ed926f9bSSteven Rostedt 		    && ftrace_enabled)
342030fb6aa7SJiri Olsa 			ftrace_run_update_code(FTRACE_UPDATE_CALLS);
342141fb61c2SSteven Rostedt 
3422e6ea44e9SSteven Rostedt 		mutex_unlock(&ftrace_lock);
3423058e297dSSteven Rostedt 	}
342433dc9b12SSteven Rostedt 	free_ftrace_hash(iter->hash);
342533dc9b12SSteven Rostedt 	kfree(iter);
3426689fd8b6S[email protected] 
342741c52c0dSSteven Rostedt 	mutex_unlock(&ftrace_regex_lock);
34285072c59fSSteven Rostedt 	return 0;
34295072c59fSSteven Rostedt }
34305072c59fSSteven Rostedt 
34315e2336a0SSteven Rostedt static const struct file_operations ftrace_avail_fops = {
34325072c59fSSteven Rostedt 	.open = ftrace_avail_open,
34335072c59fSSteven Rostedt 	.read = seq_read,
34345072c59fSSteven Rostedt 	.llseek = seq_lseek,
34353be04b47SLi Zefan 	.release = seq_release_private,
34365072c59fSSteven Rostedt };
34375072c59fSSteven Rostedt 
3438647bcd03SSteven Rostedt static const struct file_operations ftrace_enabled_fops = {
3439647bcd03SSteven Rostedt 	.open = ftrace_enabled_open,
3440647bcd03SSteven Rostedt 	.read = seq_read,
3441647bcd03SSteven Rostedt 	.llseek = seq_lseek,
3442647bcd03SSteven Rostedt 	.release = seq_release_private,
3443647bcd03SSteven Rostedt };
3444647bcd03SSteven Rostedt 
34455e2336a0SSteven Rostedt static const struct file_operations ftrace_filter_fops = {
34465072c59fSSteven Rostedt 	.open = ftrace_filter_open,
3447850a80cfSLai Jiangshan 	.read = seq_read,
34485072c59fSSteven Rostedt 	.write = ftrace_filter_write,
344998c4fd04SSteven Rostedt 	.llseek = ftrace_regex_lseek,
34501cf41dd7SSteven Rostedt 	.release = ftrace_regex_release,
34515072c59fSSteven Rostedt };
34525072c59fSSteven Rostedt 
34535e2336a0SSteven Rostedt static const struct file_operations ftrace_notrace_fops = {
345441c52c0dSSteven Rostedt 	.open = ftrace_notrace_open,
3455850a80cfSLai Jiangshan 	.read = seq_read,
345641c52c0dSSteven Rostedt 	.write = ftrace_notrace_write,
345741c52c0dSSteven Rostedt 	.llseek = ftrace_regex_lseek,
34581cf41dd7SSteven Rostedt 	.release = ftrace_regex_release,
345941c52c0dSSteven Rostedt };
346041c52c0dSSteven Rostedt 
3461ea4e2bc4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
3462ea4e2bc4SSteven Rostedt 
3463ea4e2bc4SSteven Rostedt static DEFINE_MUTEX(graph_lock);
3464ea4e2bc4SSteven Rostedt 
3465ea4e2bc4SSteven Rostedt int ftrace_graph_count;
3466c7c6b1feSLi Zefan int ftrace_graph_filter_enabled;
3467ea4e2bc4SSteven Rostedt unsigned long ftrace_graph_funcs[FTRACE_GRAPH_MAX_FUNCS] __read_mostly;
3468ea4e2bc4SSteven Rostedt 
3469ea4e2bc4SSteven Rostedt static void *
347085951842SLi Zefan __g_next(struct seq_file *m, loff_t *pos)
3471ea4e2bc4SSteven Rostedt {
347285951842SLi Zefan 	if (*pos >= ftrace_graph_count)
3473ea4e2bc4SSteven Rostedt 		return NULL;
3474a4ec5e0cSLi Zefan 	return &ftrace_graph_funcs[*pos];
347585951842SLi Zefan }
3476ea4e2bc4SSteven Rostedt 
347785951842SLi Zefan static void *
347885951842SLi Zefan g_next(struct seq_file *m, void *v, loff_t *pos)
347985951842SLi Zefan {
348085951842SLi Zefan 	(*pos)++;
348185951842SLi Zefan 	return __g_next(m, pos);
3482ea4e2bc4SSteven Rostedt }
3483ea4e2bc4SSteven Rostedt 
3484ea4e2bc4SSteven Rostedt static void *g_start(struct seq_file *m, loff_t *pos)
3485ea4e2bc4SSteven Rostedt {
3486ea4e2bc4SSteven Rostedt 	mutex_lock(&graph_lock);
3487ea4e2bc4SSteven Rostedt 
3488f9349a8fSFrederic Weisbecker 	/* Nothing, tell g_show to print all functions are enabled */
3489c7c6b1feSLi Zefan 	if (!ftrace_graph_filter_enabled && !*pos)
3490f9349a8fSFrederic Weisbecker 		return (void *)1;
3491f9349a8fSFrederic Weisbecker 
349285951842SLi Zefan 	return __g_next(m, pos);
3493ea4e2bc4SSteven Rostedt }
3494ea4e2bc4SSteven Rostedt 
3495ea4e2bc4SSteven Rostedt static void g_stop(struct seq_file *m, void *p)
3496ea4e2bc4SSteven Rostedt {
3497ea4e2bc4SSteven Rostedt 	mutex_unlock(&graph_lock);
3498ea4e2bc4SSteven Rostedt }
3499ea4e2bc4SSteven Rostedt 
3500ea4e2bc4SSteven Rostedt static int g_show(struct seq_file *m, void *v)
3501ea4e2bc4SSteven Rostedt {
3502ea4e2bc4SSteven Rostedt 	unsigned long *ptr = v;
3503ea4e2bc4SSteven Rostedt 
3504ea4e2bc4SSteven Rostedt 	if (!ptr)
3505ea4e2bc4SSteven Rostedt 		return 0;
3506ea4e2bc4SSteven Rostedt 
3507f9349a8fSFrederic Weisbecker 	if (ptr == (unsigned long *)1) {
3508f9349a8fSFrederic Weisbecker 		seq_printf(m, "#### all functions enabled ####\n");
3509f9349a8fSFrederic Weisbecker 		return 0;
3510f9349a8fSFrederic Weisbecker 	}
3511f9349a8fSFrederic Weisbecker 
3512b375a11aSSteven Rostedt 	seq_printf(m, "%ps\n", (void *)*ptr);
3513ea4e2bc4SSteven Rostedt 
3514ea4e2bc4SSteven Rostedt 	return 0;
3515ea4e2bc4SSteven Rostedt }
3516ea4e2bc4SSteven Rostedt 
351788e9d34cSJames Morris static const struct seq_operations ftrace_graph_seq_ops = {
3518ea4e2bc4SSteven Rostedt 	.start = g_start,
3519ea4e2bc4SSteven Rostedt 	.next = g_next,
3520ea4e2bc4SSteven Rostedt 	.stop = g_stop,
3521ea4e2bc4SSteven Rostedt 	.show = g_show,
3522ea4e2bc4SSteven Rostedt };
3523ea4e2bc4SSteven Rostedt 
3524ea4e2bc4SSteven Rostedt static int
3525ea4e2bc4SSteven Rostedt ftrace_graph_open(struct inode *inode, struct file *file)
3526ea4e2bc4SSteven Rostedt {
3527ea4e2bc4SSteven Rostedt 	int ret = 0;
3528ea4e2bc4SSteven Rostedt 
3529ea4e2bc4SSteven Rostedt 	if (unlikely(ftrace_disabled))
3530ea4e2bc4SSteven Rostedt 		return -ENODEV;
3531ea4e2bc4SSteven Rostedt 
3532ea4e2bc4SSteven Rostedt 	mutex_lock(&graph_lock);
3533ea4e2bc4SSteven Rostedt 	if ((file->f_mode & FMODE_WRITE) &&
35348650ae32SSteven Rostedt 	    (file->f_flags & O_TRUNC)) {
3535c7c6b1feSLi Zefan 		ftrace_graph_filter_enabled = 0;
3536ea4e2bc4SSteven Rostedt 		ftrace_graph_count = 0;
3537ea4e2bc4SSteven Rostedt 		memset(ftrace_graph_funcs, 0, sizeof(ftrace_graph_funcs));
3538ea4e2bc4SSteven Rostedt 	}
3539ea4e2bc4SSteven Rostedt 	mutex_unlock(&graph_lock);
3540ea4e2bc4SSteven Rostedt 
3541a4ec5e0cSLi Zefan 	if (file->f_mode & FMODE_READ)
3542a4ec5e0cSLi Zefan 		ret = seq_open(file, &ftrace_graph_seq_ops);
3543a4ec5e0cSLi Zefan 
3544ea4e2bc4SSteven Rostedt 	return ret;
3545ea4e2bc4SSteven Rostedt }
3546ea4e2bc4SSteven Rostedt 
3547ea4e2bc4SSteven Rostedt static int
354887827111SLi Zefan ftrace_graph_release(struct inode *inode, struct file *file)
354987827111SLi Zefan {
355087827111SLi Zefan 	if (file->f_mode & FMODE_READ)
355187827111SLi Zefan 		seq_release(inode, file);
355287827111SLi Zefan 	return 0;
355387827111SLi Zefan }
355487827111SLi Zefan 
355587827111SLi Zefan static int
3556f9349a8fSFrederic Weisbecker ftrace_set_func(unsigned long *array, int *idx, char *buffer)
3557ea4e2bc4SSteven Rostedt {
3558ea4e2bc4SSteven Rostedt 	struct dyn_ftrace *rec;
3559ea4e2bc4SSteven Rostedt 	struct ftrace_page *pg;
3560f9349a8fSFrederic Weisbecker 	int search_len;
3561c7c6b1feSLi Zefan 	int fail = 1;
3562f9349a8fSFrederic Weisbecker 	int type, not;
3563f9349a8fSFrederic Weisbecker 	char *search;
3564f9349a8fSFrederic Weisbecker 	bool exists;
3565f9349a8fSFrederic Weisbecker 	int i;
3566ea4e2bc4SSteven Rostedt 
3567f9349a8fSFrederic Weisbecker 	/* decode regex */
35683f6fe06dSFrederic Weisbecker 	type = filter_parse_regex(buffer, strlen(buffer), &search, &not);
3569c7c6b1feSLi Zefan 	if (!not && *idx >= FTRACE_GRAPH_MAX_FUNCS)
3570c7c6b1feSLi Zefan 		return -EBUSY;
3571f9349a8fSFrederic Weisbecker 
3572f9349a8fSFrederic Weisbecker 	search_len = strlen(search);
3573f9349a8fSFrederic Weisbecker 
357452baf119SSteven Rostedt 	mutex_lock(&ftrace_lock);
357545a4a237SSteven Rostedt 
357645a4a237SSteven Rostedt 	if (unlikely(ftrace_disabled)) {
357745a4a237SSteven Rostedt 		mutex_unlock(&ftrace_lock);
357845a4a237SSteven Rostedt 		return -ENODEV;
357945a4a237SSteven Rostedt 	}
358045a4a237SSteven Rostedt 
3581265c831cSSteven Rostedt 	do_for_each_ftrace_rec(pg, rec) {
3582ea4e2bc4SSteven Rostedt 
3583b9df92d2SSteven Rostedt 		if (ftrace_match_record(rec, NULL, search, search_len, type)) {
3584c7c6b1feSLi Zefan 			/* if it is in the array */
3585f9349a8fSFrederic Weisbecker 			exists = false;
3586c7c6b1feSLi Zefan 			for (i = 0; i < *idx; i++) {
3587f9349a8fSFrederic Weisbecker 				if (array[i] == rec->ip) {
3588f9349a8fSFrederic Weisbecker 					exists = true;
3589faec2ec5SLiming Wang 					break;
3590faec2ec5SLiming Wang 				}
3591c7c6b1feSLi Zefan 			}
3592c7c6b1feSLi Zefan 
3593c7c6b1feSLi Zefan 			if (!not) {
3594c7c6b1feSLi Zefan 				fail = 0;
3595c7c6b1feSLi Zefan 				if (!exists) {
3596f9349a8fSFrederic Weisbecker 					array[(*idx)++] = rec->ip;
3597c7c6b1feSLi Zefan 					if (*idx >= FTRACE_GRAPH_MAX_FUNCS)
3598c7c6b1feSLi Zefan 						goto out;
3599c7c6b1feSLi Zefan 				}
3600c7c6b1feSLi Zefan 			} else {
3601c7c6b1feSLi Zefan 				if (exists) {
3602c7c6b1feSLi Zefan 					array[i] = array[--(*idx)];
3603c7c6b1feSLi Zefan 					array[*idx] = 0;
3604c7c6b1feSLi Zefan 					fail = 0;
3605c7c6b1feSLi Zefan 				}
3606c7c6b1feSLi Zefan 			}
3607f9349a8fSFrederic Weisbecker 		}
3608265c831cSSteven Rostedt 	} while_for_each_ftrace_rec();
3609c7c6b1feSLi Zefan out:
361052baf119SSteven Rostedt 	mutex_unlock(&ftrace_lock);
3611ea4e2bc4SSteven Rostedt 
3612c7c6b1feSLi Zefan 	if (fail)
3613c7c6b1feSLi Zefan 		return -EINVAL;
3614c7c6b1feSLi Zefan 
3615c7c6b1feSLi Zefan 	ftrace_graph_filter_enabled = 1;
3616c7c6b1feSLi Zefan 	return 0;
3617ea4e2bc4SSteven Rostedt }
3618ea4e2bc4SSteven Rostedt 
3619ea4e2bc4SSteven Rostedt static ssize_t
3620ea4e2bc4SSteven Rostedt ftrace_graph_write(struct file *file, const char __user *ubuf,
3621ea4e2bc4SSteven Rostedt 		   size_t cnt, loff_t *ppos)
3622ea4e2bc4SSteven Rostedt {
3623689fd8b6S[email protected] 	struct trace_parser parser;
36244ba7978eSLi Zefan 	ssize_t read, ret;
3625ea4e2bc4SSteven Rostedt 
3626c7c6b1feSLi Zefan 	if (!cnt)
3627ea4e2bc4SSteven Rostedt 		return 0;
3628ea4e2bc4SSteven Rostedt 
3629ea4e2bc4SSteven Rostedt 	mutex_lock(&graph_lock);
3630ea4e2bc4SSteven Rostedt 
3631689fd8b6S[email protected] 	if (trace_parser_get_init(&parser, FTRACE_BUFF_MAX)) {
3632689fd8b6S[email protected] 		ret = -ENOMEM;
36331eb90f13SLi Zefan 		goto out_unlock;
3634ea4e2bc4SSteven Rostedt 	}
3635ea4e2bc4SSteven Rostedt 
3636689fd8b6S[email protected] 	read = trace_get_user(&parser, ubuf, cnt, ppos);
3637689fd8b6S[email protected] 
36384ba7978eSLi Zefan 	if (read >= 0 && trace_parser_loaded((&parser))) {
3639689fd8b6S[email protected] 		parser.buffer[parser.idx] = 0;
3640ea4e2bc4SSteven Rostedt 
3641f9349a8fSFrederic Weisbecker 		/* we allow only one expression at a time */
3642a4ec5e0cSLi Zefan 		ret = ftrace_set_func(ftrace_graph_funcs, &ftrace_graph_count,
3643689fd8b6S[email protected] 					parser.buffer);
3644ea4e2bc4SSteven Rostedt 		if (ret)
36451eb90f13SLi Zefan 			goto out_free;
3646689fd8b6S[email protected] 	}
3647ea4e2bc4SSteven Rostedt 
3648ea4e2bc4SSteven Rostedt 	ret = read;
36491eb90f13SLi Zefan 
36501eb90f13SLi Zefan out_free:
3651689fd8b6S[email protected] 	trace_parser_put(&parser);
36521eb90f13SLi Zefan out_unlock:
3653ea4e2bc4SSteven Rostedt 	mutex_unlock(&graph_lock);
3654ea4e2bc4SSteven Rostedt 
3655ea4e2bc4SSteven Rostedt 	return ret;
3656ea4e2bc4SSteven Rostedt }
3657ea4e2bc4SSteven Rostedt 
3658ea4e2bc4SSteven Rostedt static const struct file_operations ftrace_graph_fops = {
3659ea4e2bc4SSteven Rostedt 	.open		= ftrace_graph_open,
3660850a80cfSLai Jiangshan 	.read		= seq_read,
3661ea4e2bc4SSteven Rostedt 	.write		= ftrace_graph_write,
366287827111SLi Zefan 	.release	= ftrace_graph_release,
36636038f373SArnd Bergmann 	.llseek		= seq_lseek,
3664ea4e2bc4SSteven Rostedt };
3665ea4e2bc4SSteven Rostedt #endif /* CONFIG_FUNCTION_GRAPH_TRACER */
3666ea4e2bc4SSteven Rostedt 
3667df4fc315SSteven Rostedt static __init int ftrace_init_dyn_debugfs(struct dentry *d_tracer)
36685072c59fSSteven Rostedt {
36695072c59fSSteven Rostedt 
36705452af66SFrederic Weisbecker 	trace_create_file("available_filter_functions", 0444,
36715072c59fSSteven Rostedt 			d_tracer, NULL, &ftrace_avail_fops);
36725072c59fSSteven Rostedt 
3673647bcd03SSteven Rostedt 	trace_create_file("enabled_functions", 0444,
3674647bcd03SSteven Rostedt 			d_tracer, NULL, &ftrace_enabled_fops);
3675647bcd03SSteven Rostedt 
36765452af66SFrederic Weisbecker 	trace_create_file("set_ftrace_filter", 0644, d_tracer,
36775072c59fSSteven Rostedt 			NULL, &ftrace_filter_fops);
367841c52c0dSSteven Rostedt 
36795452af66SFrederic Weisbecker 	trace_create_file("set_ftrace_notrace", 0644, d_tracer,
368041c52c0dSSteven Rostedt 				    NULL, &ftrace_notrace_fops);
3681ad90c0e3SSteven Rostedt 
3682ea4e2bc4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
36835452af66SFrederic Weisbecker 	trace_create_file("set_graph_function", 0444, d_tracer,
3684ea4e2bc4SSteven Rostedt 				    NULL,
3685ea4e2bc4SSteven Rostedt 				    &ftrace_graph_fops);
3686ea4e2bc4SSteven Rostedt #endif /* CONFIG_FUNCTION_GRAPH_TRACER */
3687ea4e2bc4SSteven Rostedt 
36885072c59fSSteven Rostedt 	return 0;
36895072c59fSSteven Rostedt }
36905072c59fSSteven Rostedt 
369168950619SSteven Rostedt static void ftrace_swap_recs(void *a, void *b, int size)
369268950619SSteven Rostedt {
369368950619SSteven Rostedt 	struct dyn_ftrace *reca = a;
369468950619SSteven Rostedt 	struct dyn_ftrace *recb = b;
369568950619SSteven Rostedt 	struct dyn_ftrace t;
369668950619SSteven Rostedt 
369768950619SSteven Rostedt 	t = *reca;
369868950619SSteven Rostedt 	*reca = *recb;
369968950619SSteven Rostedt 	*recb = t;
370068950619SSteven Rostedt }
370168950619SSteven Rostedt 
37025cb084bbSJiri Olsa static int ftrace_process_locs(struct module *mod,
370331e88909SSteven Rostedt 			       unsigned long *start,
370468bf21aaSSteven Rostedt 			       unsigned long *end)
370568bf21aaSSteven Rostedt {
3706a7900875SSteven Rostedt 	struct ftrace_page *pg;
3707a7900875SSteven Rostedt 	unsigned long count;
370868bf21aaSSteven Rostedt 	unsigned long *p;
370968bf21aaSSteven Rostedt 	unsigned long addr;
37104376cac6SSteven Rostedt 	unsigned long flags = 0; /* Shut up gcc */
3711a7900875SSteven Rostedt 	int ret = -ENOMEM;
3712a7900875SSteven Rostedt 
3713a7900875SSteven Rostedt 	count = end - start;
3714a7900875SSteven Rostedt 
3715a7900875SSteven Rostedt 	if (!count)
3716a7900875SSteven Rostedt 		return 0;
3717a7900875SSteven Rostedt 
3718a7900875SSteven Rostedt 	pg = ftrace_allocate_pages(count);
3719a7900875SSteven Rostedt 	if (!pg)
3720a7900875SSteven Rostedt 		return -ENOMEM;
372168bf21aaSSteven Rostedt 
3722e6ea44e9SSteven Rostedt 	mutex_lock(&ftrace_lock);
3723a7900875SSteven Rostedt 
372432082309SSteven Rostedt 	/*
372532082309SSteven Rostedt 	 * Core and each module needs their own pages, as
372632082309SSteven Rostedt 	 * modules will free them when they are removed.
372732082309SSteven Rostedt 	 * Force a new page to be allocated for modules.
372832082309SSteven Rostedt 	 */
3729a7900875SSteven Rostedt 	if (!mod) {
3730a7900875SSteven Rostedt 		WARN_ON(ftrace_pages || ftrace_pages_start);
3731a7900875SSteven Rostedt 		/* First initialization */
3732a7900875SSteven Rostedt 		ftrace_pages = ftrace_pages_start = pg;
3733a7900875SSteven Rostedt 	} else {
373432082309SSteven Rostedt 		if (!ftrace_pages)
3735a7900875SSteven Rostedt 			goto out;
373632082309SSteven Rostedt 
3737a7900875SSteven Rostedt 		if (WARN_ON(ftrace_pages->next)) {
3738a7900875SSteven Rostedt 			/* Hmm, we have free pages? */
3739a7900875SSteven Rostedt 			while (ftrace_pages->next)
374032082309SSteven Rostedt 				ftrace_pages = ftrace_pages->next;
374132082309SSteven Rostedt 		}
3742a7900875SSteven Rostedt 
3743a7900875SSteven Rostedt 		ftrace_pages->next = pg;
3744a7900875SSteven Rostedt 		ftrace_pages = pg;
374532082309SSteven Rostedt 	}
374632082309SSteven Rostedt 
374768bf21aaSSteven Rostedt 	p = start;
374868bf21aaSSteven Rostedt 	while (p < end) {
374968bf21aaSSteven Rostedt 		addr = ftrace_call_adjust(*p++);
375020e5227eSSteven Rostedt 		/*
375120e5227eSSteven Rostedt 		 * Some architecture linkers will pad between
375220e5227eSSteven Rostedt 		 * the different mcount_loc sections of different
375320e5227eSSteven Rostedt 		 * object files to satisfy alignments.
375420e5227eSSteven Rostedt 		 * Skip any NULL pointers.
375520e5227eSSteven Rostedt 		 */
375620e5227eSSteven Rostedt 		if (!addr)
375720e5227eSSteven Rostedt 			continue;
3758a7900875SSteven Rostedt 		if (!ftrace_record_ip(addr))
3759a7900875SSteven Rostedt 			break;
376068bf21aaSSteven Rostedt 	}
376168bf21aaSSteven Rostedt 
376285ae32aeSSteven Rostedt 	/* These new locations need to be initialized */
376385ae32aeSSteven Rostedt 	ftrace_new_pgs = pg;
376485ae32aeSSteven Rostedt 
376568950619SSteven Rostedt 	/* Make each individual set of pages sorted by ips */
376668950619SSteven Rostedt 	for (; pg; pg = pg->next)
376768950619SSteven Rostedt 		sort(pg->records, pg->index, sizeof(struct dyn_ftrace),
376868950619SSteven Rostedt 		     ftrace_cmp_recs, ftrace_swap_recs);
376968950619SSteven Rostedt 
3770a4f18ed1SSteven Rostedt 	/*
37714376cac6SSteven Rostedt 	 * We only need to disable interrupts on start up
37724376cac6SSteven Rostedt 	 * because we are modifying code that an interrupt
37734376cac6SSteven Rostedt 	 * may execute, and the modification is not atomic.
37744376cac6SSteven Rostedt 	 * But for modules, nothing runs the code we modify
37754376cac6SSteven Rostedt 	 * until we are finished with it, and there's no
37764376cac6SSteven Rostedt 	 * reason to cause large interrupt latencies while we do it.
3777a4f18ed1SSteven Rostedt 	 */
37784376cac6SSteven Rostedt 	if (!mod)
3779a4f18ed1SSteven Rostedt 		local_irq_save(flags);
378031e88909SSteven Rostedt 	ftrace_update_code(mod);
37814376cac6SSteven Rostedt 	if (!mod)
3782a4f18ed1SSteven Rostedt 		local_irq_restore(flags);
3783a7900875SSteven Rostedt 	ret = 0;
3784a7900875SSteven Rostedt  out:
3785e6ea44e9SSteven Rostedt 	mutex_unlock(&ftrace_lock);
378668bf21aaSSteven Rostedt 
3787a7900875SSteven Rostedt 	return ret;
378868bf21aaSSteven Rostedt }
378968bf21aaSSteven Rostedt 
379093eb677dSSteven Rostedt #ifdef CONFIG_MODULES
379132082309SSteven Rostedt 
379232082309SSteven Rostedt #define next_to_ftrace_page(p) container_of(p, struct ftrace_page, next)
379332082309SSteven Rostedt 
3794e7247a15S[email protected] void ftrace_release_mod(struct module *mod)
379593eb677dSSteven Rostedt {
379693eb677dSSteven Rostedt 	struct dyn_ftrace *rec;
379732082309SSteven Rostedt 	struct ftrace_page **last_pg;
379893eb677dSSteven Rostedt 	struct ftrace_page *pg;
3799a7900875SSteven Rostedt 	int order;
380093eb677dSSteven Rostedt 
380193eb677dSSteven Rostedt 	mutex_lock(&ftrace_lock);
380245a4a237SSteven Rostedt 
380345a4a237SSteven Rostedt 	if (ftrace_disabled)
380445a4a237SSteven Rostedt 		goto out_unlock;
380545a4a237SSteven Rostedt 
380632082309SSteven Rostedt 	/*
380732082309SSteven Rostedt 	 * Each module has its own ftrace_pages, remove
380832082309SSteven Rostedt 	 * them from the list.
380932082309SSteven Rostedt 	 */
381032082309SSteven Rostedt 	last_pg = &ftrace_pages_start;
381132082309SSteven Rostedt 	for (pg = ftrace_pages_start; pg; pg = *last_pg) {
381232082309SSteven Rostedt 		rec = &pg->records[0];
3813e7247a15S[email protected] 		if (within_module_core(rec->ip, mod)) {
381493eb677dSSteven Rostedt 			/*
381532082309SSteven Rostedt 			 * As core pages are first, the first
381632082309SSteven Rostedt 			 * page should never be a module page.
381793eb677dSSteven Rostedt 			 */
381832082309SSteven Rostedt 			if (WARN_ON(pg == ftrace_pages_start))
381932082309SSteven Rostedt 				goto out_unlock;
382032082309SSteven Rostedt 
382132082309SSteven Rostedt 			/* Check if we are deleting the last page */
382232082309SSteven Rostedt 			if (pg == ftrace_pages)
382332082309SSteven Rostedt 				ftrace_pages = next_to_ftrace_page(last_pg);
382432082309SSteven Rostedt 
382532082309SSteven Rostedt 			*last_pg = pg->next;
3826a7900875SSteven Rostedt 			order = get_count_order(pg->size / ENTRIES_PER_PAGE);
3827a7900875SSteven Rostedt 			free_pages((unsigned long)pg->records, order);
3828a7900875SSteven Rostedt 			kfree(pg);
382932082309SSteven Rostedt 		} else
383032082309SSteven Rostedt 			last_pg = &pg->next;
383193eb677dSSteven Rostedt 	}
383245a4a237SSteven Rostedt  out_unlock:
383393eb677dSSteven Rostedt 	mutex_unlock(&ftrace_lock);
383493eb677dSSteven Rostedt }
383593eb677dSSteven Rostedt 
383693eb677dSSteven Rostedt static void ftrace_init_module(struct module *mod,
383731e88909SSteven Rostedt 			       unsigned long *start, unsigned long *end)
383890d595feSSteven Rostedt {
383900fd61aeSSteven Rostedt 	if (ftrace_disabled || start == end)
3840fed1939cSSteven Rostedt 		return;
38415cb084bbSJiri Olsa 	ftrace_process_locs(mod, start, end);
384290d595feSSteven Rostedt }
384390d595feSSteven Rostedt 
384493eb677dSSteven Rostedt static int ftrace_module_notify(struct notifier_block *self,
384593eb677dSSteven Rostedt 				unsigned long val, void *data)
384693eb677dSSteven Rostedt {
384793eb677dSSteven Rostedt 	struct module *mod = data;
384893eb677dSSteven Rostedt 
384993eb677dSSteven Rostedt 	switch (val) {
385093eb677dSSteven Rostedt 	case MODULE_STATE_COMING:
385193eb677dSSteven Rostedt 		ftrace_init_module(mod, mod->ftrace_callsites,
385293eb677dSSteven Rostedt 				   mod->ftrace_callsites +
385393eb677dSSteven Rostedt 				   mod->num_ftrace_callsites);
385493eb677dSSteven Rostedt 		break;
385593eb677dSSteven Rostedt 	case MODULE_STATE_GOING:
3856e7247a15S[email protected] 		ftrace_release_mod(mod);
385793eb677dSSteven Rostedt 		break;
385893eb677dSSteven Rostedt 	}
385993eb677dSSteven Rostedt 
386093eb677dSSteven Rostedt 	return 0;
386193eb677dSSteven Rostedt }
386293eb677dSSteven Rostedt #else
386393eb677dSSteven Rostedt static int ftrace_module_notify(struct notifier_block *self,
386493eb677dSSteven Rostedt 				unsigned long val, void *data)
386593eb677dSSteven Rostedt {
386693eb677dSSteven Rostedt 	return 0;
386793eb677dSSteven Rostedt }
386893eb677dSSteven Rostedt #endif /* CONFIG_MODULES */
386993eb677dSSteven Rostedt 
387093eb677dSSteven Rostedt struct notifier_block ftrace_module_nb = {
387193eb677dSSteven Rostedt 	.notifier_call = ftrace_module_notify,
387293eb677dSSteven Rostedt 	.priority = 0,
387393eb677dSSteven Rostedt };
387493eb677dSSteven Rostedt 
387568bf21aaSSteven Rostedt extern unsigned long __start_mcount_loc[];
387668bf21aaSSteven Rostedt extern unsigned long __stop_mcount_loc[];
387768bf21aaSSteven Rostedt 
387868bf21aaSSteven Rostedt void __init ftrace_init(void)
387968bf21aaSSteven Rostedt {
388068bf21aaSSteven Rostedt 	unsigned long count, addr, flags;
388168bf21aaSSteven Rostedt 	int ret;
388268bf21aaSSteven Rostedt 
388368bf21aaSSteven Rostedt 	/* Keep the ftrace pointer to the stub */
388468bf21aaSSteven Rostedt 	addr = (unsigned long)ftrace_stub;
388568bf21aaSSteven Rostedt 
388668bf21aaSSteven Rostedt 	local_irq_save(flags);
388768bf21aaSSteven Rostedt 	ftrace_dyn_arch_init(&addr);
388868bf21aaSSteven Rostedt 	local_irq_restore(flags);
388968bf21aaSSteven Rostedt 
389068bf21aaSSteven Rostedt 	/* ftrace_dyn_arch_init places the return code in addr */
389168bf21aaSSteven Rostedt 	if (addr)
389268bf21aaSSteven Rostedt 		goto failed;
389368bf21aaSSteven Rostedt 
389468bf21aaSSteven Rostedt 	count = __stop_mcount_loc - __start_mcount_loc;
389568bf21aaSSteven Rostedt 
389668bf21aaSSteven Rostedt 	ret = ftrace_dyn_table_alloc(count);
389768bf21aaSSteven Rostedt 	if (ret)
389868bf21aaSSteven Rostedt 		goto failed;
389968bf21aaSSteven Rostedt 
390068bf21aaSSteven Rostedt 	last_ftrace_enabled = ftrace_enabled = 1;
390168bf21aaSSteven Rostedt 
39025cb084bbSJiri Olsa 	ret = ftrace_process_locs(NULL,
390331e88909SSteven Rostedt 				  __start_mcount_loc,
390468bf21aaSSteven Rostedt 				  __stop_mcount_loc);
390568bf21aaSSteven Rostedt 
390693eb677dSSteven Rostedt 	ret = register_module_notifier(&ftrace_module_nb);
390724ed0c4bSMing Lei 	if (ret)
390893eb677dSSteven Rostedt 		pr_warning("Failed to register trace ftrace module notifier\n");
390993eb677dSSteven Rostedt 
39102af15d6aSSteven Rostedt 	set_ftrace_early_filters();
39112af15d6aSSteven Rostedt 
391268bf21aaSSteven Rostedt 	return;
391368bf21aaSSteven Rostedt  failed:
391468bf21aaSSteven Rostedt 	ftrace_disabled = 1;
391568bf21aaSSteven Rostedt }
391668bf21aaSSteven Rostedt 
39173d083395SSteven Rostedt #else
39180b6e4d56SFrederic Weisbecker 
39192b499381SSteven Rostedt static struct ftrace_ops global_ops = {
3920bd69c30bSSteven Rostedt 	.func			= ftrace_stub,
3921bd69c30bSSteven Rostedt };
3922bd69c30bSSteven Rostedt 
39230b6e4d56SFrederic Weisbecker static int __init ftrace_nodyn_init(void)
39240b6e4d56SFrederic Weisbecker {
39250b6e4d56SFrederic Weisbecker 	ftrace_enabled = 1;
39260b6e4d56SFrederic Weisbecker 	return 0;
39270b6e4d56SFrederic Weisbecker }
39280b6e4d56SFrederic Weisbecker device_initcall(ftrace_nodyn_init);
39290b6e4d56SFrederic Weisbecker 
3930df4fc315SSteven Rostedt static inline int ftrace_init_dyn_debugfs(struct dentry *d_tracer) { return 0; }
3931df4fc315SSteven Rostedt static inline void ftrace_startup_enable(int command) { }
39325a45cfe1SSteven Rostedt /* Keep as macros so we do not need to define the commands */
39333b6cfdb1SSteven Rostedt # define ftrace_startup(ops, command)			\
39343b6cfdb1SSteven Rostedt 	({						\
39353b6cfdb1SSteven Rostedt 		(ops)->flags |= FTRACE_OPS_FL_ENABLED;	\
39363b6cfdb1SSteven Rostedt 		0;					\
39373b6cfdb1SSteven Rostedt 	})
3938bd69c30bSSteven Rostedt # define ftrace_shutdown(ops, command)	do { } while (0)
3939b0fc494fSSteven Rostedt # define ftrace_startup_sysctl()	do { } while (0)
3940b0fc494fSSteven Rostedt # define ftrace_shutdown_sysctl()	do { } while (0)
3941b848914cSSteven Rostedt 
3942b848914cSSteven Rostedt static inline int
3943b848914cSSteven Rostedt ftrace_ops_test(struct ftrace_ops *ops, unsigned long ip)
3944b848914cSSteven Rostedt {
3945b848914cSSteven Rostedt 	return 1;
3946b848914cSSteven Rostedt }
3947b848914cSSteven Rostedt 
39483d083395SSteven Rostedt #endif /* CONFIG_DYNAMIC_FTRACE */
39493d083395SSteven Rostedt 
3950b848914cSSteven Rostedt static void
3951e248491aSJiri Olsa ftrace_ops_control_func(unsigned long ip, unsigned long parent_ip)
3952e248491aSJiri Olsa {
3953e248491aSJiri Olsa 	struct ftrace_ops *op;
3954e248491aSJiri Olsa 
3955e248491aSJiri Olsa 	if (unlikely(trace_recursion_test(TRACE_CONTROL_BIT)))
3956e248491aSJiri Olsa 		return;
3957e248491aSJiri Olsa 
3958e248491aSJiri Olsa 	/*
3959e248491aSJiri Olsa 	 * Some of the ops may be dynamically allocated,
3960e248491aSJiri Olsa 	 * they must be freed after a synchronize_sched().
3961e248491aSJiri Olsa 	 */
3962e248491aSJiri Olsa 	preempt_disable_notrace();
3963e248491aSJiri Olsa 	trace_recursion_set(TRACE_CONTROL_BIT);
3964e248491aSJiri Olsa 	op = rcu_dereference_raw(ftrace_control_list);
3965e248491aSJiri Olsa 	while (op != &ftrace_list_end) {
3966e248491aSJiri Olsa 		if (!ftrace_function_local_disabled(op) &&
3967e248491aSJiri Olsa 		    ftrace_ops_test(op, ip))
3968e248491aSJiri Olsa 			op->func(ip, parent_ip);
3969e248491aSJiri Olsa 
3970e248491aSJiri Olsa 		op = rcu_dereference_raw(op->next);
3971e248491aSJiri Olsa 	};
3972e248491aSJiri Olsa 	trace_recursion_clear(TRACE_CONTROL_BIT);
3973e248491aSJiri Olsa 	preempt_enable_notrace();
3974e248491aSJiri Olsa }
3975e248491aSJiri Olsa 
3976e248491aSJiri Olsa static struct ftrace_ops control_ops = {
3977e248491aSJiri Olsa 	.func = ftrace_ops_control_func,
3978e248491aSJiri Olsa };
3979e248491aSJiri Olsa 
3980e248491aSJiri Olsa static void
3981b848914cSSteven Rostedt ftrace_ops_list_func(unsigned long ip, unsigned long parent_ip)
3982b848914cSSteven Rostedt {
3983cdbe61bfSSteven Rostedt 	struct ftrace_ops *op;
3984b848914cSSteven Rostedt 
3985b1cff0adSSteven Rostedt 	if (unlikely(trace_recursion_test(TRACE_INTERNAL_BIT)))
3986b1cff0adSSteven Rostedt 		return;
3987b1cff0adSSteven Rostedt 
3988b1cff0adSSteven Rostedt 	trace_recursion_set(TRACE_INTERNAL_BIT);
3989cdbe61bfSSteven Rostedt 	/*
3990cdbe61bfSSteven Rostedt 	 * Some of the ops may be dynamically allocated,
3991cdbe61bfSSteven Rostedt 	 * they must be freed after a synchronize_sched().
3992cdbe61bfSSteven Rostedt 	 */
3993cdbe61bfSSteven Rostedt 	preempt_disable_notrace();
3994cdbe61bfSSteven Rostedt 	op = rcu_dereference_raw(ftrace_ops_list);
3995b848914cSSteven Rostedt 	while (op != &ftrace_list_end) {
3996b848914cSSteven Rostedt 		if (ftrace_ops_test(op, ip))
3997b848914cSSteven Rostedt 			op->func(ip, parent_ip);
3998b848914cSSteven Rostedt 		op = rcu_dereference_raw(op->next);
3999b848914cSSteven Rostedt 	};
4000cdbe61bfSSteven Rostedt 	preempt_enable_notrace();
4001b1cff0adSSteven Rostedt 	trace_recursion_clear(TRACE_INTERNAL_BIT);
4002b848914cSSteven Rostedt }
4003b848914cSSteven Rostedt 
4004e32d8956SSteven Rostedt static void clear_ftrace_swapper(void)
4005e32d8956SSteven Rostedt {
4006e32d8956SSteven Rostedt 	struct task_struct *p;
4007e32d8956SSteven Rostedt 	int cpu;
4008e32d8956SSteven Rostedt 
4009e32d8956SSteven Rostedt 	get_online_cpus();
4010e32d8956SSteven Rostedt 	for_each_online_cpu(cpu) {
4011e32d8956SSteven Rostedt 		p = idle_task(cpu);
4012e32d8956SSteven Rostedt 		clear_tsk_trace_trace(p);
4013e32d8956SSteven Rostedt 	}
4014e32d8956SSteven Rostedt 	put_online_cpus();
4015e32d8956SSteven Rostedt }
4016e32d8956SSteven Rostedt 
4017e32d8956SSteven Rostedt static void set_ftrace_swapper(void)
4018e32d8956SSteven Rostedt {
4019e32d8956SSteven Rostedt 	struct task_struct *p;
4020e32d8956SSteven Rostedt 	int cpu;
4021e32d8956SSteven Rostedt 
4022e32d8956SSteven Rostedt 	get_online_cpus();
4023e32d8956SSteven Rostedt 	for_each_online_cpu(cpu) {
4024e32d8956SSteven Rostedt 		p = idle_task(cpu);
4025e32d8956SSteven Rostedt 		set_tsk_trace_trace(p);
4026e32d8956SSteven Rostedt 	}
4027e32d8956SSteven Rostedt 	put_online_cpus();
4028e32d8956SSteven Rostedt }
4029e32d8956SSteven Rostedt 
4030e32d8956SSteven Rostedt static void clear_ftrace_pid(struct pid *pid)
4031978f3a45SSteven Rostedt {
4032978f3a45SSteven Rostedt 	struct task_struct *p;
4033978f3a45SSteven Rostedt 
4034229c4ef8SOleg Nesterov 	rcu_read_lock();
4035e32d8956SSteven Rostedt 	do_each_pid_task(pid, PIDTYPE_PID, p) {
4036978f3a45SSteven Rostedt 		clear_tsk_trace_trace(p);
4037e32d8956SSteven Rostedt 	} while_each_pid_task(pid, PIDTYPE_PID, p);
4038229c4ef8SOleg Nesterov 	rcu_read_unlock();
4039229c4ef8SOleg Nesterov 
4040e32d8956SSteven Rostedt 	put_pid(pid);
4041978f3a45SSteven Rostedt }
4042978f3a45SSteven Rostedt 
4043e32d8956SSteven Rostedt static void set_ftrace_pid(struct pid *pid)
4044978f3a45SSteven Rostedt {
4045978f3a45SSteven Rostedt 	struct task_struct *p;
4046978f3a45SSteven Rostedt 
4047229c4ef8SOleg Nesterov 	rcu_read_lock();
4048978f3a45SSteven Rostedt 	do_each_pid_task(pid, PIDTYPE_PID, p) {
4049978f3a45SSteven Rostedt 		set_tsk_trace_trace(p);
4050978f3a45SSteven Rostedt 	} while_each_pid_task(pid, PIDTYPE_PID, p);
4051229c4ef8SOleg Nesterov 	rcu_read_unlock();
4052978f3a45SSteven Rostedt }
4053978f3a45SSteven Rostedt 
4054756d17eeS[email protected] static void clear_ftrace_pid_task(struct pid *pid)
4055e32d8956SSteven Rostedt {
4056756d17eeS[email protected] 	if (pid == ftrace_swapper_pid)
4057e32d8956SSteven Rostedt 		clear_ftrace_swapper();
4058e32d8956SSteven Rostedt 	else
4059756d17eeS[email protected] 		clear_ftrace_pid(pid);
4060e32d8956SSteven Rostedt }
4061e32d8956SSteven Rostedt 
4062e32d8956SSteven Rostedt static void set_ftrace_pid_task(struct pid *pid)
4063e32d8956SSteven Rostedt {
4064e32d8956SSteven Rostedt 	if (pid == ftrace_swapper_pid)
4065e32d8956SSteven Rostedt 		set_ftrace_swapper();
4066e32d8956SSteven Rostedt 	else
4067e32d8956SSteven Rostedt 		set_ftrace_pid(pid);
4068e32d8956SSteven Rostedt }
4069e32d8956SSteven Rostedt 
4070756d17eeS[email protected] static int ftrace_pid_add(int p)
4071756d17eeS[email protected] {
4072756d17eeS[email protected] 	struct pid *pid;
4073756d17eeS[email protected] 	struct ftrace_pid *fpid;
4074756d17eeS[email protected] 	int ret = -EINVAL;
4075756d17eeS[email protected] 
4076756d17eeS[email protected] 	mutex_lock(&ftrace_lock);
4077756d17eeS[email protected] 
4078756d17eeS[email protected] 	if (!p)
4079756d17eeS[email protected] 		pid = ftrace_swapper_pid;
4080756d17eeS[email protected] 	else
4081756d17eeS[email protected] 		pid = find_get_pid(p);
4082756d17eeS[email protected] 
4083756d17eeS[email protected] 	if (!pid)
4084756d17eeS[email protected] 		goto out;
4085756d17eeS[email protected] 
4086756d17eeS[email protected] 	ret = 0;
4087756d17eeS[email protected] 
4088756d17eeS[email protected] 	list_for_each_entry(fpid, &ftrace_pids, list)
4089756d17eeS[email protected] 		if (fpid->pid == pid)
4090756d17eeS[email protected] 			goto out_put;
4091756d17eeS[email protected] 
4092756d17eeS[email protected] 	ret = -ENOMEM;
4093756d17eeS[email protected] 
4094756d17eeS[email protected] 	fpid = kmalloc(sizeof(*fpid), GFP_KERNEL);
4095756d17eeS[email protected] 	if (!fpid)
4096756d17eeS[email protected] 		goto out_put;
4097756d17eeS[email protected] 
4098756d17eeS[email protected] 	list_add(&fpid->list, &ftrace_pids);
4099756d17eeS[email protected] 	fpid->pid = pid;
4100756d17eeS[email protected] 
4101756d17eeS[email protected] 	set_ftrace_pid_task(pid);
4102756d17eeS[email protected] 
4103756d17eeS[email protected] 	ftrace_update_pid_func();
4104756d17eeS[email protected] 	ftrace_startup_enable(0);
4105756d17eeS[email protected] 
4106756d17eeS[email protected] 	mutex_unlock(&ftrace_lock);
4107756d17eeS[email protected] 	return 0;
4108756d17eeS[email protected] 
4109756d17eeS[email protected] out_put:
4110756d17eeS[email protected] 	if (pid != ftrace_swapper_pid)
4111756d17eeS[email protected] 		put_pid(pid);
4112756d17eeS[email protected] 
4113756d17eeS[email protected] out:
4114756d17eeS[email protected] 	mutex_unlock(&ftrace_lock);
4115756d17eeS[email protected] 	return ret;
4116756d17eeS[email protected] }
4117756d17eeS[email protected] 
4118756d17eeS[email protected] static void ftrace_pid_reset(void)
4119756d17eeS[email protected] {
4120756d17eeS[email protected] 	struct ftrace_pid *fpid, *safe;
4121756d17eeS[email protected] 
4122756d17eeS[email protected] 	mutex_lock(&ftrace_lock);
4123756d17eeS[email protected] 	list_for_each_entry_safe(fpid, safe, &ftrace_pids, list) {
4124756d17eeS[email protected] 		struct pid *pid = fpid->pid;
4125756d17eeS[email protected] 
4126756d17eeS[email protected] 		clear_ftrace_pid_task(pid);
4127756d17eeS[email protected] 
4128756d17eeS[email protected] 		list_del(&fpid->list);
4129756d17eeS[email protected] 		kfree(fpid);
4130756d17eeS[email protected] 	}
4131756d17eeS[email protected] 
4132756d17eeS[email protected] 	ftrace_update_pid_func();
4133756d17eeS[email protected] 	ftrace_startup_enable(0);
4134756d17eeS[email protected] 
4135756d17eeS[email protected] 	mutex_unlock(&ftrace_lock);
4136756d17eeS[email protected] }
4137756d17eeS[email protected] 
4138756d17eeS[email protected] static void *fpid_start(struct seq_file *m, loff_t *pos)
4139756d17eeS[email protected] {
4140756d17eeS[email protected] 	mutex_lock(&ftrace_lock);
4141756d17eeS[email protected] 
4142756d17eeS[email protected] 	if (list_empty(&ftrace_pids) && (!*pos))
4143756d17eeS[email protected] 		return (void *) 1;
4144756d17eeS[email protected] 
4145756d17eeS[email protected] 	return seq_list_start(&ftrace_pids, *pos);
4146756d17eeS[email protected] }
4147756d17eeS[email protected] 
4148756d17eeS[email protected] static void *fpid_next(struct seq_file *m, void *v, loff_t *pos)
4149756d17eeS[email protected] {
4150756d17eeS[email protected] 	if (v == (void *)1)
4151756d17eeS[email protected] 		return NULL;
4152756d17eeS[email protected] 
4153756d17eeS[email protected] 	return seq_list_next(v, &ftrace_pids, pos);
4154756d17eeS[email protected] }
4155756d17eeS[email protected] 
4156756d17eeS[email protected] static void fpid_stop(struct seq_file *m, void *p)
4157756d17eeS[email protected] {
4158756d17eeS[email protected] 	mutex_unlock(&ftrace_lock);
4159756d17eeS[email protected] }
4160756d17eeS[email protected] 
4161756d17eeS[email protected] static int fpid_show(struct seq_file *m, void *v)
4162756d17eeS[email protected] {
4163756d17eeS[email protected] 	const struct ftrace_pid *fpid = list_entry(v, struct ftrace_pid, list);
4164756d17eeS[email protected] 
4165756d17eeS[email protected] 	if (v == (void *)1) {
4166756d17eeS[email protected] 		seq_printf(m, "no pid\n");
4167756d17eeS[email protected] 		return 0;
4168756d17eeS[email protected] 	}
4169756d17eeS[email protected] 
4170756d17eeS[email protected] 	if (fpid->pid == ftrace_swapper_pid)
4171756d17eeS[email protected] 		seq_printf(m, "swapper tasks\n");
4172756d17eeS[email protected] 	else
4173756d17eeS[email protected] 		seq_printf(m, "%u\n", pid_vnr(fpid->pid));
4174756d17eeS[email protected] 
4175756d17eeS[email protected] 	return 0;
4176756d17eeS[email protected] }
4177756d17eeS[email protected] 
4178756d17eeS[email protected] static const struct seq_operations ftrace_pid_sops = {
4179756d17eeS[email protected] 	.start = fpid_start,
4180756d17eeS[email protected] 	.next = fpid_next,
4181756d17eeS[email protected] 	.stop = fpid_stop,
4182756d17eeS[email protected] 	.show = fpid_show,
4183756d17eeS[email protected] };
4184756d17eeS[email protected] 
4185756d17eeS[email protected] static int
4186756d17eeS[email protected] ftrace_pid_open(struct inode *inode, struct file *file)
4187756d17eeS[email protected] {
4188756d17eeS[email protected] 	int ret = 0;
4189756d17eeS[email protected] 
4190756d17eeS[email protected] 	if ((file->f_mode & FMODE_WRITE) &&
4191756d17eeS[email protected] 	    (file->f_flags & O_TRUNC))
4192756d17eeS[email protected] 		ftrace_pid_reset();
4193756d17eeS[email protected] 
4194756d17eeS[email protected] 	if (file->f_mode & FMODE_READ)
4195756d17eeS[email protected] 		ret = seq_open(file, &ftrace_pid_sops);
4196756d17eeS[email protected] 
4197756d17eeS[email protected] 	return ret;
4198756d17eeS[email protected] }
4199756d17eeS[email protected] 
4200df4fc315SSteven Rostedt static ssize_t
4201df4fc315SSteven Rostedt ftrace_pid_write(struct file *filp, const char __user *ubuf,
4202df4fc315SSteven Rostedt 		   size_t cnt, loff_t *ppos)
4203df4fc315SSteven Rostedt {
4204457dc928SIngo Molnar 	char buf[64], *tmp;
4205df4fc315SSteven Rostedt 	long val;
4206df4fc315SSteven Rostedt 	int ret;
4207df4fc315SSteven Rostedt 
4208df4fc315SSteven Rostedt 	if (cnt >= sizeof(buf))
4209df4fc315SSteven Rostedt 		return -EINVAL;
4210df4fc315SSteven Rostedt 
4211df4fc315SSteven Rostedt 	if (copy_from_user(&buf, ubuf, cnt))
4212df4fc315SSteven Rostedt 		return -EFAULT;
4213df4fc315SSteven Rostedt 
4214df4fc315SSteven Rostedt 	buf[cnt] = 0;
4215df4fc315SSteven Rostedt 
4216756d17eeS[email protected] 	/*
4217756d17eeS[email protected] 	 * Allow "echo > set_ftrace_pid" or "echo -n '' > set_ftrace_pid"
4218756d17eeS[email protected] 	 * to clean the filter quietly.
4219756d17eeS[email protected] 	 */
4220457dc928SIngo Molnar 	tmp = strstrip(buf);
4221457dc928SIngo Molnar 	if (strlen(tmp) == 0)
4222756d17eeS[email protected] 		return 1;
4223756d17eeS[email protected] 
4224457dc928SIngo Molnar 	ret = strict_strtol(tmp, 10, &val);
4225df4fc315SSteven Rostedt 	if (ret < 0)
4226df4fc315SSteven Rostedt 		return ret;
4227df4fc315SSteven Rostedt 
4228756d17eeS[email protected] 	ret = ftrace_pid_add(val);
4229978f3a45SSteven Rostedt 
4230756d17eeS[email protected] 	return ret ? ret : cnt;
4231e32d8956SSteven Rostedt }
4232978f3a45SSteven Rostedt 
4233756d17eeS[email protected] static int
4234756d17eeS[email protected] ftrace_pid_release(struct inode *inode, struct file *file)
4235756d17eeS[email protected] {
4236756d17eeS[email protected] 	if (file->f_mode & FMODE_READ)
4237756d17eeS[email protected] 		seq_release(inode, file);
4238978f3a45SSteven Rostedt 
4239756d17eeS[email protected] 	return 0;
4240df4fc315SSteven Rostedt }
4241df4fc315SSteven Rostedt 
42425e2336a0SSteven Rostedt static const struct file_operations ftrace_pid_fops = {
4243756d17eeS[email protected] 	.open		= ftrace_pid_open,
4244df4fc315SSteven Rostedt 	.write		= ftrace_pid_write,
4245756d17eeS[email protected] 	.read		= seq_read,
4246756d17eeS[email protected] 	.llseek		= seq_lseek,
4247756d17eeS[email protected] 	.release	= ftrace_pid_release,
4248df4fc315SSteven Rostedt };
4249df4fc315SSteven Rostedt 
4250df4fc315SSteven Rostedt static __init int ftrace_init_debugfs(void)
4251df4fc315SSteven Rostedt {
4252df4fc315SSteven Rostedt 	struct dentry *d_tracer;
4253df4fc315SSteven Rostedt 
4254df4fc315SSteven Rostedt 	d_tracer = tracing_init_dentry();
4255df4fc315SSteven Rostedt 	if (!d_tracer)
4256df4fc315SSteven Rostedt 		return 0;
4257df4fc315SSteven Rostedt 
4258df4fc315SSteven Rostedt 	ftrace_init_dyn_debugfs(d_tracer);
4259df4fc315SSteven Rostedt 
42605452af66SFrederic Weisbecker 	trace_create_file("set_ftrace_pid", 0644, d_tracer,
4261df4fc315SSteven Rostedt 			    NULL, &ftrace_pid_fops);
4262493762fcSSteven Rostedt 
4263493762fcSSteven Rostedt 	ftrace_profile_debugfs(d_tracer);
4264493762fcSSteven Rostedt 
4265df4fc315SSteven Rostedt 	return 0;
4266df4fc315SSteven Rostedt }
4267df4fc315SSteven Rostedt fs_initcall(ftrace_init_debugfs);
4268df4fc315SSteven Rostedt 
42693d083395SSteven Rostedt /**
427081adbdc0SSteven Rostedt  * ftrace_kill - kill ftrace
4271a2bb6a3dSSteven Rostedt  *
4272a2bb6a3dSSteven Rostedt  * This function should be used by panic code. It stops ftrace
4273a2bb6a3dSSteven Rostedt  * but in a not so nice way. If you need to simply kill ftrace
4274a2bb6a3dSSteven Rostedt  * from a non-atomic section, use ftrace_kill.
4275a2bb6a3dSSteven Rostedt  */
427681adbdc0SSteven Rostedt void ftrace_kill(void)
4277a2bb6a3dSSteven Rostedt {
4278a2bb6a3dSSteven Rostedt 	ftrace_disabled = 1;
4279a2bb6a3dSSteven Rostedt 	ftrace_enabled = 0;
4280a2bb6a3dSSteven Rostedt 	clear_ftrace_function();
4281a2bb6a3dSSteven Rostedt }
4282a2bb6a3dSSteven Rostedt 
4283a2bb6a3dSSteven Rostedt /**
4284e0a413f6SSteven Rostedt  * Test if ftrace is dead or not.
4285e0a413f6SSteven Rostedt  */
4286e0a413f6SSteven Rostedt int ftrace_is_dead(void)
4287e0a413f6SSteven Rostedt {
4288e0a413f6SSteven Rostedt 	return ftrace_disabled;
4289e0a413f6SSteven Rostedt }
4290e0a413f6SSteven Rostedt 
4291e0a413f6SSteven Rostedt /**
42923d083395SSteven Rostedt  * register_ftrace_function - register a function for profiling
42933d083395SSteven Rostedt  * @ops - ops structure that holds the function for profiling.
42943d083395SSteven Rostedt  *
42953d083395SSteven Rostedt  * Register a function to be called by all functions in the
42963d083395SSteven Rostedt  * kernel.
42973d083395SSteven Rostedt  *
42983d083395SSteven Rostedt  * Note: @ops->func and all the functions it calls must be labeled
42993d083395SSteven Rostedt  *       with "notrace", otherwise it will go into a
43003d083395SSteven Rostedt  *       recursive loop.
43013d083395SSteven Rostedt  */
43023d083395SSteven Rostedt int register_ftrace_function(struct ftrace_ops *ops)
43033d083395SSteven Rostedt {
430445a4a237SSteven Rostedt 	int ret = -1;
43054eebcc81SSteven Rostedt 
4306e6ea44e9SSteven Rostedt 	mutex_lock(&ftrace_lock);
4307e7d3737eSFrederic Weisbecker 
430845a4a237SSteven Rostedt 	if (unlikely(ftrace_disabled))
430945a4a237SSteven Rostedt 		goto out_unlock;
431045a4a237SSteven Rostedt 
4311b0fc494fSSteven Rostedt 	ret = __register_ftrace_function(ops);
4312b848914cSSteven Rostedt 	if (!ret)
4313a1cd6173SSteven Rostedt 		ret = ftrace_startup(ops, 0);
4314b848914cSSteven Rostedt 
4315b0fc494fSSteven Rostedt 
431645a4a237SSteven Rostedt  out_unlock:
4317e6ea44e9SSteven Rostedt 	mutex_unlock(&ftrace_lock);
4318b0fc494fSSteven Rostedt 	return ret;
43193d083395SSteven Rostedt }
4320cdbe61bfSSteven Rostedt EXPORT_SYMBOL_GPL(register_ftrace_function);
43213d083395SSteven Rostedt 
43223d083395SSteven Rostedt /**
432332632920SUwe Kleine-Koenig  * unregister_ftrace_function - unregister a function for profiling.
43243d083395SSteven Rostedt  * @ops - ops structure that holds the function to unregister
43253d083395SSteven Rostedt  *
43263d083395SSteven Rostedt  * Unregister a function that was added to be called by ftrace profiling.
43273d083395SSteven Rostedt  */
43283d083395SSteven Rostedt int unregister_ftrace_function(struct ftrace_ops *ops)
43293d083395SSteven Rostedt {
43303d083395SSteven Rostedt 	int ret;
43313d083395SSteven Rostedt 
4332e6ea44e9SSteven Rostedt 	mutex_lock(&ftrace_lock);
43333d083395SSteven Rostedt 	ret = __unregister_ftrace_function(ops);
4334b848914cSSteven Rostedt 	if (!ret)
4335b848914cSSteven Rostedt 		ftrace_shutdown(ops, 0);
4336e6ea44e9SSteven Rostedt 	mutex_unlock(&ftrace_lock);
4337b0fc494fSSteven Rostedt 
4338b0fc494fSSteven Rostedt 	return ret;
4339b0fc494fSSteven Rostedt }
4340cdbe61bfSSteven Rostedt EXPORT_SYMBOL_GPL(unregister_ftrace_function);
4341b0fc494fSSteven Rostedt 
4342e309b41dSIngo Molnar int
4343b0fc494fSSteven Rostedt ftrace_enable_sysctl(struct ctl_table *table, int write,
43448d65af78SAlexey Dobriyan 		     void __user *buffer, size_t *lenp,
4345b0fc494fSSteven Rostedt 		     loff_t *ppos)
4346b0fc494fSSteven Rostedt {
434745a4a237SSteven Rostedt 	int ret = -ENODEV;
43484eebcc81SSteven Rostedt 
4349e6ea44e9SSteven Rostedt 	mutex_lock(&ftrace_lock);
4350b0fc494fSSteven Rostedt 
435145a4a237SSteven Rostedt 	if (unlikely(ftrace_disabled))
435245a4a237SSteven Rostedt 		goto out;
435345a4a237SSteven Rostedt 
43548d65af78SAlexey Dobriyan 	ret = proc_dointvec(table, write, buffer, lenp, ppos);
4355b0fc494fSSteven Rostedt 
4356a32c7765SLi Zefan 	if (ret || !write || (last_ftrace_enabled == !!ftrace_enabled))
4357b0fc494fSSteven Rostedt 		goto out;
4358b0fc494fSSteven Rostedt 
4359a32c7765SLi Zefan 	last_ftrace_enabled = !!ftrace_enabled;
4360b0fc494fSSteven Rostedt 
4361b0fc494fSSteven Rostedt 	if (ftrace_enabled) {
4362b0fc494fSSteven Rostedt 
4363b0fc494fSSteven Rostedt 		ftrace_startup_sysctl();
4364b0fc494fSSteven Rostedt 
4365b0fc494fSSteven Rostedt 		/* we are starting ftrace again */
4366b848914cSSteven Rostedt 		if (ftrace_ops_list != &ftrace_list_end) {
4367b848914cSSteven Rostedt 			if (ftrace_ops_list->next == &ftrace_list_end)
4368b848914cSSteven Rostedt 				ftrace_trace_function = ftrace_ops_list->func;
4369b0fc494fSSteven Rostedt 			else
4370b848914cSSteven Rostedt 				ftrace_trace_function = ftrace_ops_list_func;
4371b0fc494fSSteven Rostedt 		}
4372b0fc494fSSteven Rostedt 
4373b0fc494fSSteven Rostedt 	} else {
4374b0fc494fSSteven Rostedt 		/* stopping ftrace calls (just send to ftrace_stub) */
4375b0fc494fSSteven Rostedt 		ftrace_trace_function = ftrace_stub;
4376b0fc494fSSteven Rostedt 
4377b0fc494fSSteven Rostedt 		ftrace_shutdown_sysctl();
4378b0fc494fSSteven Rostedt 	}
4379b0fc494fSSteven Rostedt 
4380b0fc494fSSteven Rostedt  out:
4381e6ea44e9SSteven Rostedt 	mutex_unlock(&ftrace_lock);
43823d083395SSteven Rostedt 	return ret;
438316444a8aSArnaldo Carvalho de Melo }
4384f17845e5SIngo Molnar 
4385fb52607aSFrederic Weisbecker #ifdef CONFIG_FUNCTION_GRAPH_TRACER
4386e7d3737eSFrederic Weisbecker 
4387597af815SSteven Rostedt static int ftrace_graph_active;
43884a2b8ddaSFrederic Weisbecker static struct notifier_block ftrace_suspend_notifier;
4389f201ae23SFrederic Weisbecker 
4390e49dc19cSSteven Rostedt int ftrace_graph_entry_stub(struct ftrace_graph_ent *trace)
4391e49dc19cSSteven Rostedt {
4392e49dc19cSSteven Rostedt 	return 0;
4393e49dc19cSSteven Rostedt }
4394e49dc19cSSteven Rostedt 
4395287b6e68SFrederic Weisbecker /* The callbacks that hook a function */
4396287b6e68SFrederic Weisbecker trace_func_graph_ret_t ftrace_graph_return =
4397287b6e68SFrederic Weisbecker 			(trace_func_graph_ret_t)ftrace_stub;
4398e49dc19cSSteven Rostedt trace_func_graph_ent_t ftrace_graph_entry = ftrace_graph_entry_stub;
4399f201ae23SFrederic Weisbecker 
4400f201ae23SFrederic Weisbecker /* Try to assign a return stack array on FTRACE_RETSTACK_ALLOC_SIZE tasks. */
4401f201ae23SFrederic Weisbecker static int alloc_retstack_tasklist(struct ftrace_ret_stack **ret_stack_list)
4402f201ae23SFrederic Weisbecker {
4403f201ae23SFrederic Weisbecker 	int i;
4404f201ae23SFrederic Weisbecker 	int ret = 0;
4405f201ae23SFrederic Weisbecker 	unsigned long flags;
4406f201ae23SFrederic Weisbecker 	int start = 0, end = FTRACE_RETSTACK_ALLOC_SIZE;
4407f201ae23SFrederic Weisbecker 	struct task_struct *g, *t;
4408f201ae23SFrederic Weisbecker 
4409f201ae23SFrederic Weisbecker 	for (i = 0; i < FTRACE_RETSTACK_ALLOC_SIZE; i++) {
4410f201ae23SFrederic Weisbecker 		ret_stack_list[i] = kmalloc(FTRACE_RETFUNC_DEPTH
4411f201ae23SFrederic Weisbecker 					* sizeof(struct ftrace_ret_stack),
4412f201ae23SFrederic Weisbecker 					GFP_KERNEL);
4413f201ae23SFrederic Weisbecker 		if (!ret_stack_list[i]) {
4414f201ae23SFrederic Weisbecker 			start = 0;
4415f201ae23SFrederic Weisbecker 			end = i;
4416f201ae23SFrederic Weisbecker 			ret = -ENOMEM;
4417f201ae23SFrederic Weisbecker 			goto free;
4418f201ae23SFrederic Weisbecker 		}
4419f201ae23SFrederic Weisbecker 	}
4420f201ae23SFrederic Weisbecker 
4421f201ae23SFrederic Weisbecker 	read_lock_irqsave(&tasklist_lock, flags);
4422f201ae23SFrederic Weisbecker 	do_each_thread(g, t) {
4423f201ae23SFrederic Weisbecker 		if (start == end) {
4424f201ae23SFrederic Weisbecker 			ret = -EAGAIN;
4425f201ae23SFrederic Weisbecker 			goto unlock;
4426f201ae23SFrederic Weisbecker 		}
4427f201ae23SFrederic Weisbecker 
4428f201ae23SFrederic Weisbecker 		if (t->ret_stack == NULL) {
4429380c4b14SFrederic Weisbecker 			atomic_set(&t->tracing_graph_pause, 0);
4430f201ae23SFrederic Weisbecker 			atomic_set(&t->trace_overrun, 0);
443126c01624SSteven Rostedt 			t->curr_ret_stack = -1;
443226c01624SSteven Rostedt 			/* Make sure the tasks see the -1 first: */
443326c01624SSteven Rostedt 			smp_wmb();
443426c01624SSteven Rostedt 			t->ret_stack = ret_stack_list[start++];
4435f201ae23SFrederic Weisbecker 		}
4436f201ae23SFrederic Weisbecker 	} while_each_thread(g, t);
4437f201ae23SFrederic Weisbecker 
4438f201ae23SFrederic Weisbecker unlock:
4439f201ae23SFrederic Weisbecker 	read_unlock_irqrestore(&tasklist_lock, flags);
4440f201ae23SFrederic Weisbecker free:
4441f201ae23SFrederic Weisbecker 	for (i = start; i < end; i++)
4442f201ae23SFrederic Weisbecker 		kfree(ret_stack_list[i]);
4443f201ae23SFrederic Weisbecker 	return ret;
4444f201ae23SFrederic Weisbecker }
4445f201ae23SFrederic Weisbecker 
44468aef2d28SSteven Rostedt static void
444738516ab5SSteven Rostedt ftrace_graph_probe_sched_switch(void *ignore,
444838516ab5SSteven Rostedt 			struct task_struct *prev, struct task_struct *next)
44498aef2d28SSteven Rostedt {
44508aef2d28SSteven Rostedt 	unsigned long long timestamp;
44518aef2d28SSteven Rostedt 	int index;
44528aef2d28SSteven Rostedt 
4453be6f164aSSteven Rostedt 	/*
4454be6f164aSSteven Rostedt 	 * Does the user want to count the time a function was asleep.
4455be6f164aSSteven Rostedt 	 * If so, do not update the time stamps.
4456be6f164aSSteven Rostedt 	 */
4457be6f164aSSteven Rostedt 	if (trace_flags & TRACE_ITER_SLEEP_TIME)
4458be6f164aSSteven Rostedt 		return;
4459be6f164aSSteven Rostedt 
44608aef2d28SSteven Rostedt 	timestamp = trace_clock_local();
44618aef2d28SSteven Rostedt 
44628aef2d28SSteven Rostedt 	prev->ftrace_timestamp = timestamp;
44638aef2d28SSteven Rostedt 
44648aef2d28SSteven Rostedt 	/* only process tasks that we timestamped */
44658aef2d28SSteven Rostedt 	if (!next->ftrace_timestamp)
44668aef2d28SSteven Rostedt 		return;
44678aef2d28SSteven Rostedt 
44688aef2d28SSteven Rostedt 	/*
44698aef2d28SSteven Rostedt 	 * Update all the counters in next to make up for the
44708aef2d28SSteven Rostedt 	 * time next was sleeping.
44718aef2d28SSteven Rostedt 	 */
44728aef2d28SSteven Rostedt 	timestamp -= next->ftrace_timestamp;
44738aef2d28SSteven Rostedt 
44748aef2d28SSteven Rostedt 	for (index = next->curr_ret_stack; index >= 0; index--)
44758aef2d28SSteven Rostedt 		next->ret_stack[index].calltime += timestamp;
44768aef2d28SSteven Rostedt }
44778aef2d28SSteven Rostedt 
4478f201ae23SFrederic Weisbecker /* Allocate a return stack for each task */
4479fb52607aSFrederic Weisbecker static int start_graph_tracing(void)
4480f201ae23SFrederic Weisbecker {
4481f201ae23SFrederic Weisbecker 	struct ftrace_ret_stack **ret_stack_list;
44825b058bcdSFrederic Weisbecker 	int ret, cpu;
4483f201ae23SFrederic Weisbecker 
4484f201ae23SFrederic Weisbecker 	ret_stack_list = kmalloc(FTRACE_RETSTACK_ALLOC_SIZE *
4485f201ae23SFrederic Weisbecker 				sizeof(struct ftrace_ret_stack *),
4486f201ae23SFrederic Weisbecker 				GFP_KERNEL);
4487f201ae23SFrederic Weisbecker 
4488f201ae23SFrederic Weisbecker 	if (!ret_stack_list)
4489f201ae23SFrederic Weisbecker 		return -ENOMEM;
4490f201ae23SFrederic Weisbecker 
44915b058bcdSFrederic Weisbecker 	/* The cpu_boot init_task->ret_stack will never be freed */
4492179c498aSSteven Rostedt 	for_each_online_cpu(cpu) {
4493179c498aSSteven Rostedt 		if (!idle_task(cpu)->ret_stack)
4494868baf07SSteven Rostedt 			ftrace_graph_init_idle_task(idle_task(cpu), cpu);
4495179c498aSSteven Rostedt 	}
44965b058bcdSFrederic Weisbecker 
4497f201ae23SFrederic Weisbecker 	do {
4498f201ae23SFrederic Weisbecker 		ret = alloc_retstack_tasklist(ret_stack_list);
4499f201ae23SFrederic Weisbecker 	} while (ret == -EAGAIN);
4500f201ae23SFrederic Weisbecker 
45018aef2d28SSteven Rostedt 	if (!ret) {
450238516ab5SSteven Rostedt 		ret = register_trace_sched_switch(ftrace_graph_probe_sched_switch, NULL);
45038aef2d28SSteven Rostedt 		if (ret)
45048aef2d28SSteven Rostedt 			pr_info("ftrace_graph: Couldn't activate tracepoint"
45058aef2d28SSteven Rostedt 				" probe to kernel_sched_switch\n");
45068aef2d28SSteven Rostedt 	}
45078aef2d28SSteven Rostedt 
4508f201ae23SFrederic Weisbecker 	kfree(ret_stack_list);
4509f201ae23SFrederic Weisbecker 	return ret;
4510f201ae23SFrederic Weisbecker }
4511f201ae23SFrederic Weisbecker 
45124a2b8ddaSFrederic Weisbecker /*
45134a2b8ddaSFrederic Weisbecker  * Hibernation protection.
45144a2b8ddaSFrederic Weisbecker  * The state of the current task is too much unstable during
45154a2b8ddaSFrederic Weisbecker  * suspend/restore to disk. We want to protect against that.
45164a2b8ddaSFrederic Weisbecker  */
45174a2b8ddaSFrederic Weisbecker static int
45184a2b8ddaSFrederic Weisbecker ftrace_suspend_notifier_call(struct notifier_block *bl, unsigned long state,
45194a2b8ddaSFrederic Weisbecker 							void *unused)
45204a2b8ddaSFrederic Weisbecker {
45214a2b8ddaSFrederic Weisbecker 	switch (state) {
45224a2b8ddaSFrederic Weisbecker 	case PM_HIBERNATION_PREPARE:
45234a2b8ddaSFrederic Weisbecker 		pause_graph_tracing();
45244a2b8ddaSFrederic Weisbecker 		break;
45254a2b8ddaSFrederic Weisbecker 
45264a2b8ddaSFrederic Weisbecker 	case PM_POST_HIBERNATION:
45274a2b8ddaSFrederic Weisbecker 		unpause_graph_tracing();
45284a2b8ddaSFrederic Weisbecker 		break;
45294a2b8ddaSFrederic Weisbecker 	}
45304a2b8ddaSFrederic Weisbecker 	return NOTIFY_DONE;
45314a2b8ddaSFrederic Weisbecker }
45324a2b8ddaSFrederic Weisbecker 
4533287b6e68SFrederic Weisbecker int register_ftrace_graph(trace_func_graph_ret_t retfunc,
4534287b6e68SFrederic Weisbecker 			trace_func_graph_ent_t entryfunc)
453515e6cb36SFrederic Weisbecker {
4536e7d3737eSFrederic Weisbecker 	int ret = 0;
4537e7d3737eSFrederic Weisbecker 
4538e6ea44e9SSteven Rostedt 	mutex_lock(&ftrace_lock);
4539e7d3737eSFrederic Weisbecker 
454005ce5818SSteven Rostedt 	/* we currently allow only one tracer registered at a time */
4541597af815SSteven Rostedt 	if (ftrace_graph_active) {
454205ce5818SSteven Rostedt 		ret = -EBUSY;
454305ce5818SSteven Rostedt 		goto out;
454405ce5818SSteven Rostedt 	}
454505ce5818SSteven Rostedt 
45464a2b8ddaSFrederic Weisbecker 	ftrace_suspend_notifier.notifier_call = ftrace_suspend_notifier_call;
45474a2b8ddaSFrederic Weisbecker 	register_pm_notifier(&ftrace_suspend_notifier);
45484a2b8ddaSFrederic Weisbecker 
4549597af815SSteven Rostedt 	ftrace_graph_active++;
4550fb52607aSFrederic Weisbecker 	ret = start_graph_tracing();
4551f201ae23SFrederic Weisbecker 	if (ret) {
4552597af815SSteven Rostedt 		ftrace_graph_active--;
4553f201ae23SFrederic Weisbecker 		goto out;
4554f201ae23SFrederic Weisbecker 	}
4555e53a6319SSteven Rostedt 
4556287b6e68SFrederic Weisbecker 	ftrace_graph_return = retfunc;
4557287b6e68SFrederic Weisbecker 	ftrace_graph_entry = entryfunc;
4558e53a6319SSteven Rostedt 
4559a1cd6173SSteven Rostedt 	ret = ftrace_startup(&global_ops, FTRACE_START_FUNC_RET);
4560e7d3737eSFrederic Weisbecker 
4561e7d3737eSFrederic Weisbecker out:
4562e6ea44e9SSteven Rostedt 	mutex_unlock(&ftrace_lock);
4563e7d3737eSFrederic Weisbecker 	return ret;
456415e6cb36SFrederic Weisbecker }
456515e6cb36SFrederic Weisbecker 
4566fb52607aSFrederic Weisbecker void unregister_ftrace_graph(void)
456715e6cb36SFrederic Weisbecker {
4568e6ea44e9SSteven Rostedt 	mutex_lock(&ftrace_lock);
4569e7d3737eSFrederic Weisbecker 
4570597af815SSteven Rostedt 	if (unlikely(!ftrace_graph_active))
45712aad1b76SSteven Rostedt 		goto out;
45722aad1b76SSteven Rostedt 
4573597af815SSteven Rostedt 	ftrace_graph_active--;
4574287b6e68SFrederic Weisbecker 	ftrace_graph_return = (trace_func_graph_ret_t)ftrace_stub;
4575e49dc19cSSteven Rostedt 	ftrace_graph_entry = ftrace_graph_entry_stub;
4576bd69c30bSSteven Rostedt 	ftrace_shutdown(&global_ops, FTRACE_STOP_FUNC_RET);
45774a2b8ddaSFrederic Weisbecker 	unregister_pm_notifier(&ftrace_suspend_notifier);
457838516ab5SSteven Rostedt 	unregister_trace_sched_switch(ftrace_graph_probe_sched_switch, NULL);
4579e7d3737eSFrederic Weisbecker 
45802aad1b76SSteven Rostedt  out:
4581e6ea44e9SSteven Rostedt 	mutex_unlock(&ftrace_lock);
458215e6cb36SFrederic Weisbecker }
4583f201ae23SFrederic Weisbecker 
4584868baf07SSteven Rostedt static DEFINE_PER_CPU(struct ftrace_ret_stack *, idle_ret_stack);
4585868baf07SSteven Rostedt 
4586868baf07SSteven Rostedt static void
4587868baf07SSteven Rostedt graph_init_task(struct task_struct *t, struct ftrace_ret_stack *ret_stack)
4588868baf07SSteven Rostedt {
4589868baf07SSteven Rostedt 	atomic_set(&t->tracing_graph_pause, 0);
4590868baf07SSteven Rostedt 	atomic_set(&t->trace_overrun, 0);
4591868baf07SSteven Rostedt 	t->ftrace_timestamp = 0;
459225985edcSLucas De Marchi 	/* make curr_ret_stack visible before we add the ret_stack */
4593868baf07SSteven Rostedt 	smp_wmb();
4594868baf07SSteven Rostedt 	t->ret_stack = ret_stack;
4595868baf07SSteven Rostedt }
4596868baf07SSteven Rostedt 
4597868baf07SSteven Rostedt /*
4598868baf07SSteven Rostedt  * Allocate a return stack for the idle task. May be the first
4599868baf07SSteven Rostedt  * time through, or it may be done by CPU hotplug online.
4600868baf07SSteven Rostedt  */
4601868baf07SSteven Rostedt void ftrace_graph_init_idle_task(struct task_struct *t, int cpu)
4602868baf07SSteven Rostedt {
4603868baf07SSteven Rostedt 	t->curr_ret_stack = -1;
4604868baf07SSteven Rostedt 	/*
4605868baf07SSteven Rostedt 	 * The idle task has no parent, it either has its own
4606868baf07SSteven Rostedt 	 * stack or no stack at all.
4607868baf07SSteven Rostedt 	 */
4608868baf07SSteven Rostedt 	if (t->ret_stack)
4609868baf07SSteven Rostedt 		WARN_ON(t->ret_stack != per_cpu(idle_ret_stack, cpu));
4610868baf07SSteven Rostedt 
4611868baf07SSteven Rostedt 	if (ftrace_graph_active) {
4612868baf07SSteven Rostedt 		struct ftrace_ret_stack *ret_stack;
4613868baf07SSteven Rostedt 
4614868baf07SSteven Rostedt 		ret_stack = per_cpu(idle_ret_stack, cpu);
4615868baf07SSteven Rostedt 		if (!ret_stack) {
4616868baf07SSteven Rostedt 			ret_stack = kmalloc(FTRACE_RETFUNC_DEPTH
4617868baf07SSteven Rostedt 					    * sizeof(struct ftrace_ret_stack),
4618868baf07SSteven Rostedt 					    GFP_KERNEL);
4619868baf07SSteven Rostedt 			if (!ret_stack)
4620868baf07SSteven Rostedt 				return;
4621868baf07SSteven Rostedt 			per_cpu(idle_ret_stack, cpu) = ret_stack;
4622868baf07SSteven Rostedt 		}
4623868baf07SSteven Rostedt 		graph_init_task(t, ret_stack);
4624868baf07SSteven Rostedt 	}
4625868baf07SSteven Rostedt }
4626868baf07SSteven Rostedt 
4627f201ae23SFrederic Weisbecker /* Allocate a return stack for newly created task */
4628fb52607aSFrederic Weisbecker void ftrace_graph_init_task(struct task_struct *t)
4629f201ae23SFrederic Weisbecker {
463084047e36SSteven Rostedt 	/* Make sure we do not use the parent ret_stack */
463184047e36SSteven Rostedt 	t->ret_stack = NULL;
4632ea14eb71SSteven Rostedt 	t->curr_ret_stack = -1;
463384047e36SSteven Rostedt 
4634597af815SSteven Rostedt 	if (ftrace_graph_active) {
463582310a32SSteven Rostedt 		struct ftrace_ret_stack *ret_stack;
463682310a32SSteven Rostedt 
463782310a32SSteven Rostedt 		ret_stack = kmalloc(FTRACE_RETFUNC_DEPTH
4638f201ae23SFrederic Weisbecker 				* sizeof(struct ftrace_ret_stack),
4639f201ae23SFrederic Weisbecker 				GFP_KERNEL);
464082310a32SSteven Rostedt 		if (!ret_stack)
4641f201ae23SFrederic Weisbecker 			return;
4642868baf07SSteven Rostedt 		graph_init_task(t, ret_stack);
464384047e36SSteven Rostedt 	}
4644f201ae23SFrederic Weisbecker }
4645f201ae23SFrederic Weisbecker 
4646fb52607aSFrederic Weisbecker void ftrace_graph_exit_task(struct task_struct *t)
4647f201ae23SFrederic Weisbecker {
4648eae849caSFrederic Weisbecker 	struct ftrace_ret_stack	*ret_stack = t->ret_stack;
4649eae849caSFrederic Weisbecker 
4650f201ae23SFrederic Weisbecker 	t->ret_stack = NULL;
4651eae849caSFrederic Weisbecker 	/* NULL must become visible to IRQs before we free it: */
4652eae849caSFrederic Weisbecker 	barrier();
4653eae849caSFrederic Weisbecker 
4654eae849caSFrederic Weisbecker 	kfree(ret_stack);
4655f201ae23SFrederic Weisbecker }
465614a866c5SSteven Rostedt 
465714a866c5SSteven Rostedt void ftrace_graph_stop(void)
465814a866c5SSteven Rostedt {
465914a866c5SSteven Rostedt 	ftrace_stop();
466014a866c5SSteven Rostedt }
466115e6cb36SFrederic Weisbecker #endif
4662