xref: /linux-6.15/kernel/trace/ftrace.c (revision a1e2e31d)
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 
672f5f6ad9SSteven Rostedt static struct ftrace_ops ftrace_list_end __read_mostly = {
682f5f6ad9SSteven Rostedt 	.func		= ftrace_stub,
692f5f6ad9SSteven Rostedt };
702f5f6ad9SSteven Rostedt 
714eebcc81SSteven Rostedt /* ftrace_enabled is a method to turn ftrace on or off */
724eebcc81SSteven Rostedt int ftrace_enabled __read_mostly;
73d61f82d0SSteven Rostedt static int last_ftrace_enabled;
74b0fc494fSSteven Rostedt 
7560a7ecf4SSteven Rostedt /* Quick disabling of function tracer. */
762f5f6ad9SSteven Rostedt int function_trace_stop __read_mostly;
772f5f6ad9SSteven Rostedt 
782f5f6ad9SSteven Rostedt /* Current function tracing op */
792f5f6ad9SSteven Rostedt struct ftrace_ops *function_trace_op __read_mostly = &ftrace_list_end;
8060a7ecf4SSteven Rostedt 
81756d17eeS[email protected] /* List for set_ftrace_pid's pids. */
82756d17eeS[email protected] LIST_HEAD(ftrace_pids);
83756d17eeS[email protected] struct ftrace_pid {
84756d17eeS[email protected] 	struct list_head list;
85756d17eeS[email protected] 	struct pid *pid;
86756d17eeS[email protected] };
87756d17eeS[email protected] 
884eebcc81SSteven Rostedt /*
894eebcc81SSteven Rostedt  * ftrace_disabled is set when an anomaly is discovered.
904eebcc81SSteven Rostedt  * ftrace_disabled is much stronger than ftrace_enabled.
914eebcc81SSteven Rostedt  */
924eebcc81SSteven Rostedt static int ftrace_disabled __read_mostly;
934eebcc81SSteven Rostedt 
9452baf119SSteven Rostedt static DEFINE_MUTEX(ftrace_lock);
95b0fc494fSSteven Rostedt 
96b848914cSSteven Rostedt static struct ftrace_ops *ftrace_global_list __read_mostly = &ftrace_list_end;
97e248491aSJiri Olsa static struct ftrace_ops *ftrace_control_list __read_mostly = &ftrace_list_end;
98b848914cSSteven Rostedt static struct ftrace_ops *ftrace_ops_list __read_mostly = &ftrace_list_end;
9916444a8aSArnaldo Carvalho de Melo ftrace_func_t ftrace_trace_function __read_mostly = ftrace_stub;
100df4fc315SSteven Rostedt ftrace_func_t ftrace_pid_function __read_mostly = ftrace_stub;
1012b499381SSteven Rostedt static struct ftrace_ops global_ops;
102e248491aSJiri Olsa static struct ftrace_ops control_ops;
10316444a8aSArnaldo Carvalho de Melo 
1042f5f6ad9SSteven Rostedt #if ARCH_SUPPORTS_FTRACE_OPS
1052f5f6ad9SSteven Rostedt static void ftrace_ops_list_func(unsigned long ip, unsigned long parent_ip,
106*a1e2e31dSSteven Rostedt 				 struct ftrace_ops *op, struct pt_regs *regs);
1072f5f6ad9SSteven Rostedt #else
1082f5f6ad9SSteven Rostedt /* See comment below, where ftrace_ops_list_func is defined */
1092f5f6ad9SSteven Rostedt static void ftrace_ops_no_ops(unsigned long ip, unsigned long parent_ip);
1102f5f6ad9SSteven Rostedt #define ftrace_ops_list_func ((ftrace_func_t)ftrace_ops_no_ops)
1112f5f6ad9SSteven Rostedt #endif
112b848914cSSteven Rostedt 
1133f379b03SPaul E. McKenney /*
114b848914cSSteven Rostedt  * Traverse the ftrace_global_list, invoking all entries.  The reason that we
1153f379b03SPaul E. McKenney  * can use rcu_dereference_raw() is that elements removed from this list
1163f379b03SPaul E. McKenney  * are simply leaked, so there is no need to interact with a grace-period
1173f379b03SPaul E. McKenney  * mechanism.  The rcu_dereference_raw() calls are needed to handle
118b848914cSSteven Rostedt  * concurrent insertions into the ftrace_global_list.
1193f379b03SPaul E. McKenney  *
1203f379b03SPaul E. McKenney  * Silly Alpha and silly pointer-speculation compiler optimizations!
1213f379b03SPaul E. McKenney  */
1222f5f6ad9SSteven Rostedt static void
1232f5f6ad9SSteven Rostedt ftrace_global_list_func(unsigned long ip, unsigned long parent_ip,
124*a1e2e31dSSteven Rostedt 			struct ftrace_ops *op, struct pt_regs *regs)
12516444a8aSArnaldo Carvalho de Melo {
126b1cff0adSSteven Rostedt 	if (unlikely(trace_recursion_test(TRACE_GLOBAL_BIT)))
127b1cff0adSSteven Rostedt 		return;
128b1cff0adSSteven Rostedt 
129b1cff0adSSteven Rostedt 	trace_recursion_set(TRACE_GLOBAL_BIT);
130b1cff0adSSteven Rostedt 	op = rcu_dereference_raw(ftrace_global_list); /*see above*/
13116444a8aSArnaldo Carvalho de Melo 	while (op != &ftrace_list_end) {
132*a1e2e31dSSteven Rostedt 		op->func(ip, parent_ip, op, regs);
1333f379b03SPaul E. McKenney 		op = rcu_dereference_raw(op->next); /*see above*/
13416444a8aSArnaldo Carvalho de Melo 	};
135b1cff0adSSteven Rostedt 	trace_recursion_clear(TRACE_GLOBAL_BIT);
13616444a8aSArnaldo Carvalho de Melo }
13716444a8aSArnaldo Carvalho de Melo 
1382f5f6ad9SSteven Rostedt static void ftrace_pid_func(unsigned long ip, unsigned long parent_ip,
139*a1e2e31dSSteven Rostedt 			    struct ftrace_ops *op, struct pt_regs *regs)
140df4fc315SSteven Rostedt {
1410ef8cde5SSteven Rostedt 	if (!test_tsk_trace_trace(current))
142df4fc315SSteven Rostedt 		return;
143df4fc315SSteven Rostedt 
144*a1e2e31dSSteven Rostedt 	ftrace_pid_function(ip, parent_ip, op, regs);
145df4fc315SSteven Rostedt }
146df4fc315SSteven Rostedt 
147df4fc315SSteven Rostedt static void set_ftrace_pid_function(ftrace_func_t func)
148df4fc315SSteven Rostedt {
149df4fc315SSteven Rostedt 	/* do not set ftrace_pid_function to itself! */
150df4fc315SSteven Rostedt 	if (func != ftrace_pid_func)
151df4fc315SSteven Rostedt 		ftrace_pid_function = func;
152df4fc315SSteven Rostedt }
153df4fc315SSteven Rostedt 
15416444a8aSArnaldo Carvalho de Melo /**
1553d083395SSteven Rostedt  * clear_ftrace_function - reset the ftrace function
15616444a8aSArnaldo Carvalho de Melo  *
1573d083395SSteven Rostedt  * This NULLs the ftrace function and in essence stops
1583d083395SSteven Rostedt  * tracing.  There may be lag
15916444a8aSArnaldo Carvalho de Melo  */
1603d083395SSteven Rostedt void clear_ftrace_function(void)
16116444a8aSArnaldo Carvalho de Melo {
1623d083395SSteven Rostedt 	ftrace_trace_function = ftrace_stub;
163df4fc315SSteven Rostedt 	ftrace_pid_function = ftrace_stub;
1643d083395SSteven Rostedt }
16516444a8aSArnaldo Carvalho de Melo 
166e248491aSJiri Olsa static void control_ops_disable_all(struct ftrace_ops *ops)
167e248491aSJiri Olsa {
168e248491aSJiri Olsa 	int cpu;
169e248491aSJiri Olsa 
170e248491aSJiri Olsa 	for_each_possible_cpu(cpu)
171e248491aSJiri Olsa 		*per_cpu_ptr(ops->disabled, cpu) = 1;
172e248491aSJiri Olsa }
173e248491aSJiri Olsa 
174e248491aSJiri Olsa static int control_ops_alloc(struct ftrace_ops *ops)
175e248491aSJiri Olsa {
176e248491aSJiri Olsa 	int __percpu *disabled;
177e248491aSJiri Olsa 
178e248491aSJiri Olsa 	disabled = alloc_percpu(int);
179e248491aSJiri Olsa 	if (!disabled)
180e248491aSJiri Olsa 		return -ENOMEM;
181e248491aSJiri Olsa 
182e248491aSJiri Olsa 	ops->disabled = disabled;
183e248491aSJiri Olsa 	control_ops_disable_all(ops);
184e248491aSJiri Olsa 	return 0;
185e248491aSJiri Olsa }
186e248491aSJiri Olsa 
187e248491aSJiri Olsa static void control_ops_free(struct ftrace_ops *ops)
188e248491aSJiri Olsa {
189e248491aSJiri Olsa 	free_percpu(ops->disabled);
190e248491aSJiri Olsa }
191e248491aSJiri Olsa 
1922b499381SSteven Rostedt static void update_global_ops(void)
193491d0dcfSSteven Rostedt {
194491d0dcfSSteven Rostedt 	ftrace_func_t func;
195491d0dcfSSteven Rostedt 
196491d0dcfSSteven Rostedt 	/*
197491d0dcfSSteven Rostedt 	 * If there's only one function registered, then call that
198491d0dcfSSteven Rostedt 	 * function directly. Otherwise, we need to iterate over the
199491d0dcfSSteven Rostedt 	 * registered callers.
200491d0dcfSSteven Rostedt 	 */
201b848914cSSteven Rostedt 	if (ftrace_global_list == &ftrace_list_end ||
202b848914cSSteven Rostedt 	    ftrace_global_list->next == &ftrace_list_end)
203b848914cSSteven Rostedt 		func = ftrace_global_list->func;
204491d0dcfSSteven Rostedt 	else
205b848914cSSteven Rostedt 		func = ftrace_global_list_func;
206491d0dcfSSteven Rostedt 
207491d0dcfSSteven Rostedt 	/* If we filter on pids, update to use the pid function */
208491d0dcfSSteven Rostedt 	if (!list_empty(&ftrace_pids)) {
209491d0dcfSSteven Rostedt 		set_ftrace_pid_function(func);
210491d0dcfSSteven Rostedt 		func = ftrace_pid_func;
211491d0dcfSSteven Rostedt 	}
2122b499381SSteven Rostedt 
2132b499381SSteven Rostedt 	global_ops.func = func;
2142b499381SSteven Rostedt }
2152b499381SSteven Rostedt 
2162b499381SSteven Rostedt static void update_ftrace_function(void)
2172b499381SSteven Rostedt {
2182b499381SSteven Rostedt 	ftrace_func_t func;
2192b499381SSteven Rostedt 
2202b499381SSteven Rostedt 	update_global_ops();
2212b499381SSteven Rostedt 
222cdbe61bfSSteven Rostedt 	/*
223cdbe61bfSSteven Rostedt 	 * If we are at the end of the list and this ops is
2242f5f6ad9SSteven Rostedt 	 * not dynamic and the arch supports passing ops, then have the
2252f5f6ad9SSteven Rostedt 	 * mcount trampoline call the function directly.
226cdbe61bfSSteven Rostedt 	 */
227b848914cSSteven Rostedt 	if (ftrace_ops_list == &ftrace_list_end ||
228cdbe61bfSSteven Rostedt 	    (ftrace_ops_list->next == &ftrace_list_end &&
2292f5f6ad9SSteven Rostedt 	     !(ftrace_ops_list->flags & FTRACE_OPS_FL_DYNAMIC) &&
230ccf3672dSSteven Rostedt 	     !FTRACE_FORCE_LIST_FUNC)) {
2312f5f6ad9SSteven Rostedt 		/* Set the ftrace_ops that the arch callback uses */
2322f5f6ad9SSteven Rostedt 		if (ftrace_ops_list == &global_ops)
2332f5f6ad9SSteven Rostedt 			function_trace_op = ftrace_global_list;
234b848914cSSteven Rostedt 		else
2352f5f6ad9SSteven Rostedt 			function_trace_op = ftrace_ops_list;
2362f5f6ad9SSteven Rostedt 		func = ftrace_ops_list->func;
2372f5f6ad9SSteven Rostedt 	} else {
2382f5f6ad9SSteven Rostedt 		/* Just use the default ftrace_ops */
2392f5f6ad9SSteven Rostedt 		function_trace_op = &ftrace_list_end;
240b848914cSSteven Rostedt 		func = ftrace_ops_list_func;
2412f5f6ad9SSteven Rostedt 	}
2422b499381SSteven Rostedt 
243491d0dcfSSteven Rostedt 	ftrace_trace_function = func;
244491d0dcfSSteven Rostedt }
245491d0dcfSSteven Rostedt 
2462b499381SSteven Rostedt static void add_ftrace_ops(struct ftrace_ops **list, struct ftrace_ops *ops)
2473d083395SSteven Rostedt {
2482b499381SSteven Rostedt 	ops->next = *list;
24916444a8aSArnaldo Carvalho de Melo 	/*
250b848914cSSteven Rostedt 	 * We are entering ops into the list but another
25116444a8aSArnaldo Carvalho de Melo 	 * CPU might be walking that list. We need to make sure
25216444a8aSArnaldo Carvalho de Melo 	 * the ops->next pointer is valid before another CPU sees
253b848914cSSteven Rostedt 	 * the ops pointer included into the list.
25416444a8aSArnaldo Carvalho de Melo 	 */
2552b499381SSteven Rostedt 	rcu_assign_pointer(*list, ops);
2562b499381SSteven Rostedt }
2573d083395SSteven Rostedt 
2582b499381SSteven Rostedt static int remove_ftrace_ops(struct ftrace_ops **list, struct ftrace_ops *ops)
2592b499381SSteven Rostedt {
2602b499381SSteven Rostedt 	struct ftrace_ops **p;
2612b499381SSteven Rostedt 
2622b499381SSteven Rostedt 	/*
2632b499381SSteven Rostedt 	 * If we are removing the last function, then simply point
2642b499381SSteven Rostedt 	 * to the ftrace_stub.
2652b499381SSteven Rostedt 	 */
2662b499381SSteven Rostedt 	if (*list == ops && ops->next == &ftrace_list_end) {
2672b499381SSteven Rostedt 		*list = &ftrace_list_end;
2682b499381SSteven Rostedt 		return 0;
2692b499381SSteven Rostedt 	}
2702b499381SSteven Rostedt 
2712b499381SSteven Rostedt 	for (p = list; *p != &ftrace_list_end; p = &(*p)->next)
2722b499381SSteven Rostedt 		if (*p == ops)
2732b499381SSteven Rostedt 			break;
2742b499381SSteven Rostedt 
2752b499381SSteven Rostedt 	if (*p != ops)
2762b499381SSteven Rostedt 		return -1;
2772b499381SSteven Rostedt 
2782b499381SSteven Rostedt 	*p = (*p)->next;
2792b499381SSteven Rostedt 	return 0;
2802b499381SSteven Rostedt }
2812b499381SSteven Rostedt 
282e248491aSJiri Olsa static void add_ftrace_list_ops(struct ftrace_ops **list,
283e248491aSJiri Olsa 				struct ftrace_ops *main_ops,
284e248491aSJiri Olsa 				struct ftrace_ops *ops)
285e248491aSJiri Olsa {
286e248491aSJiri Olsa 	int first = *list == &ftrace_list_end;
287e248491aSJiri Olsa 	add_ftrace_ops(list, ops);
288e248491aSJiri Olsa 	if (first)
289e248491aSJiri Olsa 		add_ftrace_ops(&ftrace_ops_list, main_ops);
290e248491aSJiri Olsa }
291e248491aSJiri Olsa 
292e248491aSJiri Olsa static int remove_ftrace_list_ops(struct ftrace_ops **list,
293e248491aSJiri Olsa 				  struct ftrace_ops *main_ops,
294e248491aSJiri Olsa 				  struct ftrace_ops *ops)
295e248491aSJiri Olsa {
296e248491aSJiri Olsa 	int ret = remove_ftrace_ops(list, ops);
297e248491aSJiri Olsa 	if (!ret && *list == &ftrace_list_end)
298e248491aSJiri Olsa 		ret = remove_ftrace_ops(&ftrace_ops_list, main_ops);
299e248491aSJiri Olsa 	return ret;
300e248491aSJiri Olsa }
301e248491aSJiri Olsa 
3022b499381SSteven Rostedt static int __register_ftrace_function(struct ftrace_ops *ops)
3032b499381SSteven Rostedt {
3048d240dd8SBorislav Petkov 	if (unlikely(ftrace_disabled))
3052b499381SSteven Rostedt 		return -ENODEV;
3062b499381SSteven Rostedt 
3072b499381SSteven Rostedt 	if (FTRACE_WARN_ON(ops == &global_ops))
3082b499381SSteven Rostedt 		return -EINVAL;
3092b499381SSteven Rostedt 
310b848914cSSteven Rostedt 	if (WARN_ON(ops->flags & FTRACE_OPS_FL_ENABLED))
311b848914cSSteven Rostedt 		return -EBUSY;
312b848914cSSteven Rostedt 
313e248491aSJiri Olsa 	/* We don't support both control and global flags set. */
314e248491aSJiri Olsa 	if ((ops->flags & FL_GLOBAL_CONTROL_MASK) == FL_GLOBAL_CONTROL_MASK)
315e248491aSJiri Olsa 		return -EINVAL;
316e248491aSJiri Olsa 
317cdbe61bfSSteven Rostedt 	if (!core_kernel_data((unsigned long)ops))
318cdbe61bfSSteven Rostedt 		ops->flags |= FTRACE_OPS_FL_DYNAMIC;
319cdbe61bfSSteven Rostedt 
320b848914cSSteven Rostedt 	if (ops->flags & FTRACE_OPS_FL_GLOBAL) {
321e248491aSJiri Olsa 		add_ftrace_list_ops(&ftrace_global_list, &global_ops, ops);
322b848914cSSteven Rostedt 		ops->flags |= FTRACE_OPS_FL_ENABLED;
323e248491aSJiri Olsa 	} else if (ops->flags & FTRACE_OPS_FL_CONTROL) {
324e248491aSJiri Olsa 		if (control_ops_alloc(ops))
325e248491aSJiri Olsa 			return -ENOMEM;
326e248491aSJiri Olsa 		add_ftrace_list_ops(&ftrace_control_list, &control_ops, ops);
327b848914cSSteven Rostedt 	} else
328b848914cSSteven Rostedt 		add_ftrace_ops(&ftrace_ops_list, ops);
329b848914cSSteven Rostedt 
330491d0dcfSSteven Rostedt 	if (ftrace_enabled)
331491d0dcfSSteven Rostedt 		update_ftrace_function();
3323d083395SSteven Rostedt 
33316444a8aSArnaldo Carvalho de Melo 	return 0;
33416444a8aSArnaldo Carvalho de Melo }
33516444a8aSArnaldo Carvalho de Melo 
336e309b41dSIngo Molnar static int __unregister_ftrace_function(struct ftrace_ops *ops)
33716444a8aSArnaldo Carvalho de Melo {
3382b499381SSteven Rostedt 	int ret;
33916444a8aSArnaldo Carvalho de Melo 
3402b499381SSteven Rostedt 	if (ftrace_disabled)
3412b499381SSteven Rostedt 		return -ENODEV;
34216444a8aSArnaldo Carvalho de Melo 
343b848914cSSteven Rostedt 	if (WARN_ON(!(ops->flags & FTRACE_OPS_FL_ENABLED)))
344b848914cSSteven Rostedt 		return -EBUSY;
345b848914cSSteven Rostedt 
3462b499381SSteven Rostedt 	if (FTRACE_WARN_ON(ops == &global_ops))
3472b499381SSteven Rostedt 		return -EINVAL;
34816444a8aSArnaldo Carvalho de Melo 
349b848914cSSteven Rostedt 	if (ops->flags & FTRACE_OPS_FL_GLOBAL) {
350e248491aSJiri Olsa 		ret = remove_ftrace_list_ops(&ftrace_global_list,
351e248491aSJiri Olsa 					     &global_ops, ops);
352b848914cSSteven Rostedt 		if (!ret)
353b848914cSSteven Rostedt 			ops->flags &= ~FTRACE_OPS_FL_ENABLED;
354e248491aSJiri Olsa 	} else if (ops->flags & FTRACE_OPS_FL_CONTROL) {
355e248491aSJiri Olsa 		ret = remove_ftrace_list_ops(&ftrace_control_list,
356e248491aSJiri Olsa 					     &control_ops, ops);
357e248491aSJiri Olsa 		if (!ret) {
358e248491aSJiri Olsa 			/*
359e248491aSJiri Olsa 			 * The ftrace_ops is now removed from the list,
360e248491aSJiri Olsa 			 * so there'll be no new users. We must ensure
361e248491aSJiri Olsa 			 * all current users are done before we free
362e248491aSJiri Olsa 			 * the control data.
363e248491aSJiri Olsa 			 */
364e248491aSJiri Olsa 			synchronize_sched();
365e248491aSJiri Olsa 			control_ops_free(ops);
366e248491aSJiri Olsa 		}
367b848914cSSteven Rostedt 	} else
368b848914cSSteven Rostedt 		ret = remove_ftrace_ops(&ftrace_ops_list, ops);
369b848914cSSteven Rostedt 
3702b499381SSteven Rostedt 	if (ret < 0)
3712b499381SSteven Rostedt 		return ret;
372b848914cSSteven Rostedt 
373491d0dcfSSteven Rostedt 	if (ftrace_enabled)
374491d0dcfSSteven Rostedt 		update_ftrace_function();
37516444a8aSArnaldo Carvalho de Melo 
376cdbe61bfSSteven Rostedt 	/*
377cdbe61bfSSteven Rostedt 	 * Dynamic ops may be freed, we must make sure that all
378cdbe61bfSSteven Rostedt 	 * callers are done before leaving this function.
379cdbe61bfSSteven Rostedt 	 */
380cdbe61bfSSteven Rostedt 	if (ops->flags & FTRACE_OPS_FL_DYNAMIC)
381cdbe61bfSSteven Rostedt 		synchronize_sched();
382cdbe61bfSSteven Rostedt 
383e6ea44e9SSteven Rostedt 	return 0;
3843d083395SSteven Rostedt }
3853d083395SSteven Rostedt 
386df4fc315SSteven Rostedt static void ftrace_update_pid_func(void)
387df4fc315SSteven Rostedt {
388491d0dcfSSteven Rostedt 	/* Only do something if we are tracing something */
389df4fc315SSteven Rostedt 	if (ftrace_trace_function == ftrace_stub)
39010dd3ebeSKOSAKI Motohiro 		return;
391df4fc315SSteven Rostedt 
392491d0dcfSSteven Rostedt 	update_ftrace_function();
393df4fc315SSteven Rostedt }
394df4fc315SSteven Rostedt 
395493762fcSSteven Rostedt #ifdef CONFIG_FUNCTION_PROFILER
396493762fcSSteven Rostedt struct ftrace_profile {
397493762fcSSteven Rostedt 	struct hlist_node		node;
398493762fcSSteven Rostedt 	unsigned long			ip;
399493762fcSSteven Rostedt 	unsigned long			counter;
4000706f1c4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
4010706f1c4SSteven Rostedt 	unsigned long long		time;
402e330b3bcSChase Douglas 	unsigned long long		time_squared;
4030706f1c4SSteven Rostedt #endif
404493762fcSSteven Rostedt };
405493762fcSSteven Rostedt 
406493762fcSSteven Rostedt struct ftrace_profile_page {
407493762fcSSteven Rostedt 	struct ftrace_profile_page	*next;
408493762fcSSteven Rostedt 	unsigned long			index;
409493762fcSSteven Rostedt 	struct ftrace_profile		records[];
410493762fcSSteven Rostedt };
411493762fcSSteven Rostedt 
412cafb168aSSteven Rostedt struct ftrace_profile_stat {
413cafb168aSSteven Rostedt 	atomic_t			disabled;
414cafb168aSSteven Rostedt 	struct hlist_head		*hash;
415cafb168aSSteven Rostedt 	struct ftrace_profile_page	*pages;
416cafb168aSSteven Rostedt 	struct ftrace_profile_page	*start;
417cafb168aSSteven Rostedt 	struct tracer_stat		stat;
418cafb168aSSteven Rostedt };
419cafb168aSSteven Rostedt 
420493762fcSSteven Rostedt #define PROFILE_RECORDS_SIZE						\
421493762fcSSteven Rostedt 	(PAGE_SIZE - offsetof(struct ftrace_profile_page, records))
422493762fcSSteven Rostedt 
423493762fcSSteven Rostedt #define PROFILES_PER_PAGE					\
424493762fcSSteven Rostedt 	(PROFILE_RECORDS_SIZE / sizeof(struct ftrace_profile))
425493762fcSSteven Rostedt 
426fb9fb015SSteven Rostedt static int ftrace_profile_bits __read_mostly;
427fb9fb015SSteven Rostedt static int ftrace_profile_enabled __read_mostly;
428fb9fb015SSteven Rostedt 
429fb9fb015SSteven Rostedt /* ftrace_profile_lock - synchronize the enable and disable of the profiler */
430493762fcSSteven Rostedt static DEFINE_MUTEX(ftrace_profile_lock);
431493762fcSSteven Rostedt 
432cafb168aSSteven Rostedt static DEFINE_PER_CPU(struct ftrace_profile_stat, ftrace_profile_stats);
433493762fcSSteven Rostedt 
434493762fcSSteven Rostedt #define FTRACE_PROFILE_HASH_SIZE 1024 /* must be power of 2 */
435493762fcSSteven Rostedt 
436493762fcSSteven Rostedt static void *
437493762fcSSteven Rostedt function_stat_next(void *v, int idx)
438493762fcSSteven Rostedt {
439493762fcSSteven Rostedt 	struct ftrace_profile *rec = v;
440493762fcSSteven Rostedt 	struct ftrace_profile_page *pg;
441493762fcSSteven Rostedt 
442493762fcSSteven Rostedt 	pg = (struct ftrace_profile_page *)((unsigned long)rec & PAGE_MASK);
443493762fcSSteven Rostedt 
444493762fcSSteven Rostedt  again:
4450296e425SLi Zefan 	if (idx != 0)
446493762fcSSteven Rostedt 		rec++;
4470296e425SLi Zefan 
448493762fcSSteven Rostedt 	if ((void *)rec >= (void *)&pg->records[pg->index]) {
449493762fcSSteven Rostedt 		pg = pg->next;
450493762fcSSteven Rostedt 		if (!pg)
451493762fcSSteven Rostedt 			return NULL;
452493762fcSSteven Rostedt 		rec = &pg->records[0];
453493762fcSSteven Rostedt 		if (!rec->counter)
454493762fcSSteven Rostedt 			goto again;
455493762fcSSteven Rostedt 	}
456493762fcSSteven Rostedt 
457493762fcSSteven Rostedt 	return rec;
458493762fcSSteven Rostedt }
459493762fcSSteven Rostedt 
460493762fcSSteven Rostedt static void *function_stat_start(struct tracer_stat *trace)
461493762fcSSteven Rostedt {
462cafb168aSSteven Rostedt 	struct ftrace_profile_stat *stat =
463cafb168aSSteven Rostedt 		container_of(trace, struct ftrace_profile_stat, stat);
464cafb168aSSteven Rostedt 
465cafb168aSSteven Rostedt 	if (!stat || !stat->start)
466cafb168aSSteven Rostedt 		return NULL;
467cafb168aSSteven Rostedt 
468cafb168aSSteven Rostedt 	return function_stat_next(&stat->start->records[0], 0);
469493762fcSSteven Rostedt }
470493762fcSSteven Rostedt 
4710706f1c4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
4720706f1c4SSteven Rostedt /* function graph compares on total time */
4730706f1c4SSteven Rostedt static int function_stat_cmp(void *p1, void *p2)
4740706f1c4SSteven Rostedt {
4750706f1c4SSteven Rostedt 	struct ftrace_profile *a = p1;
4760706f1c4SSteven Rostedt 	struct ftrace_profile *b = p2;
4770706f1c4SSteven Rostedt 
4780706f1c4SSteven Rostedt 	if (a->time < b->time)
4790706f1c4SSteven Rostedt 		return -1;
4800706f1c4SSteven Rostedt 	if (a->time > b->time)
4810706f1c4SSteven Rostedt 		return 1;
4820706f1c4SSteven Rostedt 	else
4830706f1c4SSteven Rostedt 		return 0;
4840706f1c4SSteven Rostedt }
4850706f1c4SSteven Rostedt #else
4860706f1c4SSteven Rostedt /* not function graph compares against hits */
487493762fcSSteven Rostedt static int function_stat_cmp(void *p1, void *p2)
488493762fcSSteven Rostedt {
489493762fcSSteven Rostedt 	struct ftrace_profile *a = p1;
490493762fcSSteven Rostedt 	struct ftrace_profile *b = p2;
491493762fcSSteven Rostedt 
492493762fcSSteven Rostedt 	if (a->counter < b->counter)
493493762fcSSteven Rostedt 		return -1;
494493762fcSSteven Rostedt 	if (a->counter > b->counter)
495493762fcSSteven Rostedt 		return 1;
496493762fcSSteven Rostedt 	else
497493762fcSSteven Rostedt 		return 0;
498493762fcSSteven Rostedt }
4990706f1c4SSteven Rostedt #endif
500493762fcSSteven Rostedt 
501493762fcSSteven Rostedt static int function_stat_headers(struct seq_file *m)
502493762fcSSteven Rostedt {
5030706f1c4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
50434886c8bSSteven Rostedt 	seq_printf(m, "  Function                               "
505e330b3bcSChase Douglas 		   "Hit    Time            Avg             s^2\n"
50634886c8bSSteven Rostedt 		      "  --------                               "
507e330b3bcSChase Douglas 		   "---    ----            ---             ---\n");
5080706f1c4SSteven Rostedt #else
509493762fcSSteven Rostedt 	seq_printf(m, "  Function                               Hit\n"
510493762fcSSteven Rostedt 		      "  --------                               ---\n");
5110706f1c4SSteven Rostedt #endif
512493762fcSSteven Rostedt 	return 0;
513493762fcSSteven Rostedt }
514493762fcSSteven Rostedt 
515493762fcSSteven Rostedt static int function_stat_show(struct seq_file *m, void *v)
516493762fcSSteven Rostedt {
517493762fcSSteven Rostedt 	struct ftrace_profile *rec = v;
518493762fcSSteven Rostedt 	char str[KSYM_SYMBOL_LEN];
5193aaba20fSLi Zefan 	int ret = 0;
5200706f1c4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
52134886c8bSSteven Rostedt 	static struct trace_seq s;
52234886c8bSSteven Rostedt 	unsigned long long avg;
523e330b3bcSChase Douglas 	unsigned long long stddev;
5240706f1c4SSteven Rostedt #endif
5253aaba20fSLi Zefan 	mutex_lock(&ftrace_profile_lock);
5263aaba20fSLi Zefan 
5273aaba20fSLi Zefan 	/* we raced with function_profile_reset() */
5283aaba20fSLi Zefan 	if (unlikely(rec->counter == 0)) {
5293aaba20fSLi Zefan 		ret = -EBUSY;
5303aaba20fSLi Zefan 		goto out;
5313aaba20fSLi Zefan 	}
532493762fcSSteven Rostedt 
533493762fcSSteven Rostedt 	kallsyms_lookup(rec->ip, NULL, NULL, NULL, str);
5340706f1c4SSteven Rostedt 	seq_printf(m, "  %-30.30s  %10lu", str, rec->counter);
535493762fcSSteven Rostedt 
5360706f1c4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
5370706f1c4SSteven Rostedt 	seq_printf(m, "    ");
53834886c8bSSteven Rostedt 	avg = rec->time;
53934886c8bSSteven Rostedt 	do_div(avg, rec->counter);
54034886c8bSSteven Rostedt 
541e330b3bcSChase Douglas 	/* Sample standard deviation (s^2) */
542e330b3bcSChase Douglas 	if (rec->counter <= 1)
543e330b3bcSChase Douglas 		stddev = 0;
544e330b3bcSChase Douglas 	else {
545e330b3bcSChase Douglas 		stddev = rec->time_squared - rec->counter * avg * avg;
546e330b3bcSChase Douglas 		/*
547e330b3bcSChase Douglas 		 * Divide only 1000 for ns^2 -> us^2 conversion.
548e330b3bcSChase Douglas 		 * trace_print_graph_duration will divide 1000 again.
549e330b3bcSChase Douglas 		 */
550e330b3bcSChase Douglas 		do_div(stddev, (rec->counter - 1) * 1000);
551e330b3bcSChase Douglas 	}
552e330b3bcSChase Douglas 
55334886c8bSSteven Rostedt 	trace_seq_init(&s);
55434886c8bSSteven Rostedt 	trace_print_graph_duration(rec->time, &s);
55534886c8bSSteven Rostedt 	trace_seq_puts(&s, "    ");
55634886c8bSSteven Rostedt 	trace_print_graph_duration(avg, &s);
557e330b3bcSChase Douglas 	trace_seq_puts(&s, "    ");
558e330b3bcSChase Douglas 	trace_print_graph_duration(stddev, &s);
5590706f1c4SSteven Rostedt 	trace_print_seq(m, &s);
5600706f1c4SSteven Rostedt #endif
5610706f1c4SSteven Rostedt 	seq_putc(m, '\n');
5623aaba20fSLi Zefan out:
5633aaba20fSLi Zefan 	mutex_unlock(&ftrace_profile_lock);
5640706f1c4SSteven Rostedt 
5653aaba20fSLi Zefan 	return ret;
566493762fcSSteven Rostedt }
567493762fcSSteven Rostedt 
568cafb168aSSteven Rostedt static void ftrace_profile_reset(struct ftrace_profile_stat *stat)
569493762fcSSteven Rostedt {
570493762fcSSteven Rostedt 	struct ftrace_profile_page *pg;
571493762fcSSteven Rostedt 
572cafb168aSSteven Rostedt 	pg = stat->pages = stat->start;
573493762fcSSteven Rostedt 
574493762fcSSteven Rostedt 	while (pg) {
575493762fcSSteven Rostedt 		memset(pg->records, 0, PROFILE_RECORDS_SIZE);
576493762fcSSteven Rostedt 		pg->index = 0;
577493762fcSSteven Rostedt 		pg = pg->next;
578493762fcSSteven Rostedt 	}
579493762fcSSteven Rostedt 
580cafb168aSSteven Rostedt 	memset(stat->hash, 0,
581493762fcSSteven Rostedt 	       FTRACE_PROFILE_HASH_SIZE * sizeof(struct hlist_head));
582493762fcSSteven Rostedt }
583493762fcSSteven Rostedt 
584cafb168aSSteven Rostedt int ftrace_profile_pages_init(struct ftrace_profile_stat *stat)
585493762fcSSteven Rostedt {
586493762fcSSteven Rostedt 	struct ftrace_profile_page *pg;
587318e0a73SSteven Rostedt 	int functions;
588318e0a73SSteven Rostedt 	int pages;
589493762fcSSteven Rostedt 	int i;
590493762fcSSteven Rostedt 
591493762fcSSteven Rostedt 	/* If we already allocated, do nothing */
592cafb168aSSteven Rostedt 	if (stat->pages)
593493762fcSSteven Rostedt 		return 0;
594493762fcSSteven Rostedt 
595cafb168aSSteven Rostedt 	stat->pages = (void *)get_zeroed_page(GFP_KERNEL);
596cafb168aSSteven Rostedt 	if (!stat->pages)
597493762fcSSteven Rostedt 		return -ENOMEM;
598493762fcSSteven Rostedt 
599318e0a73SSteven Rostedt #ifdef CONFIG_DYNAMIC_FTRACE
600318e0a73SSteven Rostedt 	functions = ftrace_update_tot_cnt;
601318e0a73SSteven Rostedt #else
602318e0a73SSteven Rostedt 	/*
603318e0a73SSteven Rostedt 	 * We do not know the number of functions that exist because
604318e0a73SSteven Rostedt 	 * dynamic tracing is what counts them. With past experience
605318e0a73SSteven Rostedt 	 * we have around 20K functions. That should be more than enough.
606318e0a73SSteven Rostedt 	 * It is highly unlikely we will execute every function in
607318e0a73SSteven Rostedt 	 * the kernel.
608318e0a73SSteven Rostedt 	 */
609318e0a73SSteven Rostedt 	functions = 20000;
610318e0a73SSteven Rostedt #endif
611318e0a73SSteven Rostedt 
612cafb168aSSteven Rostedt 	pg = stat->start = stat->pages;
613493762fcSSteven Rostedt 
614318e0a73SSteven Rostedt 	pages = DIV_ROUND_UP(functions, PROFILES_PER_PAGE);
615318e0a73SSteven Rostedt 
616318e0a73SSteven Rostedt 	for (i = 0; i < pages; i++) {
617493762fcSSteven Rostedt 		pg->next = (void *)get_zeroed_page(GFP_KERNEL);
618493762fcSSteven Rostedt 		if (!pg->next)
619318e0a73SSteven Rostedt 			goto out_free;
620493762fcSSteven Rostedt 		pg = pg->next;
621493762fcSSteven Rostedt 	}
622493762fcSSteven Rostedt 
623493762fcSSteven Rostedt 	return 0;
624318e0a73SSteven Rostedt 
625318e0a73SSteven Rostedt  out_free:
626318e0a73SSteven Rostedt 	pg = stat->start;
627318e0a73SSteven Rostedt 	while (pg) {
628318e0a73SSteven Rostedt 		unsigned long tmp = (unsigned long)pg;
629318e0a73SSteven Rostedt 
630318e0a73SSteven Rostedt 		pg = pg->next;
631318e0a73SSteven Rostedt 		free_page(tmp);
632318e0a73SSteven Rostedt 	}
633318e0a73SSteven Rostedt 
634318e0a73SSteven Rostedt 	free_page((unsigned long)stat->pages);
635318e0a73SSteven Rostedt 	stat->pages = NULL;
636318e0a73SSteven Rostedt 	stat->start = NULL;
637318e0a73SSteven Rostedt 
638318e0a73SSteven Rostedt 	return -ENOMEM;
639493762fcSSteven Rostedt }
640493762fcSSteven Rostedt 
641cafb168aSSteven Rostedt static int ftrace_profile_init_cpu(int cpu)
642493762fcSSteven Rostedt {
643cafb168aSSteven Rostedt 	struct ftrace_profile_stat *stat;
644493762fcSSteven Rostedt 	int size;
645493762fcSSteven Rostedt 
646cafb168aSSteven Rostedt 	stat = &per_cpu(ftrace_profile_stats, cpu);
647cafb168aSSteven Rostedt 
648cafb168aSSteven Rostedt 	if (stat->hash) {
649493762fcSSteven Rostedt 		/* If the profile is already created, simply reset it */
650cafb168aSSteven Rostedt 		ftrace_profile_reset(stat);
651493762fcSSteven Rostedt 		return 0;
652493762fcSSteven Rostedt 	}
653493762fcSSteven Rostedt 
654493762fcSSteven Rostedt 	/*
655493762fcSSteven Rostedt 	 * We are profiling all functions, but usually only a few thousand
656493762fcSSteven Rostedt 	 * functions are hit. We'll make a hash of 1024 items.
657493762fcSSteven Rostedt 	 */
658493762fcSSteven Rostedt 	size = FTRACE_PROFILE_HASH_SIZE;
659493762fcSSteven Rostedt 
660cafb168aSSteven Rostedt 	stat->hash = kzalloc(sizeof(struct hlist_head) * size, GFP_KERNEL);
661493762fcSSteven Rostedt 
662cafb168aSSteven Rostedt 	if (!stat->hash)
663493762fcSSteven Rostedt 		return -ENOMEM;
664493762fcSSteven Rostedt 
665cafb168aSSteven Rostedt 	if (!ftrace_profile_bits) {
666493762fcSSteven Rostedt 		size--;
667493762fcSSteven Rostedt 
668493762fcSSteven Rostedt 		for (; size; size >>= 1)
669493762fcSSteven Rostedt 			ftrace_profile_bits++;
670cafb168aSSteven Rostedt 	}
671493762fcSSteven Rostedt 
672318e0a73SSteven Rostedt 	/* Preallocate the function profiling pages */
673cafb168aSSteven Rostedt 	if (ftrace_profile_pages_init(stat) < 0) {
674cafb168aSSteven Rostedt 		kfree(stat->hash);
675cafb168aSSteven Rostedt 		stat->hash = NULL;
676493762fcSSteven Rostedt 		return -ENOMEM;
677493762fcSSteven Rostedt 	}
678493762fcSSteven Rostedt 
679493762fcSSteven Rostedt 	return 0;
680493762fcSSteven Rostedt }
681493762fcSSteven Rostedt 
682cafb168aSSteven Rostedt static int ftrace_profile_init(void)
683cafb168aSSteven Rostedt {
684cafb168aSSteven Rostedt 	int cpu;
685cafb168aSSteven Rostedt 	int ret = 0;
686cafb168aSSteven Rostedt 
687cafb168aSSteven Rostedt 	for_each_online_cpu(cpu) {
688cafb168aSSteven Rostedt 		ret = ftrace_profile_init_cpu(cpu);
689cafb168aSSteven Rostedt 		if (ret)
690cafb168aSSteven Rostedt 			break;
691cafb168aSSteven Rostedt 	}
692cafb168aSSteven Rostedt 
693cafb168aSSteven Rostedt 	return ret;
694cafb168aSSteven Rostedt }
695cafb168aSSteven Rostedt 
696493762fcSSteven Rostedt /* interrupts must be disabled */
697cafb168aSSteven Rostedt static struct ftrace_profile *
698cafb168aSSteven Rostedt ftrace_find_profiled_func(struct ftrace_profile_stat *stat, unsigned long ip)
699493762fcSSteven Rostedt {
700493762fcSSteven Rostedt 	struct ftrace_profile *rec;
701493762fcSSteven Rostedt 	struct hlist_head *hhd;
702493762fcSSteven Rostedt 	struct hlist_node *n;
703493762fcSSteven Rostedt 	unsigned long key;
704493762fcSSteven Rostedt 
705493762fcSSteven Rostedt 	key = hash_long(ip, ftrace_profile_bits);
706cafb168aSSteven Rostedt 	hhd = &stat->hash[key];
707493762fcSSteven Rostedt 
708493762fcSSteven Rostedt 	if (hlist_empty(hhd))
709493762fcSSteven Rostedt 		return NULL;
710493762fcSSteven Rostedt 
711493762fcSSteven Rostedt 	hlist_for_each_entry_rcu(rec, n, hhd, node) {
712493762fcSSteven Rostedt 		if (rec->ip == ip)
713493762fcSSteven Rostedt 			return rec;
714493762fcSSteven Rostedt 	}
715493762fcSSteven Rostedt 
716493762fcSSteven Rostedt 	return NULL;
717493762fcSSteven Rostedt }
718493762fcSSteven Rostedt 
719cafb168aSSteven Rostedt static void ftrace_add_profile(struct ftrace_profile_stat *stat,
720cafb168aSSteven Rostedt 			       struct ftrace_profile *rec)
721493762fcSSteven Rostedt {
722493762fcSSteven Rostedt 	unsigned long key;
723493762fcSSteven Rostedt 
724493762fcSSteven Rostedt 	key = hash_long(rec->ip, ftrace_profile_bits);
725cafb168aSSteven Rostedt 	hlist_add_head_rcu(&rec->node, &stat->hash[key]);
726493762fcSSteven Rostedt }
727493762fcSSteven Rostedt 
728318e0a73SSteven Rostedt /*
729318e0a73SSteven Rostedt  * The memory is already allocated, this simply finds a new record to use.
730318e0a73SSteven Rostedt  */
731493762fcSSteven Rostedt static struct ftrace_profile *
732318e0a73SSteven Rostedt ftrace_profile_alloc(struct ftrace_profile_stat *stat, unsigned long ip)
733493762fcSSteven Rostedt {
734493762fcSSteven Rostedt 	struct ftrace_profile *rec = NULL;
735493762fcSSteven Rostedt 
736318e0a73SSteven Rostedt 	/* prevent recursion (from NMIs) */
737cafb168aSSteven Rostedt 	if (atomic_inc_return(&stat->disabled) != 1)
738493762fcSSteven Rostedt 		goto out;
739493762fcSSteven Rostedt 
740493762fcSSteven Rostedt 	/*
741318e0a73SSteven Rostedt 	 * Try to find the function again since an NMI
742318e0a73SSteven Rostedt 	 * could have added it
743493762fcSSteven Rostedt 	 */
744cafb168aSSteven Rostedt 	rec = ftrace_find_profiled_func(stat, ip);
745493762fcSSteven Rostedt 	if (rec)
746cafb168aSSteven Rostedt 		goto out;
747493762fcSSteven Rostedt 
748cafb168aSSteven Rostedt 	if (stat->pages->index == PROFILES_PER_PAGE) {
749cafb168aSSteven Rostedt 		if (!stat->pages->next)
750cafb168aSSteven Rostedt 			goto out;
751cafb168aSSteven Rostedt 		stat->pages = stat->pages->next;
752493762fcSSteven Rostedt 	}
753493762fcSSteven Rostedt 
754cafb168aSSteven Rostedt 	rec = &stat->pages->records[stat->pages->index++];
755493762fcSSteven Rostedt 	rec->ip = ip;
756cafb168aSSteven Rostedt 	ftrace_add_profile(stat, rec);
757493762fcSSteven Rostedt 
758493762fcSSteven Rostedt  out:
759cafb168aSSteven Rostedt 	atomic_dec(&stat->disabled);
760493762fcSSteven Rostedt 
761493762fcSSteven Rostedt 	return rec;
762493762fcSSteven Rostedt }
763493762fcSSteven Rostedt 
764493762fcSSteven Rostedt static void
7652f5f6ad9SSteven Rostedt function_profile_call(unsigned long ip, unsigned long parent_ip,
766*a1e2e31dSSteven Rostedt 		      struct ftrace_ops *ops, struct pt_regs *regs)
767493762fcSSteven Rostedt {
768cafb168aSSteven Rostedt 	struct ftrace_profile_stat *stat;
769493762fcSSteven Rostedt 	struct ftrace_profile *rec;
770493762fcSSteven Rostedt 	unsigned long flags;
771493762fcSSteven Rostedt 
772493762fcSSteven Rostedt 	if (!ftrace_profile_enabled)
773493762fcSSteven Rostedt 		return;
774493762fcSSteven Rostedt 
775493762fcSSteven Rostedt 	local_irq_save(flags);
776cafb168aSSteven Rostedt 
777cafb168aSSteven Rostedt 	stat = &__get_cpu_var(ftrace_profile_stats);
7780f6ce3deSSteven Rostedt 	if (!stat->hash || !ftrace_profile_enabled)
779cafb168aSSteven Rostedt 		goto out;
780cafb168aSSteven Rostedt 
781cafb168aSSteven Rostedt 	rec = ftrace_find_profiled_func(stat, ip);
782493762fcSSteven Rostedt 	if (!rec) {
783318e0a73SSteven Rostedt 		rec = ftrace_profile_alloc(stat, ip);
784493762fcSSteven Rostedt 		if (!rec)
785493762fcSSteven Rostedt 			goto out;
786493762fcSSteven Rostedt 	}
787493762fcSSteven Rostedt 
788493762fcSSteven Rostedt 	rec->counter++;
789493762fcSSteven Rostedt  out:
790493762fcSSteven Rostedt 	local_irq_restore(flags);
791493762fcSSteven Rostedt }
792493762fcSSteven Rostedt 
7930706f1c4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
7940706f1c4SSteven Rostedt static int profile_graph_entry(struct ftrace_graph_ent *trace)
7950706f1c4SSteven Rostedt {
796*a1e2e31dSSteven Rostedt 	function_profile_call(trace->func, 0, NULL, NULL);
7970706f1c4SSteven Rostedt 	return 1;
7980706f1c4SSteven Rostedt }
7990706f1c4SSteven Rostedt 
8000706f1c4SSteven Rostedt static void profile_graph_return(struct ftrace_graph_ret *trace)
8010706f1c4SSteven Rostedt {
802cafb168aSSteven Rostedt 	struct ftrace_profile_stat *stat;
803a2a16d6aSSteven Rostedt 	unsigned long long calltime;
8040706f1c4SSteven Rostedt 	struct ftrace_profile *rec;
805cafb168aSSteven Rostedt 	unsigned long flags;
8060706f1c4SSteven Rostedt 
8070706f1c4SSteven Rostedt 	local_irq_save(flags);
808cafb168aSSteven Rostedt 	stat = &__get_cpu_var(ftrace_profile_stats);
8090f6ce3deSSteven Rostedt 	if (!stat->hash || !ftrace_profile_enabled)
810cafb168aSSteven Rostedt 		goto out;
811cafb168aSSteven Rostedt 
81237e44bc5SSteven Rostedt 	/* If the calltime was zero'd ignore it */
81337e44bc5SSteven Rostedt 	if (!trace->calltime)
81437e44bc5SSteven Rostedt 		goto out;
81537e44bc5SSteven Rostedt 
816a2a16d6aSSteven Rostedt 	calltime = trace->rettime - trace->calltime;
817a2a16d6aSSteven Rostedt 
818a2a16d6aSSteven Rostedt 	if (!(trace_flags & TRACE_ITER_GRAPH_TIME)) {
819a2a16d6aSSteven Rostedt 		int index;
820a2a16d6aSSteven Rostedt 
821a2a16d6aSSteven Rostedt 		index = trace->depth;
822a2a16d6aSSteven Rostedt 
823a2a16d6aSSteven Rostedt 		/* Append this call time to the parent time to subtract */
824a2a16d6aSSteven Rostedt 		if (index)
825a2a16d6aSSteven Rostedt 			current->ret_stack[index - 1].subtime += calltime;
826a2a16d6aSSteven Rostedt 
827a2a16d6aSSteven Rostedt 		if (current->ret_stack[index].subtime < calltime)
828a2a16d6aSSteven Rostedt 			calltime -= current->ret_stack[index].subtime;
829a2a16d6aSSteven Rostedt 		else
830a2a16d6aSSteven Rostedt 			calltime = 0;
831a2a16d6aSSteven Rostedt 	}
832a2a16d6aSSteven Rostedt 
833cafb168aSSteven Rostedt 	rec = ftrace_find_profiled_func(stat, trace->func);
834e330b3bcSChase Douglas 	if (rec) {
835a2a16d6aSSteven Rostedt 		rec->time += calltime;
836e330b3bcSChase Douglas 		rec->time_squared += calltime * calltime;
837e330b3bcSChase Douglas 	}
838a2a16d6aSSteven Rostedt 
839cafb168aSSteven Rostedt  out:
8400706f1c4SSteven Rostedt 	local_irq_restore(flags);
8410706f1c4SSteven Rostedt }
8420706f1c4SSteven Rostedt 
8430706f1c4SSteven Rostedt static int register_ftrace_profiler(void)
8440706f1c4SSteven Rostedt {
8450706f1c4SSteven Rostedt 	return register_ftrace_graph(&profile_graph_return,
8460706f1c4SSteven Rostedt 				     &profile_graph_entry);
8470706f1c4SSteven Rostedt }
8480706f1c4SSteven Rostedt 
8490706f1c4SSteven Rostedt static void unregister_ftrace_profiler(void)
8500706f1c4SSteven Rostedt {
8510706f1c4SSteven Rostedt 	unregister_ftrace_graph();
8520706f1c4SSteven Rostedt }
8530706f1c4SSteven Rostedt #else
854bd38c0e6SPaul McQuade static struct ftrace_ops ftrace_profile_ops __read_mostly = {
855493762fcSSteven Rostedt 	.func		= function_profile_call,
856493762fcSSteven Rostedt };
857493762fcSSteven Rostedt 
8580706f1c4SSteven Rostedt static int register_ftrace_profiler(void)
8590706f1c4SSteven Rostedt {
8600706f1c4SSteven Rostedt 	return register_ftrace_function(&ftrace_profile_ops);
8610706f1c4SSteven Rostedt }
8620706f1c4SSteven Rostedt 
8630706f1c4SSteven Rostedt static void unregister_ftrace_profiler(void)
8640706f1c4SSteven Rostedt {
8650706f1c4SSteven Rostedt 	unregister_ftrace_function(&ftrace_profile_ops);
8660706f1c4SSteven Rostedt }
8670706f1c4SSteven Rostedt #endif /* CONFIG_FUNCTION_GRAPH_TRACER */
8680706f1c4SSteven Rostedt 
869493762fcSSteven Rostedt static ssize_t
870493762fcSSteven Rostedt ftrace_profile_write(struct file *filp, const char __user *ubuf,
871493762fcSSteven Rostedt 		     size_t cnt, loff_t *ppos)
872493762fcSSteven Rostedt {
873493762fcSSteven Rostedt 	unsigned long val;
874493762fcSSteven Rostedt 	int ret;
875493762fcSSteven Rostedt 
87622fe9b54SPeter Huewe 	ret = kstrtoul_from_user(ubuf, cnt, 10, &val);
87722fe9b54SPeter Huewe 	if (ret)
878493762fcSSteven Rostedt 		return ret;
879493762fcSSteven Rostedt 
880493762fcSSteven Rostedt 	val = !!val;
881493762fcSSteven Rostedt 
882493762fcSSteven Rostedt 	mutex_lock(&ftrace_profile_lock);
883493762fcSSteven Rostedt 	if (ftrace_profile_enabled ^ val) {
884493762fcSSteven Rostedt 		if (val) {
885493762fcSSteven Rostedt 			ret = ftrace_profile_init();
886493762fcSSteven Rostedt 			if (ret < 0) {
887493762fcSSteven Rostedt 				cnt = ret;
888493762fcSSteven Rostedt 				goto out;
889493762fcSSteven Rostedt 			}
890493762fcSSteven Rostedt 
8910706f1c4SSteven Rostedt 			ret = register_ftrace_profiler();
8920706f1c4SSteven Rostedt 			if (ret < 0) {
8930706f1c4SSteven Rostedt 				cnt = ret;
8940706f1c4SSteven Rostedt 				goto out;
8950706f1c4SSteven Rostedt 			}
896493762fcSSteven Rostedt 			ftrace_profile_enabled = 1;
897493762fcSSteven Rostedt 		} else {
898493762fcSSteven Rostedt 			ftrace_profile_enabled = 0;
8990f6ce3deSSteven Rostedt 			/*
9000f6ce3deSSteven Rostedt 			 * unregister_ftrace_profiler calls stop_machine
9010f6ce3deSSteven Rostedt 			 * so this acts like an synchronize_sched.
9020f6ce3deSSteven Rostedt 			 */
9030706f1c4SSteven Rostedt 			unregister_ftrace_profiler();
904493762fcSSteven Rostedt 		}
905493762fcSSteven Rostedt 	}
906493762fcSSteven Rostedt  out:
907493762fcSSteven Rostedt 	mutex_unlock(&ftrace_profile_lock);
908493762fcSSteven Rostedt 
909cf8517cfSJiri Olsa 	*ppos += cnt;
910493762fcSSteven Rostedt 
911493762fcSSteven Rostedt 	return cnt;
912493762fcSSteven Rostedt }
913493762fcSSteven Rostedt 
914493762fcSSteven Rostedt static ssize_t
915493762fcSSteven Rostedt ftrace_profile_read(struct file *filp, char __user *ubuf,
916493762fcSSteven Rostedt 		     size_t cnt, loff_t *ppos)
917493762fcSSteven Rostedt {
918fb9fb015SSteven Rostedt 	char buf[64];		/* big enough to hold a number */
919493762fcSSteven Rostedt 	int r;
920493762fcSSteven Rostedt 
921493762fcSSteven Rostedt 	r = sprintf(buf, "%u\n", ftrace_profile_enabled);
922493762fcSSteven Rostedt 	return simple_read_from_buffer(ubuf, cnt, ppos, buf, r);
923493762fcSSteven Rostedt }
924493762fcSSteven Rostedt 
925493762fcSSteven Rostedt static const struct file_operations ftrace_profile_fops = {
926493762fcSSteven Rostedt 	.open		= tracing_open_generic,
927493762fcSSteven Rostedt 	.read		= ftrace_profile_read,
928493762fcSSteven Rostedt 	.write		= ftrace_profile_write,
9296038f373SArnd Bergmann 	.llseek		= default_llseek,
930493762fcSSteven Rostedt };
931493762fcSSteven Rostedt 
932cafb168aSSteven Rostedt /* used to initialize the real stat files */
933cafb168aSSteven Rostedt static struct tracer_stat function_stats __initdata = {
934cafb168aSSteven Rostedt 	.name		= "functions",
935cafb168aSSteven Rostedt 	.stat_start	= function_stat_start,
936cafb168aSSteven Rostedt 	.stat_next	= function_stat_next,
937cafb168aSSteven Rostedt 	.stat_cmp	= function_stat_cmp,
938cafb168aSSteven Rostedt 	.stat_headers	= function_stat_headers,
939cafb168aSSteven Rostedt 	.stat_show	= function_stat_show
940cafb168aSSteven Rostedt };
941cafb168aSSteven Rostedt 
9426ab5d668SSteven Rostedt static __init void ftrace_profile_debugfs(struct dentry *d_tracer)
943493762fcSSteven Rostedt {
944cafb168aSSteven Rostedt 	struct ftrace_profile_stat *stat;
945493762fcSSteven Rostedt 	struct dentry *entry;
946cafb168aSSteven Rostedt 	char *name;
947493762fcSSteven Rostedt 	int ret;
948cafb168aSSteven Rostedt 	int cpu;
949493762fcSSteven Rostedt 
950cafb168aSSteven Rostedt 	for_each_possible_cpu(cpu) {
951cafb168aSSteven Rostedt 		stat = &per_cpu(ftrace_profile_stats, cpu);
952cafb168aSSteven Rostedt 
953cafb168aSSteven Rostedt 		/* allocate enough for function name + cpu number */
954cafb168aSSteven Rostedt 		name = kmalloc(32, GFP_KERNEL);
955cafb168aSSteven Rostedt 		if (!name) {
956cafb168aSSteven Rostedt 			/*
957cafb168aSSteven Rostedt 			 * The files created are permanent, if something happens
958cafb168aSSteven Rostedt 			 * we still do not free memory.
959cafb168aSSteven Rostedt 			 */
960cafb168aSSteven Rostedt 			WARN(1,
961cafb168aSSteven Rostedt 			     "Could not allocate stat file for cpu %d\n",
962cafb168aSSteven Rostedt 			     cpu);
963493762fcSSteven Rostedt 			return;
964493762fcSSteven Rostedt 		}
965cafb168aSSteven Rostedt 		stat->stat = function_stats;
966cafb168aSSteven Rostedt 		snprintf(name, 32, "function%d", cpu);
967cafb168aSSteven Rostedt 		stat->stat.name = name;
968cafb168aSSteven Rostedt 		ret = register_stat_tracer(&stat->stat);
969cafb168aSSteven Rostedt 		if (ret) {
970cafb168aSSteven Rostedt 			WARN(1,
971cafb168aSSteven Rostedt 			     "Could not register function stat for cpu %d\n",
972cafb168aSSteven Rostedt 			     cpu);
973cafb168aSSteven Rostedt 			kfree(name);
974cafb168aSSteven Rostedt 			return;
975cafb168aSSteven Rostedt 		}
976cafb168aSSteven Rostedt 	}
977493762fcSSteven Rostedt 
978493762fcSSteven Rostedt 	entry = debugfs_create_file("function_profile_enabled", 0644,
979493762fcSSteven Rostedt 				    d_tracer, NULL, &ftrace_profile_fops);
980493762fcSSteven Rostedt 	if (!entry)
981493762fcSSteven Rostedt 		pr_warning("Could not create debugfs "
982493762fcSSteven Rostedt 			   "'function_profile_enabled' entry\n");
983493762fcSSteven Rostedt }
984493762fcSSteven Rostedt 
985493762fcSSteven Rostedt #else /* CONFIG_FUNCTION_PROFILER */
9866ab5d668SSteven Rostedt static __init void ftrace_profile_debugfs(struct dentry *d_tracer)
987493762fcSSteven Rostedt {
988493762fcSSteven Rostedt }
989493762fcSSteven Rostedt #endif /* CONFIG_FUNCTION_PROFILER */
990493762fcSSteven Rostedt 
99173d3fd96SIngo Molnar static struct pid * const ftrace_swapper_pid = &init_struct_pid;
99273d3fd96SIngo Molnar 
9933d083395SSteven Rostedt #ifdef CONFIG_DYNAMIC_FTRACE
99473d3fd96SIngo Molnar 
99599ecdc43SSteven Rostedt #ifndef CONFIG_FTRACE_MCOUNT_RECORD
996cb7be3b2SSteven Rostedt # error Dynamic ftrace depends on MCOUNT_RECORD
99799ecdc43SSteven Rostedt #endif
99899ecdc43SSteven Rostedt 
9998fc0c701SSteven Rostedt static struct hlist_head ftrace_func_hash[FTRACE_FUNC_HASHSIZE] __read_mostly;
10008fc0c701SSteven Rostedt 
1001b6887d79SSteven Rostedt struct ftrace_func_probe {
10028fc0c701SSteven Rostedt 	struct hlist_node	node;
1003b6887d79SSteven Rostedt 	struct ftrace_probe_ops	*ops;
10048fc0c701SSteven Rostedt 	unsigned long		flags;
10058fc0c701SSteven Rostedt 	unsigned long		ip;
10068fc0c701SSteven Rostedt 	void			*data;
10078fc0c701SSteven Rostedt 	struct rcu_head		rcu;
10088fc0c701SSteven Rostedt };
10098fc0c701SSteven Rostedt 
1010b448c4e3SSteven Rostedt struct ftrace_func_entry {
1011b448c4e3SSteven Rostedt 	struct hlist_node hlist;
1012b448c4e3SSteven Rostedt 	unsigned long ip;
1013b448c4e3SSteven Rostedt };
1014b448c4e3SSteven Rostedt 
1015b448c4e3SSteven Rostedt struct ftrace_hash {
1016b448c4e3SSteven Rostedt 	unsigned long		size_bits;
1017b448c4e3SSteven Rostedt 	struct hlist_head	*buckets;
1018b448c4e3SSteven Rostedt 	unsigned long		count;
101907fd5515SSteven Rostedt 	struct rcu_head		rcu;
1020b448c4e3SSteven Rostedt };
1021b448c4e3SSteven Rostedt 
102233dc9b12SSteven Rostedt /*
102333dc9b12SSteven Rostedt  * We make these constant because no one should touch them,
102433dc9b12SSteven Rostedt  * but they are used as the default "empty hash", to avoid allocating
102533dc9b12SSteven Rostedt  * it all the time. These are in a read only section such that if
102633dc9b12SSteven Rostedt  * anyone does try to modify it, it will cause an exception.
102733dc9b12SSteven Rostedt  */
102833dc9b12SSteven Rostedt static const struct hlist_head empty_buckets[1];
102933dc9b12SSteven Rostedt static const struct ftrace_hash empty_hash = {
103033dc9b12SSteven Rostedt 	.buckets = (struct hlist_head *)empty_buckets,
1031b448c4e3SSteven Rostedt };
103233dc9b12SSteven Rostedt #define EMPTY_HASH	((struct ftrace_hash *)&empty_hash)
10335072c59fSSteven Rostedt 
10342b499381SSteven Rostedt static struct ftrace_ops global_ops = {
1035f45948e8SSteven Rostedt 	.func			= ftrace_stub,
103633dc9b12SSteven Rostedt 	.notrace_hash		= EMPTY_HASH,
103733dc9b12SSteven Rostedt 	.filter_hash		= EMPTY_HASH,
1038f45948e8SSteven Rostedt };
1039f45948e8SSteven Rostedt 
104041c52c0dSSteven Rostedt static DEFINE_MUTEX(ftrace_regex_lock);
10413d083395SSteven Rostedt 
10423c1720f0SSteven Rostedt struct ftrace_page {
10433c1720f0SSteven Rostedt 	struct ftrace_page	*next;
1044a7900875SSteven Rostedt 	struct dyn_ftrace	*records;
1045431aa3fbSSteven Rostedt 	int			index;
1046a7900875SSteven Rostedt 	int			size;
1047aa5e5ceaSDavid Miller };
10483c1720f0SSteven Rostedt 
104985ae32aeSSteven Rostedt static struct ftrace_page *ftrace_new_pgs;
105085ae32aeSSteven Rostedt 
1051a7900875SSteven Rostedt #define ENTRY_SIZE sizeof(struct dyn_ftrace)
1052a7900875SSteven Rostedt #define ENTRIES_PER_PAGE (PAGE_SIZE / ENTRY_SIZE)
10533c1720f0SSteven Rostedt 
10543c1720f0SSteven Rostedt /* estimate from running different kernels */
10553c1720f0SSteven Rostedt #define NR_TO_INIT		10000
10563c1720f0SSteven Rostedt 
10573c1720f0SSteven Rostedt static struct ftrace_page	*ftrace_pages_start;
10583c1720f0SSteven Rostedt static struct ftrace_page	*ftrace_pages;
10593c1720f0SSteven Rostedt 
106006a51d93SSteven Rostedt static bool ftrace_hash_empty(struct ftrace_hash *hash)
106106a51d93SSteven Rostedt {
106206a51d93SSteven Rostedt 	return !hash || !hash->count;
106306a51d93SSteven Rostedt }
106406a51d93SSteven Rostedt 
1065b448c4e3SSteven Rostedt static struct ftrace_func_entry *
1066b448c4e3SSteven Rostedt ftrace_lookup_ip(struct ftrace_hash *hash, unsigned long ip)
1067b448c4e3SSteven Rostedt {
1068b448c4e3SSteven Rostedt 	unsigned long key;
1069b448c4e3SSteven Rostedt 	struct ftrace_func_entry *entry;
1070b448c4e3SSteven Rostedt 	struct hlist_head *hhd;
1071b448c4e3SSteven Rostedt 	struct hlist_node *n;
1072b448c4e3SSteven Rostedt 
107306a51d93SSteven Rostedt 	if (ftrace_hash_empty(hash))
1074b448c4e3SSteven Rostedt 		return NULL;
1075b448c4e3SSteven Rostedt 
1076b448c4e3SSteven Rostedt 	if (hash->size_bits > 0)
1077b448c4e3SSteven Rostedt 		key = hash_long(ip, hash->size_bits);
1078b448c4e3SSteven Rostedt 	else
1079b448c4e3SSteven Rostedt 		key = 0;
1080b448c4e3SSteven Rostedt 
1081b448c4e3SSteven Rostedt 	hhd = &hash->buckets[key];
1082b448c4e3SSteven Rostedt 
1083b448c4e3SSteven Rostedt 	hlist_for_each_entry_rcu(entry, n, hhd, hlist) {
1084b448c4e3SSteven Rostedt 		if (entry->ip == ip)
1085b448c4e3SSteven Rostedt 			return entry;
1086b448c4e3SSteven Rostedt 	}
1087b448c4e3SSteven Rostedt 	return NULL;
1088b448c4e3SSteven Rostedt }
1089b448c4e3SSteven Rostedt 
109033dc9b12SSteven Rostedt static void __add_hash_entry(struct ftrace_hash *hash,
109133dc9b12SSteven Rostedt 			     struct ftrace_func_entry *entry)
109233dc9b12SSteven Rostedt {
109333dc9b12SSteven Rostedt 	struct hlist_head *hhd;
109433dc9b12SSteven Rostedt 	unsigned long key;
109533dc9b12SSteven Rostedt 
109633dc9b12SSteven Rostedt 	if (hash->size_bits)
109733dc9b12SSteven Rostedt 		key = hash_long(entry->ip, hash->size_bits);
109833dc9b12SSteven Rostedt 	else
109933dc9b12SSteven Rostedt 		key = 0;
110033dc9b12SSteven Rostedt 
110133dc9b12SSteven Rostedt 	hhd = &hash->buckets[key];
110233dc9b12SSteven Rostedt 	hlist_add_head(&entry->hlist, hhd);
110333dc9b12SSteven Rostedt 	hash->count++;
110433dc9b12SSteven Rostedt }
110533dc9b12SSteven Rostedt 
1106b448c4e3SSteven Rostedt static int add_hash_entry(struct ftrace_hash *hash, unsigned long ip)
1107b448c4e3SSteven Rostedt {
1108b448c4e3SSteven Rostedt 	struct ftrace_func_entry *entry;
1109b448c4e3SSteven Rostedt 
1110b448c4e3SSteven Rostedt 	entry = kmalloc(sizeof(*entry), GFP_KERNEL);
1111b448c4e3SSteven Rostedt 	if (!entry)
1112b448c4e3SSteven Rostedt 		return -ENOMEM;
1113b448c4e3SSteven Rostedt 
1114b448c4e3SSteven Rostedt 	entry->ip = ip;
111533dc9b12SSteven Rostedt 	__add_hash_entry(hash, entry);
1116b448c4e3SSteven Rostedt 
1117b448c4e3SSteven Rostedt 	return 0;
1118b448c4e3SSteven Rostedt }
1119b448c4e3SSteven Rostedt 
1120b448c4e3SSteven Rostedt static void
112133dc9b12SSteven Rostedt free_hash_entry(struct ftrace_hash *hash,
112233dc9b12SSteven Rostedt 		  struct ftrace_func_entry *entry)
112333dc9b12SSteven Rostedt {
112433dc9b12SSteven Rostedt 	hlist_del(&entry->hlist);
112533dc9b12SSteven Rostedt 	kfree(entry);
112633dc9b12SSteven Rostedt 	hash->count--;
112733dc9b12SSteven Rostedt }
112833dc9b12SSteven Rostedt 
112933dc9b12SSteven Rostedt static void
1130b448c4e3SSteven Rostedt remove_hash_entry(struct ftrace_hash *hash,
1131b448c4e3SSteven Rostedt 		  struct ftrace_func_entry *entry)
1132b448c4e3SSteven Rostedt {
1133b448c4e3SSteven Rostedt 	hlist_del(&entry->hlist);
1134b448c4e3SSteven Rostedt 	hash->count--;
1135b448c4e3SSteven Rostedt }
1136b448c4e3SSteven Rostedt 
1137b448c4e3SSteven Rostedt static void ftrace_hash_clear(struct ftrace_hash *hash)
1138b448c4e3SSteven Rostedt {
1139b448c4e3SSteven Rostedt 	struct hlist_head *hhd;
1140b448c4e3SSteven Rostedt 	struct hlist_node *tp, *tn;
1141b448c4e3SSteven Rostedt 	struct ftrace_func_entry *entry;
1142b448c4e3SSteven Rostedt 	int size = 1 << hash->size_bits;
1143b448c4e3SSteven Rostedt 	int i;
1144b448c4e3SSteven Rostedt 
114533dc9b12SSteven Rostedt 	if (!hash->count)
114633dc9b12SSteven Rostedt 		return;
114733dc9b12SSteven Rostedt 
1148b448c4e3SSteven Rostedt 	for (i = 0; i < size; i++) {
1149b448c4e3SSteven Rostedt 		hhd = &hash->buckets[i];
1150b448c4e3SSteven Rostedt 		hlist_for_each_entry_safe(entry, tp, tn, hhd, hlist)
115133dc9b12SSteven Rostedt 			free_hash_entry(hash, entry);
1152b448c4e3SSteven Rostedt 	}
1153b448c4e3SSteven Rostedt 	FTRACE_WARN_ON(hash->count);
1154b448c4e3SSteven Rostedt }
1155b448c4e3SSteven Rostedt 
115633dc9b12SSteven Rostedt static void free_ftrace_hash(struct ftrace_hash *hash)
115733dc9b12SSteven Rostedt {
115833dc9b12SSteven Rostedt 	if (!hash || hash == EMPTY_HASH)
115933dc9b12SSteven Rostedt 		return;
116033dc9b12SSteven Rostedt 	ftrace_hash_clear(hash);
116133dc9b12SSteven Rostedt 	kfree(hash->buckets);
116233dc9b12SSteven Rostedt 	kfree(hash);
116333dc9b12SSteven Rostedt }
116433dc9b12SSteven Rostedt 
116507fd5515SSteven Rostedt static void __free_ftrace_hash_rcu(struct rcu_head *rcu)
116607fd5515SSteven Rostedt {
116707fd5515SSteven Rostedt 	struct ftrace_hash *hash;
116807fd5515SSteven Rostedt 
116907fd5515SSteven Rostedt 	hash = container_of(rcu, struct ftrace_hash, rcu);
117007fd5515SSteven Rostedt 	free_ftrace_hash(hash);
117107fd5515SSteven Rostedt }
117207fd5515SSteven Rostedt 
117307fd5515SSteven Rostedt static void free_ftrace_hash_rcu(struct ftrace_hash *hash)
117407fd5515SSteven Rostedt {
117507fd5515SSteven Rostedt 	if (!hash || hash == EMPTY_HASH)
117607fd5515SSteven Rostedt 		return;
117707fd5515SSteven Rostedt 	call_rcu_sched(&hash->rcu, __free_ftrace_hash_rcu);
117807fd5515SSteven Rostedt }
117907fd5515SSteven Rostedt 
11805500fa51SJiri Olsa void ftrace_free_filter(struct ftrace_ops *ops)
11815500fa51SJiri Olsa {
11825500fa51SJiri Olsa 	free_ftrace_hash(ops->filter_hash);
11835500fa51SJiri Olsa 	free_ftrace_hash(ops->notrace_hash);
11845500fa51SJiri Olsa }
11855500fa51SJiri Olsa 
118633dc9b12SSteven Rostedt static struct ftrace_hash *alloc_ftrace_hash(int size_bits)
118733dc9b12SSteven Rostedt {
118833dc9b12SSteven Rostedt 	struct ftrace_hash *hash;
118933dc9b12SSteven Rostedt 	int size;
119033dc9b12SSteven Rostedt 
119133dc9b12SSteven Rostedt 	hash = kzalloc(sizeof(*hash), GFP_KERNEL);
119233dc9b12SSteven Rostedt 	if (!hash)
119333dc9b12SSteven Rostedt 		return NULL;
119433dc9b12SSteven Rostedt 
119533dc9b12SSteven Rostedt 	size = 1 << size_bits;
119647b0edcbSThomas Meyer 	hash->buckets = kcalloc(size, sizeof(*hash->buckets), GFP_KERNEL);
119733dc9b12SSteven Rostedt 
119833dc9b12SSteven Rostedt 	if (!hash->buckets) {
119933dc9b12SSteven Rostedt 		kfree(hash);
120033dc9b12SSteven Rostedt 		return NULL;
120133dc9b12SSteven Rostedt 	}
120233dc9b12SSteven Rostedt 
120333dc9b12SSteven Rostedt 	hash->size_bits = size_bits;
120433dc9b12SSteven Rostedt 
120533dc9b12SSteven Rostedt 	return hash;
120633dc9b12SSteven Rostedt }
120733dc9b12SSteven Rostedt 
120833dc9b12SSteven Rostedt static struct ftrace_hash *
120933dc9b12SSteven Rostedt alloc_and_copy_ftrace_hash(int size_bits, struct ftrace_hash *hash)
121033dc9b12SSteven Rostedt {
121133dc9b12SSteven Rostedt 	struct ftrace_func_entry *entry;
121233dc9b12SSteven Rostedt 	struct ftrace_hash *new_hash;
121333dc9b12SSteven Rostedt 	struct hlist_node *tp;
121433dc9b12SSteven Rostedt 	int size;
121533dc9b12SSteven Rostedt 	int ret;
121633dc9b12SSteven Rostedt 	int i;
121733dc9b12SSteven Rostedt 
121833dc9b12SSteven Rostedt 	new_hash = alloc_ftrace_hash(size_bits);
121933dc9b12SSteven Rostedt 	if (!new_hash)
122033dc9b12SSteven Rostedt 		return NULL;
122133dc9b12SSteven Rostedt 
122233dc9b12SSteven Rostedt 	/* Empty hash? */
122306a51d93SSteven Rostedt 	if (ftrace_hash_empty(hash))
122433dc9b12SSteven Rostedt 		return new_hash;
122533dc9b12SSteven Rostedt 
122633dc9b12SSteven Rostedt 	size = 1 << hash->size_bits;
122733dc9b12SSteven Rostedt 	for (i = 0; i < size; i++) {
122833dc9b12SSteven Rostedt 		hlist_for_each_entry(entry, tp, &hash->buckets[i], hlist) {
122933dc9b12SSteven Rostedt 			ret = add_hash_entry(new_hash, entry->ip);
123033dc9b12SSteven Rostedt 			if (ret < 0)
123133dc9b12SSteven Rostedt 				goto free_hash;
123233dc9b12SSteven Rostedt 		}
123333dc9b12SSteven Rostedt 	}
123433dc9b12SSteven Rostedt 
123533dc9b12SSteven Rostedt 	FTRACE_WARN_ON(new_hash->count != hash->count);
123633dc9b12SSteven Rostedt 
123733dc9b12SSteven Rostedt 	return new_hash;
123833dc9b12SSteven Rostedt 
123933dc9b12SSteven Rostedt  free_hash:
124033dc9b12SSteven Rostedt 	free_ftrace_hash(new_hash);
124133dc9b12SSteven Rostedt 	return NULL;
124233dc9b12SSteven Rostedt }
124333dc9b12SSteven Rostedt 
124441fb61c2SSteven Rostedt static void
124541fb61c2SSteven Rostedt ftrace_hash_rec_disable(struct ftrace_ops *ops, int filter_hash);
124641fb61c2SSteven Rostedt static void
124741fb61c2SSteven Rostedt ftrace_hash_rec_enable(struct ftrace_ops *ops, int filter_hash);
124841fb61c2SSteven Rostedt 
124933dc9b12SSteven Rostedt static int
125041fb61c2SSteven Rostedt ftrace_hash_move(struct ftrace_ops *ops, int enable,
125141fb61c2SSteven Rostedt 		 struct ftrace_hash **dst, struct ftrace_hash *src)
125233dc9b12SSteven Rostedt {
125333dc9b12SSteven Rostedt 	struct ftrace_func_entry *entry;
125433dc9b12SSteven Rostedt 	struct hlist_node *tp, *tn;
125533dc9b12SSteven Rostedt 	struct hlist_head *hhd;
125607fd5515SSteven Rostedt 	struct ftrace_hash *old_hash;
125707fd5515SSteven Rostedt 	struct ftrace_hash *new_hash;
125833dc9b12SSteven Rostedt 	unsigned long key;
125933dc9b12SSteven Rostedt 	int size = src->count;
126033dc9b12SSteven Rostedt 	int bits = 0;
126141fb61c2SSteven Rostedt 	int ret;
126233dc9b12SSteven Rostedt 	int i;
126333dc9b12SSteven Rostedt 
126433dc9b12SSteven Rostedt 	/*
126541fb61c2SSteven Rostedt 	 * Remove the current set, update the hash and add
126641fb61c2SSteven Rostedt 	 * them back.
126741fb61c2SSteven Rostedt 	 */
126841fb61c2SSteven Rostedt 	ftrace_hash_rec_disable(ops, enable);
126941fb61c2SSteven Rostedt 
127041fb61c2SSteven Rostedt 	/*
127133dc9b12SSteven Rostedt 	 * If the new source is empty, just free dst and assign it
127233dc9b12SSteven Rostedt 	 * the empty_hash.
127333dc9b12SSteven Rostedt 	 */
127433dc9b12SSteven Rostedt 	if (!src->count) {
127507fd5515SSteven Rostedt 		free_ftrace_hash_rcu(*dst);
127607fd5515SSteven Rostedt 		rcu_assign_pointer(*dst, EMPTY_HASH);
1277d4d34b98SSteven Rostedt 		/* still need to update the function records */
1278d4d34b98SSteven Rostedt 		ret = 0;
1279d4d34b98SSteven Rostedt 		goto out;
128033dc9b12SSteven Rostedt 	}
128133dc9b12SSteven Rostedt 
128233dc9b12SSteven Rostedt 	/*
128333dc9b12SSteven Rostedt 	 * Make the hash size about 1/2 the # found
128433dc9b12SSteven Rostedt 	 */
128533dc9b12SSteven Rostedt 	for (size /= 2; size; size >>= 1)
128633dc9b12SSteven Rostedt 		bits++;
128733dc9b12SSteven Rostedt 
128833dc9b12SSteven Rostedt 	/* Don't allocate too much */
128933dc9b12SSteven Rostedt 	if (bits > FTRACE_HASH_MAX_BITS)
129033dc9b12SSteven Rostedt 		bits = FTRACE_HASH_MAX_BITS;
129133dc9b12SSteven Rostedt 
129241fb61c2SSteven Rostedt 	ret = -ENOMEM;
129307fd5515SSteven Rostedt 	new_hash = alloc_ftrace_hash(bits);
129407fd5515SSteven Rostedt 	if (!new_hash)
129541fb61c2SSteven Rostedt 		goto out;
129633dc9b12SSteven Rostedt 
129733dc9b12SSteven Rostedt 	size = 1 << src->size_bits;
129833dc9b12SSteven Rostedt 	for (i = 0; i < size; i++) {
129933dc9b12SSteven Rostedt 		hhd = &src->buckets[i];
130033dc9b12SSteven Rostedt 		hlist_for_each_entry_safe(entry, tp, tn, hhd, hlist) {
130133dc9b12SSteven Rostedt 			if (bits > 0)
130233dc9b12SSteven Rostedt 				key = hash_long(entry->ip, bits);
130333dc9b12SSteven Rostedt 			else
130433dc9b12SSteven Rostedt 				key = 0;
130533dc9b12SSteven Rostedt 			remove_hash_entry(src, entry);
130607fd5515SSteven Rostedt 			__add_hash_entry(new_hash, entry);
130733dc9b12SSteven Rostedt 		}
130833dc9b12SSteven Rostedt 	}
130933dc9b12SSteven Rostedt 
131007fd5515SSteven Rostedt 	old_hash = *dst;
131107fd5515SSteven Rostedt 	rcu_assign_pointer(*dst, new_hash);
131207fd5515SSteven Rostedt 	free_ftrace_hash_rcu(old_hash);
131307fd5515SSteven Rostedt 
131441fb61c2SSteven Rostedt 	ret = 0;
131541fb61c2SSteven Rostedt  out:
131641fb61c2SSteven Rostedt 	/*
131741fb61c2SSteven Rostedt 	 * Enable regardless of ret:
131841fb61c2SSteven Rostedt 	 *  On success, we enable the new hash.
131941fb61c2SSteven Rostedt 	 *  On failure, we re-enable the original hash.
132041fb61c2SSteven Rostedt 	 */
132141fb61c2SSteven Rostedt 	ftrace_hash_rec_enable(ops, enable);
132241fb61c2SSteven Rostedt 
132341fb61c2SSteven Rostedt 	return ret;
132433dc9b12SSteven Rostedt }
132533dc9b12SSteven Rostedt 
1326265c831cSSteven Rostedt /*
1327b848914cSSteven Rostedt  * Test the hashes for this ops to see if we want to call
1328b848914cSSteven Rostedt  * the ops->func or not.
1329b848914cSSteven Rostedt  *
1330b848914cSSteven Rostedt  * It's a match if the ip is in the ops->filter_hash or
1331b848914cSSteven Rostedt  * the filter_hash does not exist or is empty,
1332b848914cSSteven Rostedt  *  AND
1333b848914cSSteven Rostedt  * the ip is not in the ops->notrace_hash.
1334cdbe61bfSSteven Rostedt  *
1335cdbe61bfSSteven Rostedt  * This needs to be called with preemption disabled as
1336cdbe61bfSSteven Rostedt  * the hashes are freed with call_rcu_sched().
1337b848914cSSteven Rostedt  */
1338b848914cSSteven Rostedt static int
1339b848914cSSteven Rostedt ftrace_ops_test(struct ftrace_ops *ops, unsigned long ip)
1340b848914cSSteven Rostedt {
1341b848914cSSteven Rostedt 	struct ftrace_hash *filter_hash;
1342b848914cSSteven Rostedt 	struct ftrace_hash *notrace_hash;
1343b848914cSSteven Rostedt 	int ret;
1344b848914cSSteven Rostedt 
1345b848914cSSteven Rostedt 	filter_hash = rcu_dereference_raw(ops->filter_hash);
1346b848914cSSteven Rostedt 	notrace_hash = rcu_dereference_raw(ops->notrace_hash);
1347b848914cSSteven Rostedt 
134806a51d93SSteven Rostedt 	if ((ftrace_hash_empty(filter_hash) ||
1349b848914cSSteven Rostedt 	     ftrace_lookup_ip(filter_hash, ip)) &&
135006a51d93SSteven Rostedt 	    (ftrace_hash_empty(notrace_hash) ||
1351b848914cSSteven Rostedt 	     !ftrace_lookup_ip(notrace_hash, ip)))
1352b848914cSSteven Rostedt 		ret = 1;
1353b848914cSSteven Rostedt 	else
1354b848914cSSteven Rostedt 		ret = 0;
1355b848914cSSteven Rostedt 
1356b848914cSSteven Rostedt 	return ret;
1357b848914cSSteven Rostedt }
1358b848914cSSteven Rostedt 
1359b848914cSSteven Rostedt /*
1360265c831cSSteven Rostedt  * This is a double for. Do not use 'break' to break out of the loop,
1361265c831cSSteven Rostedt  * you must use a goto.
1362265c831cSSteven Rostedt  */
1363265c831cSSteven Rostedt #define do_for_each_ftrace_rec(pg, rec)					\
1364265c831cSSteven Rostedt 	for (pg = ftrace_pages_start; pg; pg = pg->next) {		\
1365265c831cSSteven Rostedt 		int _____i;						\
1366265c831cSSteven Rostedt 		for (_____i = 0; _____i < pg->index; _____i++) {	\
1367265c831cSSteven Rostedt 			rec = &pg->records[_____i];
1368265c831cSSteven Rostedt 
1369265c831cSSteven Rostedt #define while_for_each_ftrace_rec()		\
1370265c831cSSteven Rostedt 		}				\
1371265c831cSSteven Rostedt 	}
1372ecea656dSAbhishek Sagar 
13735855feadSSteven Rostedt 
13745855feadSSteven Rostedt static int ftrace_cmp_recs(const void *a, const void *b)
13755855feadSSteven Rostedt {
1376a650e02aSSteven Rostedt 	const struct dyn_ftrace *key = a;
1377a650e02aSSteven Rostedt 	const struct dyn_ftrace *rec = b;
13785855feadSSteven Rostedt 
1379a650e02aSSteven Rostedt 	if (key->flags < rec->ip)
13805855feadSSteven Rostedt 		return -1;
1381a650e02aSSteven Rostedt 	if (key->ip >= rec->ip + MCOUNT_INSN_SIZE)
1382a650e02aSSteven Rostedt 		return 1;
1383a650e02aSSteven Rostedt 	return 0;
1384a650e02aSSteven Rostedt }
1385a650e02aSSteven Rostedt 
1386f0cf973aSSteven Rostedt static unsigned long ftrace_location_range(unsigned long start, unsigned long end)
1387a650e02aSSteven Rostedt {
1388a650e02aSSteven Rostedt 	struct ftrace_page *pg;
1389a650e02aSSteven Rostedt 	struct dyn_ftrace *rec;
1390a650e02aSSteven Rostedt 	struct dyn_ftrace key;
1391a650e02aSSteven Rostedt 
1392a650e02aSSteven Rostedt 	key.ip = start;
1393a650e02aSSteven Rostedt 	key.flags = end;	/* overload flags, as it is unsigned long */
1394a650e02aSSteven Rostedt 
1395a650e02aSSteven Rostedt 	for (pg = ftrace_pages_start; pg; pg = pg->next) {
1396a650e02aSSteven Rostedt 		if (end < pg->records[0].ip ||
1397a650e02aSSteven Rostedt 		    start >= (pg->records[pg->index - 1].ip + MCOUNT_INSN_SIZE))
1398a650e02aSSteven Rostedt 			continue;
1399a650e02aSSteven Rostedt 		rec = bsearch(&key, pg->records, pg->index,
1400a650e02aSSteven Rostedt 			      sizeof(struct dyn_ftrace),
1401a650e02aSSteven Rostedt 			      ftrace_cmp_recs);
1402a650e02aSSteven Rostedt 		if (rec)
1403f0cf973aSSteven Rostedt 			return rec->ip;
1404a650e02aSSteven Rostedt 	}
1405a650e02aSSteven Rostedt 
14065855feadSSteven Rostedt 	return 0;
14075855feadSSteven Rostedt }
14085855feadSSteven Rostedt 
1409c88fd863SSteven Rostedt /**
1410c88fd863SSteven Rostedt  * ftrace_location - return true if the ip giving is a traced location
1411c88fd863SSteven Rostedt  * @ip: the instruction pointer to check
1412c88fd863SSteven Rostedt  *
1413f0cf973aSSteven Rostedt  * Returns rec->ip if @ip given is a pointer to a ftrace location.
1414c88fd863SSteven Rostedt  * That is, the instruction that is either a NOP or call to
1415c88fd863SSteven Rostedt  * the function tracer. It checks the ftrace internal tables to
1416c88fd863SSteven Rostedt  * determine if the address belongs or not.
1417c88fd863SSteven Rostedt  */
1418f0cf973aSSteven Rostedt unsigned long ftrace_location(unsigned long ip)
1419c88fd863SSteven Rostedt {
1420a650e02aSSteven Rostedt 	return ftrace_location_range(ip, ip);
14215855feadSSteven Rostedt }
1422c88fd863SSteven Rostedt 
1423a650e02aSSteven Rostedt /**
1424a650e02aSSteven Rostedt  * ftrace_text_reserved - return true if range contains an ftrace location
1425a650e02aSSteven Rostedt  * @start: start of range to search
1426a650e02aSSteven Rostedt  * @end: end of range to search (inclusive). @end points to the last byte to check.
1427a650e02aSSteven Rostedt  *
1428a650e02aSSteven Rostedt  * Returns 1 if @start and @end contains a ftrace location.
1429a650e02aSSteven Rostedt  * That is, the instruction that is either a NOP or call to
1430a650e02aSSteven Rostedt  * the function tracer. It checks the ftrace internal tables to
1431a650e02aSSteven Rostedt  * determine if the address belongs or not.
1432a650e02aSSteven Rostedt  */
1433a650e02aSSteven Rostedt int ftrace_text_reserved(void *start, void *end)
1434a650e02aSSteven Rostedt {
1435f0cf973aSSteven Rostedt 	unsigned long ret;
1436f0cf973aSSteven Rostedt 
1437f0cf973aSSteven Rostedt 	ret = ftrace_location_range((unsigned long)start,
1438a650e02aSSteven Rostedt 				    (unsigned long)end);
1439f0cf973aSSteven Rostedt 
1440f0cf973aSSteven Rostedt 	return (int)!!ret;
1441c88fd863SSteven Rostedt }
1442c88fd863SSteven Rostedt 
1443ed926f9bSSteven Rostedt static void __ftrace_hash_rec_update(struct ftrace_ops *ops,
1444ed926f9bSSteven Rostedt 				     int filter_hash,
1445ed926f9bSSteven Rostedt 				     bool inc)
1446ed926f9bSSteven Rostedt {
1447ed926f9bSSteven Rostedt 	struct ftrace_hash *hash;
1448ed926f9bSSteven Rostedt 	struct ftrace_hash *other_hash;
1449ed926f9bSSteven Rostedt 	struct ftrace_page *pg;
1450ed926f9bSSteven Rostedt 	struct dyn_ftrace *rec;
1451ed926f9bSSteven Rostedt 	int count = 0;
1452ed926f9bSSteven Rostedt 	int all = 0;
1453ed926f9bSSteven Rostedt 
1454ed926f9bSSteven Rostedt 	/* Only update if the ops has been registered */
1455ed926f9bSSteven Rostedt 	if (!(ops->flags & FTRACE_OPS_FL_ENABLED))
1456ed926f9bSSteven Rostedt 		return;
1457ed926f9bSSteven Rostedt 
1458ed926f9bSSteven Rostedt 	/*
1459ed926f9bSSteven Rostedt 	 * In the filter_hash case:
1460ed926f9bSSteven Rostedt 	 *   If the count is zero, we update all records.
1461ed926f9bSSteven Rostedt 	 *   Otherwise we just update the items in the hash.
1462ed926f9bSSteven Rostedt 	 *
1463ed926f9bSSteven Rostedt 	 * In the notrace_hash case:
1464ed926f9bSSteven Rostedt 	 *   We enable the update in the hash.
1465ed926f9bSSteven Rostedt 	 *   As disabling notrace means enabling the tracing,
1466ed926f9bSSteven Rostedt 	 *   and enabling notrace means disabling, the inc variable
1467ed926f9bSSteven Rostedt 	 *   gets inversed.
1468ed926f9bSSteven Rostedt 	 */
1469ed926f9bSSteven Rostedt 	if (filter_hash) {
1470ed926f9bSSteven Rostedt 		hash = ops->filter_hash;
1471ed926f9bSSteven Rostedt 		other_hash = ops->notrace_hash;
147206a51d93SSteven Rostedt 		if (ftrace_hash_empty(hash))
1473ed926f9bSSteven Rostedt 			all = 1;
1474ed926f9bSSteven Rostedt 	} else {
1475ed926f9bSSteven Rostedt 		inc = !inc;
1476ed926f9bSSteven Rostedt 		hash = ops->notrace_hash;
1477ed926f9bSSteven Rostedt 		other_hash = ops->filter_hash;
1478ed926f9bSSteven Rostedt 		/*
1479ed926f9bSSteven Rostedt 		 * If the notrace hash has no items,
1480ed926f9bSSteven Rostedt 		 * then there's nothing to do.
1481ed926f9bSSteven Rostedt 		 */
148206a51d93SSteven Rostedt 		if (ftrace_hash_empty(hash))
1483ed926f9bSSteven Rostedt 			return;
1484ed926f9bSSteven Rostedt 	}
1485ed926f9bSSteven Rostedt 
1486ed926f9bSSteven Rostedt 	do_for_each_ftrace_rec(pg, rec) {
1487ed926f9bSSteven Rostedt 		int in_other_hash = 0;
1488ed926f9bSSteven Rostedt 		int in_hash = 0;
1489ed926f9bSSteven Rostedt 		int match = 0;
1490ed926f9bSSteven Rostedt 
1491ed926f9bSSteven Rostedt 		if (all) {
1492ed926f9bSSteven Rostedt 			/*
1493ed926f9bSSteven Rostedt 			 * Only the filter_hash affects all records.
1494ed926f9bSSteven Rostedt 			 * Update if the record is not in the notrace hash.
1495ed926f9bSSteven Rostedt 			 */
1496b848914cSSteven Rostedt 			if (!other_hash || !ftrace_lookup_ip(other_hash, rec->ip))
1497ed926f9bSSteven Rostedt 				match = 1;
1498ed926f9bSSteven Rostedt 		} else {
149906a51d93SSteven Rostedt 			in_hash = !!ftrace_lookup_ip(hash, rec->ip);
150006a51d93SSteven Rostedt 			in_other_hash = !!ftrace_lookup_ip(other_hash, rec->ip);
1501ed926f9bSSteven Rostedt 
1502ed926f9bSSteven Rostedt 			/*
1503ed926f9bSSteven Rostedt 			 *
1504ed926f9bSSteven Rostedt 			 */
1505ed926f9bSSteven Rostedt 			if (filter_hash && in_hash && !in_other_hash)
1506ed926f9bSSteven Rostedt 				match = 1;
1507ed926f9bSSteven Rostedt 			else if (!filter_hash && in_hash &&
150806a51d93SSteven Rostedt 				 (in_other_hash || ftrace_hash_empty(other_hash)))
1509ed926f9bSSteven Rostedt 				match = 1;
1510ed926f9bSSteven Rostedt 		}
1511ed926f9bSSteven Rostedt 		if (!match)
1512ed926f9bSSteven Rostedt 			continue;
1513ed926f9bSSteven Rostedt 
1514ed926f9bSSteven Rostedt 		if (inc) {
1515ed926f9bSSteven Rostedt 			rec->flags++;
1516ed926f9bSSteven Rostedt 			if (FTRACE_WARN_ON((rec->flags & ~FTRACE_FL_MASK) == FTRACE_REF_MAX))
1517ed926f9bSSteven Rostedt 				return;
1518ed926f9bSSteven Rostedt 		} else {
1519ed926f9bSSteven Rostedt 			if (FTRACE_WARN_ON((rec->flags & ~FTRACE_FL_MASK) == 0))
1520ed926f9bSSteven Rostedt 				return;
1521ed926f9bSSteven Rostedt 			rec->flags--;
1522ed926f9bSSteven Rostedt 		}
1523ed926f9bSSteven Rostedt 		count++;
1524ed926f9bSSteven Rostedt 		/* Shortcut, if we handled all records, we are done. */
1525ed926f9bSSteven Rostedt 		if (!all && count == hash->count)
1526ed926f9bSSteven Rostedt 			return;
1527ed926f9bSSteven Rostedt 	} while_for_each_ftrace_rec();
1528ed926f9bSSteven Rostedt }
1529ed926f9bSSteven Rostedt 
1530ed926f9bSSteven Rostedt static void ftrace_hash_rec_disable(struct ftrace_ops *ops,
1531ed926f9bSSteven Rostedt 				    int filter_hash)
1532ed926f9bSSteven Rostedt {
1533ed926f9bSSteven Rostedt 	__ftrace_hash_rec_update(ops, filter_hash, 0);
1534ed926f9bSSteven Rostedt }
1535ed926f9bSSteven Rostedt 
1536ed926f9bSSteven Rostedt static void ftrace_hash_rec_enable(struct ftrace_ops *ops,
1537ed926f9bSSteven Rostedt 				   int filter_hash)
1538ed926f9bSSteven Rostedt {
1539ed926f9bSSteven Rostedt 	__ftrace_hash_rec_update(ops, filter_hash, 1);
1540ed926f9bSSteven Rostedt }
1541ed926f9bSSteven Rostedt 
154205736a42SSteven Rostedt static void print_ip_ins(const char *fmt, unsigned char *p)
154305736a42SSteven Rostedt {
154405736a42SSteven Rostedt 	int i;
154505736a42SSteven Rostedt 
154605736a42SSteven Rostedt 	printk(KERN_CONT "%s", fmt);
154705736a42SSteven Rostedt 
154805736a42SSteven Rostedt 	for (i = 0; i < MCOUNT_INSN_SIZE; i++)
154905736a42SSteven Rostedt 		printk(KERN_CONT "%s%02x", i ? ":" : "", p[i]);
155005736a42SSteven Rostedt }
155105736a42SSteven Rostedt 
1552c88fd863SSteven Rostedt /**
1553c88fd863SSteven Rostedt  * ftrace_bug - report and shutdown function tracer
1554c88fd863SSteven Rostedt  * @failed: The failed type (EFAULT, EINVAL, EPERM)
1555c88fd863SSteven Rostedt  * @ip: The address that failed
1556c88fd863SSteven Rostedt  *
1557c88fd863SSteven Rostedt  * The arch code that enables or disables the function tracing
1558c88fd863SSteven Rostedt  * can call ftrace_bug() when it has detected a problem in
1559c88fd863SSteven Rostedt  * modifying the code. @failed should be one of either:
1560c88fd863SSteven Rostedt  * EFAULT - if the problem happens on reading the @ip address
1561c88fd863SSteven Rostedt  * EINVAL - if what is read at @ip is not what was expected
1562c88fd863SSteven Rostedt  * EPERM - if the problem happens on writting to the @ip address
1563c88fd863SSteven Rostedt  */
1564c88fd863SSteven Rostedt void ftrace_bug(int failed, unsigned long ip)
15653c1720f0SSteven Rostedt {
1566b17e8a37SSteven Rostedt 	switch (failed) {
1567593eb8a2SSteven Rostedt 	case -EFAULT:
15686912896eSSteven Rostedt 		FTRACE_WARN_ON_ONCE(1);
156905736a42SSteven Rostedt 		pr_info("ftrace faulted on modifying ");
157005736a42SSteven Rostedt 		print_ip_sym(ip);
157105736a42SSteven Rostedt 		break;
1572593eb8a2SSteven Rostedt 	case -EINVAL:
15736912896eSSteven Rostedt 		FTRACE_WARN_ON_ONCE(1);
157405736a42SSteven Rostedt 		pr_info("ftrace failed to modify ");
157505736a42SSteven Rostedt 		print_ip_sym(ip);
157605736a42SSteven Rostedt 		print_ip_ins(" actual: ", (unsigned char *)ip);
157705736a42SSteven Rostedt 		printk(KERN_CONT "\n");
157805736a42SSteven Rostedt 		break;
1579593eb8a2SSteven Rostedt 	case -EPERM:
15806912896eSSteven Rostedt 		FTRACE_WARN_ON_ONCE(1);
1581593eb8a2SSteven Rostedt 		pr_info("ftrace faulted on writing ");
1582593eb8a2SSteven Rostedt 		print_ip_sym(ip);
1583593eb8a2SSteven Rostedt 		break;
1584593eb8a2SSteven Rostedt 	default:
15856912896eSSteven Rostedt 		FTRACE_WARN_ON_ONCE(1);
1586593eb8a2SSteven Rostedt 		pr_info("ftrace faulted on unknown error ");
1587593eb8a2SSteven Rostedt 		print_ip_sym(ip);
158805736a42SSteven Rostedt 	}
1589b17e8a37SSteven Rostedt }
159005736a42SSteven Rostedt 
1591c88fd863SSteven Rostedt static int ftrace_check_record(struct dyn_ftrace *rec, int enable, int update)
15923d083395SSteven Rostedt {
159364fbcd16SXiao Guangrong 	unsigned long flag = 0UL;
1594e7d3737eSFrederic Weisbecker 
15953d083395SSteven Rostedt 	/*
159630fb6aa7SJiri Olsa 	 * If we are updating calls:
15973d083395SSteven Rostedt 	 *
1598ed926f9bSSteven Rostedt 	 *   If the record has a ref count, then we need to enable it
1599ed926f9bSSteven Rostedt 	 *   because someone is using it.
16003d083395SSteven Rostedt 	 *
1601ed926f9bSSteven Rostedt 	 *   Otherwise we make sure its disabled.
1602ed926f9bSSteven Rostedt 	 *
160330fb6aa7SJiri Olsa 	 * If we are disabling calls, then disable all records that
1604ed926f9bSSteven Rostedt 	 * are enabled.
16053d083395SSteven Rostedt 	 */
1606c88fd863SSteven Rostedt 	if (enable && (rec->flags & ~FTRACE_FL_MASK))
160764fbcd16SXiao Guangrong 		flag = FTRACE_FL_ENABLED;
16083d083395SSteven Rostedt 
160964fbcd16SXiao Guangrong 	/* If the state of this record hasn't changed, then do nothing */
161064fbcd16SXiao Guangrong 	if ((rec->flags & FTRACE_FL_ENABLED) == flag)
1611c88fd863SSteven Rostedt 		return FTRACE_UPDATE_IGNORE;
161264fbcd16SXiao Guangrong 
161364fbcd16SXiao Guangrong 	if (flag) {
1614c88fd863SSteven Rostedt 		if (update)
161564fbcd16SXiao Guangrong 			rec->flags |= FTRACE_FL_ENABLED;
1616c88fd863SSteven Rostedt 		return FTRACE_UPDATE_MAKE_CALL;
161764fbcd16SXiao Guangrong 	}
161864fbcd16SXiao Guangrong 
1619c88fd863SSteven Rostedt 	if (update)
162064fbcd16SXiao Guangrong 		rec->flags &= ~FTRACE_FL_ENABLED;
1621c88fd863SSteven Rostedt 
1622c88fd863SSteven Rostedt 	return FTRACE_UPDATE_MAKE_NOP;
1623c88fd863SSteven Rostedt }
1624c88fd863SSteven Rostedt 
1625c88fd863SSteven Rostedt /**
1626c88fd863SSteven Rostedt  * ftrace_update_record, set a record that now is tracing or not
1627c88fd863SSteven Rostedt  * @rec: the record to update
1628c88fd863SSteven Rostedt  * @enable: set to 1 if the record is tracing, zero to force disable
1629c88fd863SSteven Rostedt  *
1630c88fd863SSteven Rostedt  * The records that represent all functions that can be traced need
1631c88fd863SSteven Rostedt  * to be updated when tracing has been enabled.
1632c88fd863SSteven Rostedt  */
1633c88fd863SSteven Rostedt int ftrace_update_record(struct dyn_ftrace *rec, int enable)
1634c88fd863SSteven Rostedt {
1635c88fd863SSteven Rostedt 	return ftrace_check_record(rec, enable, 1);
1636c88fd863SSteven Rostedt }
1637c88fd863SSteven Rostedt 
1638c88fd863SSteven Rostedt /**
1639c88fd863SSteven Rostedt  * ftrace_test_record, check if the record has been enabled or not
1640c88fd863SSteven Rostedt  * @rec: the record to test
1641c88fd863SSteven Rostedt  * @enable: set to 1 to check if enabled, 0 if it is disabled
1642c88fd863SSteven Rostedt  *
1643c88fd863SSteven Rostedt  * The arch code may need to test if a record is already set to
1644c88fd863SSteven Rostedt  * tracing to determine how to modify the function code that it
1645c88fd863SSteven Rostedt  * represents.
1646c88fd863SSteven Rostedt  */
1647c88fd863SSteven Rostedt int ftrace_test_record(struct dyn_ftrace *rec, int enable)
1648c88fd863SSteven Rostedt {
1649c88fd863SSteven Rostedt 	return ftrace_check_record(rec, enable, 0);
1650c88fd863SSteven Rostedt }
1651c88fd863SSteven Rostedt 
1652c88fd863SSteven Rostedt static int
1653c88fd863SSteven Rostedt __ftrace_replace_code(struct dyn_ftrace *rec, int enable)
1654c88fd863SSteven Rostedt {
1655c88fd863SSteven Rostedt 	unsigned long ftrace_addr;
1656c88fd863SSteven Rostedt 	int ret;
1657c88fd863SSteven Rostedt 
1658c88fd863SSteven Rostedt 	ftrace_addr = (unsigned long)FTRACE_ADDR;
1659c88fd863SSteven Rostedt 
1660c88fd863SSteven Rostedt 	ret = ftrace_update_record(rec, enable);
1661c88fd863SSteven Rostedt 
1662c88fd863SSteven Rostedt 	switch (ret) {
1663c88fd863SSteven Rostedt 	case FTRACE_UPDATE_IGNORE:
1664c88fd863SSteven Rostedt 		return 0;
1665c88fd863SSteven Rostedt 
1666c88fd863SSteven Rostedt 	case FTRACE_UPDATE_MAKE_CALL:
1667c88fd863SSteven Rostedt 		return ftrace_make_call(rec, ftrace_addr);
1668c88fd863SSteven Rostedt 
1669c88fd863SSteven Rostedt 	case FTRACE_UPDATE_MAKE_NOP:
1670e7d3737eSFrederic Weisbecker 		return ftrace_make_nop(NULL, rec, ftrace_addr);
16713d083395SSteven Rostedt 	}
16723d083395SSteven Rostedt 
1673c88fd863SSteven Rostedt 	return -1; /* unknow ftrace bug */
1674c88fd863SSteven Rostedt }
1675c88fd863SSteven Rostedt 
1676e4f5d544SSteven Rostedt void __weak ftrace_replace_code(int enable)
16773d083395SSteven Rostedt {
16783d083395SSteven Rostedt 	struct dyn_ftrace *rec;
16793d083395SSteven Rostedt 	struct ftrace_page *pg;
16806a24a244SSteven Rostedt 	int failed;
16813d083395SSteven Rostedt 
168245a4a237SSteven Rostedt 	if (unlikely(ftrace_disabled))
168345a4a237SSteven Rostedt 		return;
168445a4a237SSteven Rostedt 
1685265c831cSSteven Rostedt 	do_for_each_ftrace_rec(pg, rec) {
1686e4f5d544SSteven Rostedt 		failed = __ftrace_replace_code(rec, enable);
1687fa9d13cfSZhaolei 		if (failed) {
168831e88909SSteven Rostedt 			ftrace_bug(failed, rec->ip);
16894377245aSSteven Rostedt 			/* Stop processing */
16904377245aSSteven Rostedt 			return;
16914377245aSSteven Rostedt 		}
1692265c831cSSteven Rostedt 	} while_for_each_ftrace_rec();
16933d083395SSteven Rostedt }
16943c1720f0SSteven Rostedt 
1695c88fd863SSteven Rostedt struct ftrace_rec_iter {
1696c88fd863SSteven Rostedt 	struct ftrace_page	*pg;
1697c88fd863SSteven Rostedt 	int			index;
1698c88fd863SSteven Rostedt };
1699c88fd863SSteven Rostedt 
1700c88fd863SSteven Rostedt /**
1701c88fd863SSteven Rostedt  * ftrace_rec_iter_start, start up iterating over traced functions
1702c88fd863SSteven Rostedt  *
1703c88fd863SSteven Rostedt  * Returns an iterator handle that is used to iterate over all
1704c88fd863SSteven Rostedt  * the records that represent address locations where functions
1705c88fd863SSteven Rostedt  * are traced.
1706c88fd863SSteven Rostedt  *
1707c88fd863SSteven Rostedt  * May return NULL if no records are available.
1708c88fd863SSteven Rostedt  */
1709c88fd863SSteven Rostedt struct ftrace_rec_iter *ftrace_rec_iter_start(void)
1710c88fd863SSteven Rostedt {
1711c88fd863SSteven Rostedt 	/*
1712c88fd863SSteven Rostedt 	 * We only use a single iterator.
1713c88fd863SSteven Rostedt 	 * Protected by the ftrace_lock mutex.
1714c88fd863SSteven Rostedt 	 */
1715c88fd863SSteven Rostedt 	static struct ftrace_rec_iter ftrace_rec_iter;
1716c88fd863SSteven Rostedt 	struct ftrace_rec_iter *iter = &ftrace_rec_iter;
1717c88fd863SSteven Rostedt 
1718c88fd863SSteven Rostedt 	iter->pg = ftrace_pages_start;
1719c88fd863SSteven Rostedt 	iter->index = 0;
1720c88fd863SSteven Rostedt 
1721c88fd863SSteven Rostedt 	/* Could have empty pages */
1722c88fd863SSteven Rostedt 	while (iter->pg && !iter->pg->index)
1723c88fd863SSteven Rostedt 		iter->pg = iter->pg->next;
1724c88fd863SSteven Rostedt 
1725c88fd863SSteven Rostedt 	if (!iter->pg)
1726c88fd863SSteven Rostedt 		return NULL;
1727c88fd863SSteven Rostedt 
1728c88fd863SSteven Rostedt 	return iter;
1729c88fd863SSteven Rostedt }
1730c88fd863SSteven Rostedt 
1731c88fd863SSteven Rostedt /**
1732c88fd863SSteven Rostedt  * ftrace_rec_iter_next, get the next record to process.
1733c88fd863SSteven Rostedt  * @iter: The handle to the iterator.
1734c88fd863SSteven Rostedt  *
1735c88fd863SSteven Rostedt  * Returns the next iterator after the given iterator @iter.
1736c88fd863SSteven Rostedt  */
1737c88fd863SSteven Rostedt struct ftrace_rec_iter *ftrace_rec_iter_next(struct ftrace_rec_iter *iter)
1738c88fd863SSteven Rostedt {
1739c88fd863SSteven Rostedt 	iter->index++;
1740c88fd863SSteven Rostedt 
1741c88fd863SSteven Rostedt 	if (iter->index >= iter->pg->index) {
1742c88fd863SSteven Rostedt 		iter->pg = iter->pg->next;
1743c88fd863SSteven Rostedt 		iter->index = 0;
1744c88fd863SSteven Rostedt 
1745c88fd863SSteven Rostedt 		/* Could have empty pages */
1746c88fd863SSteven Rostedt 		while (iter->pg && !iter->pg->index)
1747c88fd863SSteven Rostedt 			iter->pg = iter->pg->next;
1748c88fd863SSteven Rostedt 	}
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_record, get the record at the iterator location
1758c88fd863SSteven Rostedt  * @iter: The current iterator location
1759c88fd863SSteven Rostedt  *
1760c88fd863SSteven Rostedt  * Returns the record that the current @iter is at.
1761c88fd863SSteven Rostedt  */
1762c88fd863SSteven Rostedt struct dyn_ftrace *ftrace_rec_iter_record(struct ftrace_rec_iter *iter)
1763c88fd863SSteven Rostedt {
1764c88fd863SSteven Rostedt 	return &iter->pg->records[iter->index];
1765c88fd863SSteven Rostedt }
1766c88fd863SSteven Rostedt 
17673b47bfc1SSteven Rostedt static int
176831e88909SSteven Rostedt ftrace_code_disable(struct module *mod, struct dyn_ftrace *rec)
17693c1720f0SSteven Rostedt {
177037ad5084SSteven Rostedt 	unsigned long ip;
1771492a7ea5SAbhishek Sagar 	int ret;
177237ad5084SSteven Rostedt 
1773492a7ea5SAbhishek Sagar 	ip = rec->ip;
17743c1720f0SSteven Rostedt 
177545a4a237SSteven Rostedt 	if (unlikely(ftrace_disabled))
177645a4a237SSteven Rostedt 		return 0;
177745a4a237SSteven Rostedt 
177825aac9dcSShaohua Li 	ret = ftrace_make_nop(mod, rec, MCOUNT_ADDR);
17793d083395SSteven Rostedt 	if (ret) {
178031e88909SSteven Rostedt 		ftrace_bug(ret, ip);
17813d083395SSteven Rostedt 		return 0;
1782d61f82d0SSteven Rostedt 	}
1783d61f82d0SSteven Rostedt 	return 1;
17843d083395SSteven Rostedt }
17853d083395SSteven Rostedt 
1786000ab691SSteven Rostedt /*
1787000ab691SSteven Rostedt  * archs can override this function if they must do something
1788000ab691SSteven Rostedt  * before the modifying code is performed.
1789000ab691SSteven Rostedt  */
1790000ab691SSteven Rostedt int __weak ftrace_arch_code_modify_prepare(void)
1791000ab691SSteven Rostedt {
1792000ab691SSteven Rostedt 	return 0;
1793000ab691SSteven Rostedt }
1794000ab691SSteven Rostedt 
1795000ab691SSteven Rostedt /*
1796000ab691SSteven Rostedt  * archs can override this function if they must do something
1797000ab691SSteven Rostedt  * after the modifying code is performed.
1798000ab691SSteven Rostedt  */
1799000ab691SSteven Rostedt int __weak ftrace_arch_code_modify_post_process(void)
1800000ab691SSteven Rostedt {
1801000ab691SSteven Rostedt 	return 0;
1802000ab691SSteven Rostedt }
1803000ab691SSteven Rostedt 
18048ed3e2cfSSteven Rostedt void ftrace_modify_all_code(int command)
18058ed3e2cfSSteven Rostedt {
18068ed3e2cfSSteven Rostedt 	if (command & FTRACE_UPDATE_CALLS)
18078ed3e2cfSSteven Rostedt 		ftrace_replace_code(1);
18088ed3e2cfSSteven Rostedt 	else if (command & FTRACE_DISABLE_CALLS)
18098ed3e2cfSSteven Rostedt 		ftrace_replace_code(0);
18108ed3e2cfSSteven Rostedt 
18118ed3e2cfSSteven Rostedt 	if (command & FTRACE_UPDATE_TRACE_FUNC)
18128ed3e2cfSSteven Rostedt 		ftrace_update_ftrace_func(ftrace_trace_function);
18138ed3e2cfSSteven Rostedt 
18148ed3e2cfSSteven Rostedt 	if (command & FTRACE_START_FUNC_RET)
18158ed3e2cfSSteven Rostedt 		ftrace_enable_ftrace_graph_caller();
18168ed3e2cfSSteven Rostedt 	else if (command & FTRACE_STOP_FUNC_RET)
18178ed3e2cfSSteven Rostedt 		ftrace_disable_ftrace_graph_caller();
18188ed3e2cfSSteven Rostedt }
18198ed3e2cfSSteven Rostedt 
18203d083395SSteven Rostedt static int __ftrace_modify_code(void *data)
18213d083395SSteven Rostedt {
18223d083395SSteven Rostedt 	int *command = data;
18233d083395SSteven Rostedt 
18248ed3e2cfSSteven Rostedt 	ftrace_modify_all_code(*command);
18255a45cfe1SSteven Rostedt 
1826c88fd863SSteven Rostedt 	return 0;
1827c88fd863SSteven Rostedt }
1828c88fd863SSteven Rostedt 
1829c88fd863SSteven Rostedt /**
1830c88fd863SSteven Rostedt  * ftrace_run_stop_machine, go back to the stop machine method
1831c88fd863SSteven Rostedt  * @command: The command to tell ftrace what to do
1832c88fd863SSteven Rostedt  *
1833c88fd863SSteven Rostedt  * If an arch needs to fall back to the stop machine method, the
1834c88fd863SSteven Rostedt  * it can call this function.
1835c88fd863SSteven Rostedt  */
1836c88fd863SSteven Rostedt void ftrace_run_stop_machine(int command)
1837c88fd863SSteven Rostedt {
1838c88fd863SSteven Rostedt 	stop_machine(__ftrace_modify_code, &command, NULL);
1839c88fd863SSteven Rostedt }
1840c88fd863SSteven Rostedt 
1841c88fd863SSteven Rostedt /**
1842c88fd863SSteven Rostedt  * arch_ftrace_update_code, modify the code to trace or not trace
1843c88fd863SSteven Rostedt  * @command: The command that needs to be done
1844c88fd863SSteven Rostedt  *
1845c88fd863SSteven Rostedt  * Archs can override this function if it does not need to
1846c88fd863SSteven Rostedt  * run stop_machine() to modify code.
1847c88fd863SSteven Rostedt  */
1848c88fd863SSteven Rostedt void __weak arch_ftrace_update_code(int command)
1849c88fd863SSteven Rostedt {
1850c88fd863SSteven Rostedt 	ftrace_run_stop_machine(command);
1851c88fd863SSteven Rostedt }
1852c88fd863SSteven Rostedt 
1853c88fd863SSteven Rostedt static void ftrace_run_update_code(int command)
1854c88fd863SSteven Rostedt {
1855c88fd863SSteven Rostedt 	int ret;
1856c88fd863SSteven Rostedt 
1857c88fd863SSteven Rostedt 	ret = ftrace_arch_code_modify_prepare();
1858c88fd863SSteven Rostedt 	FTRACE_WARN_ON(ret);
1859c88fd863SSteven Rostedt 	if (ret)
1860c88fd863SSteven Rostedt 		return;
1861c88fd863SSteven Rostedt 	/*
1862c88fd863SSteven Rostedt 	 * Do not call function tracer while we update the code.
1863c88fd863SSteven Rostedt 	 * We are in stop machine.
1864c88fd863SSteven Rostedt 	 */
1865c88fd863SSteven Rostedt 	function_trace_stop++;
1866c88fd863SSteven Rostedt 
1867c88fd863SSteven Rostedt 	/*
1868c88fd863SSteven Rostedt 	 * By default we use stop_machine() to modify the code.
1869c88fd863SSteven Rostedt 	 * But archs can do what ever they want as long as it
1870c88fd863SSteven Rostedt 	 * is safe. The stop_machine() is the safest, but also
1871c88fd863SSteven Rostedt 	 * produces the most overhead.
1872c88fd863SSteven Rostedt 	 */
1873c88fd863SSteven Rostedt 	arch_ftrace_update_code(command);
1874c88fd863SSteven Rostedt 
18756331c28cSSteven Rostedt 	function_trace_stop--;
18766331c28cSSteven Rostedt 
1877000ab691SSteven Rostedt 	ret = ftrace_arch_code_modify_post_process();
1878000ab691SSteven Rostedt 	FTRACE_WARN_ON(ret);
18793d083395SSteven Rostedt }
18803d083395SSteven Rostedt 
18813d083395SSteven Rostedt static ftrace_func_t saved_ftrace_func;
188260a7ecf4SSteven Rostedt static int ftrace_start_up;
1883b848914cSSteven Rostedt static int global_start_up;
1884df4fc315SSteven Rostedt 
1885df4fc315SSteven Rostedt static void ftrace_startup_enable(int command)
1886df4fc315SSteven Rostedt {
1887df4fc315SSteven Rostedt 	if (saved_ftrace_func != ftrace_trace_function) {
1888df4fc315SSteven Rostedt 		saved_ftrace_func = ftrace_trace_function;
1889df4fc315SSteven Rostedt 		command |= FTRACE_UPDATE_TRACE_FUNC;
1890df4fc315SSteven Rostedt 	}
1891df4fc315SSteven Rostedt 
1892df4fc315SSteven Rostedt 	if (!command || !ftrace_enabled)
1893df4fc315SSteven Rostedt 		return;
1894df4fc315SSteven Rostedt 
1895df4fc315SSteven Rostedt 	ftrace_run_update_code(command);
1896df4fc315SSteven Rostedt }
18973d083395SSteven Rostedt 
1898a1cd6173SSteven Rostedt static int ftrace_startup(struct ftrace_ops *ops, int command)
18993d083395SSteven Rostedt {
1900b848914cSSteven Rostedt 	bool hash_enable = true;
1901b848914cSSteven Rostedt 
19024eebcc81SSteven Rostedt 	if (unlikely(ftrace_disabled))
1903a1cd6173SSteven Rostedt 		return -ENODEV;
19044eebcc81SSteven Rostedt 
190560a7ecf4SSteven Rostedt 	ftrace_start_up++;
190630fb6aa7SJiri Olsa 	command |= FTRACE_UPDATE_CALLS;
19073d083395SSteven Rostedt 
1908b848914cSSteven Rostedt 	/* ops marked global share the filter hashes */
1909b848914cSSteven Rostedt 	if (ops->flags & FTRACE_OPS_FL_GLOBAL) {
1910b848914cSSteven Rostedt 		ops = &global_ops;
1911b848914cSSteven Rostedt 		/* Don't update hash if global is already set */
1912b848914cSSteven Rostedt 		if (global_start_up)
1913b848914cSSteven Rostedt 			hash_enable = false;
1914b848914cSSteven Rostedt 		global_start_up++;
1915b848914cSSteven Rostedt 	}
1916b848914cSSteven Rostedt 
1917ed926f9bSSteven Rostedt 	ops->flags |= FTRACE_OPS_FL_ENABLED;
1918b848914cSSteven Rostedt 	if (hash_enable)
1919ed926f9bSSteven Rostedt 		ftrace_hash_rec_enable(ops, 1);
1920ed926f9bSSteven Rostedt 
1921df4fc315SSteven Rostedt 	ftrace_startup_enable(command);
1922a1cd6173SSteven Rostedt 
1923a1cd6173SSteven Rostedt 	return 0;
19243d083395SSteven Rostedt }
19253d083395SSteven Rostedt 
1926bd69c30bSSteven Rostedt static void ftrace_shutdown(struct ftrace_ops *ops, int command)
19273d083395SSteven Rostedt {
1928b848914cSSteven Rostedt 	bool hash_disable = true;
1929b848914cSSteven Rostedt 
19304eebcc81SSteven Rostedt 	if (unlikely(ftrace_disabled))
19314eebcc81SSteven Rostedt 		return;
19324eebcc81SSteven Rostedt 
193360a7ecf4SSteven Rostedt 	ftrace_start_up--;
19349ea1a153SFrederic Weisbecker 	/*
19359ea1a153SFrederic Weisbecker 	 * Just warn in case of unbalance, no need to kill ftrace, it's not
19369ea1a153SFrederic Weisbecker 	 * critical but the ftrace_call callers may be never nopped again after
19379ea1a153SFrederic Weisbecker 	 * further ftrace uses.
19389ea1a153SFrederic Weisbecker 	 */
19399ea1a153SFrederic Weisbecker 	WARN_ON_ONCE(ftrace_start_up < 0);
19409ea1a153SFrederic Weisbecker 
1941b848914cSSteven Rostedt 	if (ops->flags & FTRACE_OPS_FL_GLOBAL) {
1942b848914cSSteven Rostedt 		ops = &global_ops;
1943b848914cSSteven Rostedt 		global_start_up--;
1944b848914cSSteven Rostedt 		WARN_ON_ONCE(global_start_up < 0);
1945b848914cSSteven Rostedt 		/* Don't update hash if global still has users */
1946b848914cSSteven Rostedt 		if (global_start_up) {
1947b848914cSSteven Rostedt 			WARN_ON_ONCE(!ftrace_start_up);
1948b848914cSSteven Rostedt 			hash_disable = false;
1949b848914cSSteven Rostedt 		}
1950b848914cSSteven Rostedt 	}
1951b848914cSSteven Rostedt 
1952b848914cSSteven Rostedt 	if (hash_disable)
1953ed926f9bSSteven Rostedt 		ftrace_hash_rec_disable(ops, 1);
1954ed926f9bSSteven Rostedt 
1955b848914cSSteven Rostedt 	if (ops != &global_ops || !global_start_up)
1956ed926f9bSSteven Rostedt 		ops->flags &= ~FTRACE_OPS_FL_ENABLED;
1957b848914cSSteven Rostedt 
195830fb6aa7SJiri Olsa 	command |= FTRACE_UPDATE_CALLS;
1959d61f82d0SSteven Rostedt 
1960d61f82d0SSteven Rostedt 	if (saved_ftrace_func != ftrace_trace_function) {
1961d61f82d0SSteven Rostedt 		saved_ftrace_func = ftrace_trace_function;
1962d61f82d0SSteven Rostedt 		command |= FTRACE_UPDATE_TRACE_FUNC;
1963d61f82d0SSteven Rostedt 	}
1964d61f82d0SSteven Rostedt 
1965d61f82d0SSteven Rostedt 	if (!command || !ftrace_enabled)
1966e6ea44e9SSteven Rostedt 		return;
19673d083395SSteven Rostedt 
1968d61f82d0SSteven Rostedt 	ftrace_run_update_code(command);
19693d083395SSteven Rostedt }
19703d083395SSteven Rostedt 
1971e309b41dSIngo Molnar static void ftrace_startup_sysctl(void)
1972b0fc494fSSteven Rostedt {
19734eebcc81SSteven Rostedt 	if (unlikely(ftrace_disabled))
19744eebcc81SSteven Rostedt 		return;
19754eebcc81SSteven Rostedt 
1976d61f82d0SSteven Rostedt 	/* Force update next time */
1977d61f82d0SSteven Rostedt 	saved_ftrace_func = NULL;
197860a7ecf4SSteven Rostedt 	/* ftrace_start_up is true if we want ftrace running */
197960a7ecf4SSteven Rostedt 	if (ftrace_start_up)
198030fb6aa7SJiri Olsa 		ftrace_run_update_code(FTRACE_UPDATE_CALLS);
1981b0fc494fSSteven Rostedt }
1982b0fc494fSSteven Rostedt 
1983e309b41dSIngo Molnar static void ftrace_shutdown_sysctl(void)
1984b0fc494fSSteven Rostedt {
19854eebcc81SSteven Rostedt 	if (unlikely(ftrace_disabled))
19864eebcc81SSteven Rostedt 		return;
19874eebcc81SSteven Rostedt 
198860a7ecf4SSteven Rostedt 	/* ftrace_start_up is true if ftrace is running */
198960a7ecf4SSteven Rostedt 	if (ftrace_start_up)
199079e406d7SSteven Rostedt 		ftrace_run_update_code(FTRACE_DISABLE_CALLS);
1991b0fc494fSSteven Rostedt }
1992b0fc494fSSteven Rostedt 
19933d083395SSteven Rostedt static cycle_t		ftrace_update_time;
19943d083395SSteven Rostedt static unsigned long	ftrace_update_cnt;
19953d083395SSteven Rostedt unsigned long		ftrace_update_tot_cnt;
19963d083395SSteven Rostedt 
1997f7bc8b61SSteven Rostedt static int ops_traces_mod(struct ftrace_ops *ops)
1998f7bc8b61SSteven Rostedt {
1999f7bc8b61SSteven Rostedt 	struct ftrace_hash *hash;
2000f7bc8b61SSteven Rostedt 
2001f7bc8b61SSteven Rostedt 	hash = ops->filter_hash;
200206a51d93SSteven Rostedt 	return ftrace_hash_empty(hash);
2003f7bc8b61SSteven Rostedt }
2004f7bc8b61SSteven Rostedt 
200531e88909SSteven Rostedt static int ftrace_update_code(struct module *mod)
20063d083395SSteven Rostedt {
200785ae32aeSSteven Rostedt 	struct ftrace_page *pg;
2008e94142a6SLai Jiangshan 	struct dyn_ftrace *p;
2009f22f9a89SAbhishek Sagar 	cycle_t start, stop;
2010f7bc8b61SSteven Rostedt 	unsigned long ref = 0;
201185ae32aeSSteven Rostedt 	int i;
2012f7bc8b61SSteven Rostedt 
2013f7bc8b61SSteven Rostedt 	/*
2014f7bc8b61SSteven Rostedt 	 * When adding a module, we need to check if tracers are
2015f7bc8b61SSteven Rostedt 	 * currently enabled and if they are set to trace all functions.
2016f7bc8b61SSteven Rostedt 	 * If they are, we need to enable the module functions as well
2017f7bc8b61SSteven Rostedt 	 * as update the reference counts for those function records.
2018f7bc8b61SSteven Rostedt 	 */
2019f7bc8b61SSteven Rostedt 	if (mod) {
2020f7bc8b61SSteven Rostedt 		struct ftrace_ops *ops;
2021f7bc8b61SSteven Rostedt 
2022f7bc8b61SSteven Rostedt 		for (ops = ftrace_ops_list;
2023f7bc8b61SSteven Rostedt 		     ops != &ftrace_list_end; ops = ops->next) {
2024f7bc8b61SSteven Rostedt 			if (ops->flags & FTRACE_OPS_FL_ENABLED &&
2025f7bc8b61SSteven Rostedt 			    ops_traces_mod(ops))
2026f7bc8b61SSteven Rostedt 				ref++;
2027f7bc8b61SSteven Rostedt 		}
2028f7bc8b61SSteven Rostedt 	}
20293d083395SSteven Rostedt 
2030750ed1a4SIngo Molnar 	start = ftrace_now(raw_smp_processor_id());
20313d083395SSteven Rostedt 	ftrace_update_cnt = 0;
20323d083395SSteven Rostedt 
203385ae32aeSSteven Rostedt 	for (pg = ftrace_new_pgs; pg; pg = pg->next) {
2034f22f9a89SAbhishek Sagar 
203585ae32aeSSteven Rostedt 		for (i = 0; i < pg->index; i++) {
203608f5ac90SSteven Rostedt 			/* If something went wrong, bail without enabling anything */
203708f5ac90SSteven Rostedt 			if (unlikely(ftrace_disabled))
203808f5ac90SSteven Rostedt 				return -1;
20393d083395SSteven Rostedt 
204085ae32aeSSteven Rostedt 			p = &pg->records[i];
2041f7bc8b61SSteven Rostedt 			p->flags = ref;
2042f22f9a89SAbhishek Sagar 
20435cb084bbSJiri Olsa 			/*
204425985edcSLucas De Marchi 			 * Do the initial record conversion from mcount jump
20455cb084bbSJiri Olsa 			 * to the NOP instructions.
20465cb084bbSJiri Olsa 			 */
204732082309SSteven Rostedt 			if (!ftrace_code_disable(mod, p))
2048d2c8c3eaSSteven Rostedt 				break;
20495cb084bbSJiri Olsa 
20503d083395SSteven Rostedt 			ftrace_update_cnt++;
20515cb084bbSJiri Olsa 
20525cb084bbSJiri Olsa 			/*
20535cb084bbSJiri Olsa 			 * If the tracing is enabled, go ahead and enable the record.
20545cb084bbSJiri Olsa 			 *
20555cb084bbSJiri Olsa 			 * The reason not to enable the record immediatelly is the
20565cb084bbSJiri Olsa 			 * inherent check of ftrace_make_nop/ftrace_make_call for
20575cb084bbSJiri Olsa 			 * correct previous instructions.  Making first the NOP
20585cb084bbSJiri Olsa 			 * conversion puts the module to the correct state, thus
20595cb084bbSJiri Olsa 			 * passing the ftrace_make_call check.
20605cb084bbSJiri Olsa 			 */
2061f7bc8b61SSteven Rostedt 			if (ftrace_start_up && ref) {
20625cb084bbSJiri Olsa 				int failed = __ftrace_replace_code(p, 1);
206332082309SSteven Rostedt 				if (failed)
20645cb084bbSJiri Olsa 					ftrace_bug(failed, p->ip);
20655cb084bbSJiri Olsa 			}
20665cb084bbSJiri Olsa 		}
206785ae32aeSSteven Rostedt 	}
206885ae32aeSSteven Rostedt 
206985ae32aeSSteven Rostedt 	ftrace_new_pgs = NULL;
20703d083395SSteven Rostedt 
2071750ed1a4SIngo Molnar 	stop = ftrace_now(raw_smp_processor_id());
20723d083395SSteven Rostedt 	ftrace_update_time = stop - start;
20733d083395SSteven Rostedt 	ftrace_update_tot_cnt += ftrace_update_cnt;
20743d083395SSteven Rostedt 
207516444a8aSArnaldo Carvalho de Melo 	return 0;
207616444a8aSArnaldo Carvalho de Melo }
207716444a8aSArnaldo Carvalho de Melo 
2078a7900875SSteven Rostedt static int ftrace_allocate_records(struct ftrace_page *pg, int count)
20793c1720f0SSteven Rostedt {
2080a7900875SSteven Rostedt 	int order;
20813c1720f0SSteven Rostedt 	int cnt;
20823c1720f0SSteven Rostedt 
2083a7900875SSteven Rostedt 	if (WARN_ON(!count))
2084a7900875SSteven Rostedt 		return -EINVAL;
2085a7900875SSteven Rostedt 
2086a7900875SSteven Rostedt 	order = get_count_order(DIV_ROUND_UP(count, ENTRIES_PER_PAGE));
20873c1720f0SSteven Rostedt 
20883c1720f0SSteven Rostedt 	/*
2089a7900875SSteven Rostedt 	 * We want to fill as much as possible. No more than a page
2090a7900875SSteven Rostedt 	 * may be empty.
20913c1720f0SSteven Rostedt 	 */
2092a7900875SSteven Rostedt 	while ((PAGE_SIZE << order) / ENTRY_SIZE >= count + ENTRIES_PER_PAGE)
2093a7900875SSteven Rostedt 		order--;
20943c1720f0SSteven Rostedt 
2095a7900875SSteven Rostedt  again:
2096a7900875SSteven Rostedt 	pg->records = (void *)__get_free_pages(GFP_KERNEL | __GFP_ZERO, order);
2097a7900875SSteven Rostedt 
2098a7900875SSteven Rostedt 	if (!pg->records) {
2099a7900875SSteven Rostedt 		/* if we can't allocate this size, try something smaller */
2100a7900875SSteven Rostedt 		if (!order)
2101a7900875SSteven Rostedt 			return -ENOMEM;
2102a7900875SSteven Rostedt 		order >>= 1;
2103a7900875SSteven Rostedt 		goto again;
2104a7900875SSteven Rostedt 	}
2105a7900875SSteven Rostedt 
2106a7900875SSteven Rostedt 	cnt = (PAGE_SIZE << order) / ENTRY_SIZE;
2107a7900875SSteven Rostedt 	pg->size = cnt;
2108a7900875SSteven Rostedt 
2109a7900875SSteven Rostedt 	if (cnt > count)
2110a7900875SSteven Rostedt 		cnt = count;
2111a7900875SSteven Rostedt 
2112a7900875SSteven Rostedt 	return cnt;
2113a7900875SSteven Rostedt }
2114a7900875SSteven Rostedt 
2115a7900875SSteven Rostedt static struct ftrace_page *
2116a7900875SSteven Rostedt ftrace_allocate_pages(unsigned long num_to_init)
2117a7900875SSteven Rostedt {
2118a7900875SSteven Rostedt 	struct ftrace_page *start_pg;
2119a7900875SSteven Rostedt 	struct ftrace_page *pg;
2120a7900875SSteven Rostedt 	int order;
2121a7900875SSteven Rostedt 	int cnt;
2122a7900875SSteven Rostedt 
2123a7900875SSteven Rostedt 	if (!num_to_init)
2124a7900875SSteven Rostedt 		return 0;
2125a7900875SSteven Rostedt 
2126a7900875SSteven Rostedt 	start_pg = pg = kzalloc(sizeof(*pg), GFP_KERNEL);
2127a7900875SSteven Rostedt 	if (!pg)
2128a7900875SSteven Rostedt 		return NULL;
2129a7900875SSteven Rostedt 
2130a7900875SSteven Rostedt 	/*
2131a7900875SSteven Rostedt 	 * Try to allocate as much as possible in one continues
2132a7900875SSteven Rostedt 	 * location that fills in all of the space. We want to
2133a7900875SSteven Rostedt 	 * waste as little space as possible.
2134a7900875SSteven Rostedt 	 */
2135a7900875SSteven Rostedt 	for (;;) {
2136a7900875SSteven Rostedt 		cnt = ftrace_allocate_records(pg, num_to_init);
2137a7900875SSteven Rostedt 		if (cnt < 0)
2138a7900875SSteven Rostedt 			goto free_pages;
2139a7900875SSteven Rostedt 
2140a7900875SSteven Rostedt 		num_to_init -= cnt;
2141a7900875SSteven Rostedt 		if (!num_to_init)
2142a7900875SSteven Rostedt 			break;
2143a7900875SSteven Rostedt 
2144a7900875SSteven Rostedt 		pg->next = kzalloc(sizeof(*pg), GFP_KERNEL);
2145a7900875SSteven Rostedt 		if (!pg->next)
2146a7900875SSteven Rostedt 			goto free_pages;
2147a7900875SSteven Rostedt 
2148a7900875SSteven Rostedt 		pg = pg->next;
2149a7900875SSteven Rostedt 	}
2150a7900875SSteven Rostedt 
2151a7900875SSteven Rostedt 	return start_pg;
2152a7900875SSteven Rostedt 
2153a7900875SSteven Rostedt  free_pages:
2154a7900875SSteven Rostedt 	while (start_pg) {
2155a7900875SSteven Rostedt 		order = get_count_order(pg->size / ENTRIES_PER_PAGE);
2156a7900875SSteven Rostedt 		free_pages((unsigned long)pg->records, order);
2157a7900875SSteven Rostedt 		start_pg = pg->next;
2158a7900875SSteven Rostedt 		kfree(pg);
2159a7900875SSteven Rostedt 		pg = start_pg;
2160a7900875SSteven Rostedt 	}
2161a7900875SSteven Rostedt 	pr_info("ftrace: FAILED to allocate memory for functions\n");
2162a7900875SSteven Rostedt 	return NULL;
2163a7900875SSteven Rostedt }
2164a7900875SSteven Rostedt 
2165a7900875SSteven Rostedt static int __init ftrace_dyn_table_alloc(unsigned long num_to_init)
2166a7900875SSteven Rostedt {
2167a7900875SSteven Rostedt 	int cnt;
2168a7900875SSteven Rostedt 
2169a7900875SSteven Rostedt 	if (!num_to_init) {
2170a7900875SSteven Rostedt 		pr_info("ftrace: No functions to be traced?\n");
2171a7900875SSteven Rostedt 		return -1;
2172a7900875SSteven Rostedt 	}
21733c1720f0SSteven Rostedt 
217468bf21aaSSteven Rostedt 	cnt = num_to_init / ENTRIES_PER_PAGE;
217508f5ac90SSteven Rostedt 	pr_info("ftrace: allocating %ld entries in %d pages\n",
21765821e1b7Swalimis 		num_to_init, cnt + 1);
21773c1720f0SSteven Rostedt 
21783c1720f0SSteven Rostedt 	return 0;
21793c1720f0SSteven Rostedt }
21803c1720f0SSteven Rostedt 
21815072c59fSSteven Rostedt #define FTRACE_BUFF_MAX (KSYM_SYMBOL_LEN+4) /* room for wildcards */
21825072c59fSSteven Rostedt 
21835072c59fSSteven Rostedt struct ftrace_iterator {
218498c4fd04SSteven Rostedt 	loff_t				pos;
21852bccfffdSSteven Rostedt 	loff_t				func_pos;
21865072c59fSSteven Rostedt 	struct ftrace_page		*pg;
21874aeb6967SSteven Rostedt 	struct dyn_ftrace		*func;
21884aeb6967SSteven Rostedt 	struct ftrace_func_probe	*probe;
21894aeb6967SSteven Rostedt 	struct trace_parser		parser;
21901cf41dd7SSteven Rostedt 	struct ftrace_hash		*hash;
219133dc9b12SSteven Rostedt 	struct ftrace_ops		*ops;
21928fc0c701SSteven Rostedt 	int				hidx;
2193431aa3fbSSteven Rostedt 	int				idx;
21945072c59fSSteven Rostedt 	unsigned			flags;
21955072c59fSSteven Rostedt };
21965072c59fSSteven Rostedt 
2197e309b41dSIngo Molnar static void *
21984aeb6967SSteven Rostedt t_hash_next(struct seq_file *m, loff_t *pos)
21998fc0c701SSteven Rostedt {
22008fc0c701SSteven Rostedt 	struct ftrace_iterator *iter = m->private;
22014aeb6967SSteven Rostedt 	struct hlist_node *hnd = NULL;
22028fc0c701SSteven Rostedt 	struct hlist_head *hhd;
22038fc0c701SSteven Rostedt 
22048fc0c701SSteven Rostedt 	(*pos)++;
220598c4fd04SSteven Rostedt 	iter->pos = *pos;
22068fc0c701SSteven Rostedt 
22074aeb6967SSteven Rostedt 	if (iter->probe)
22084aeb6967SSteven Rostedt 		hnd = &iter->probe->node;
22098fc0c701SSteven Rostedt  retry:
22108fc0c701SSteven Rostedt 	if (iter->hidx >= FTRACE_FUNC_HASHSIZE)
22118fc0c701SSteven Rostedt 		return NULL;
22128fc0c701SSteven Rostedt 
22138fc0c701SSteven Rostedt 	hhd = &ftrace_func_hash[iter->hidx];
22148fc0c701SSteven Rostedt 
22158fc0c701SSteven Rostedt 	if (hlist_empty(hhd)) {
22168fc0c701SSteven Rostedt 		iter->hidx++;
22178fc0c701SSteven Rostedt 		hnd = NULL;
22188fc0c701SSteven Rostedt 		goto retry;
22198fc0c701SSteven Rostedt 	}
22208fc0c701SSteven Rostedt 
22218fc0c701SSteven Rostedt 	if (!hnd)
22228fc0c701SSteven Rostedt 		hnd = hhd->first;
22238fc0c701SSteven Rostedt 	else {
22248fc0c701SSteven Rostedt 		hnd = hnd->next;
22258fc0c701SSteven Rostedt 		if (!hnd) {
22268fc0c701SSteven Rostedt 			iter->hidx++;
22278fc0c701SSteven Rostedt 			goto retry;
22288fc0c701SSteven Rostedt 		}
22298fc0c701SSteven Rostedt 	}
22308fc0c701SSteven Rostedt 
22314aeb6967SSteven Rostedt 	if (WARN_ON_ONCE(!hnd))
22324aeb6967SSteven Rostedt 		return NULL;
22334aeb6967SSteven Rostedt 
22344aeb6967SSteven Rostedt 	iter->probe = hlist_entry(hnd, struct ftrace_func_probe, node);
22354aeb6967SSteven Rostedt 
22364aeb6967SSteven Rostedt 	return iter;
22378fc0c701SSteven Rostedt }
22388fc0c701SSteven Rostedt 
22398fc0c701SSteven Rostedt static void *t_hash_start(struct seq_file *m, loff_t *pos)
22408fc0c701SSteven Rostedt {
22418fc0c701SSteven Rostedt 	struct ftrace_iterator *iter = m->private;
22428fc0c701SSteven Rostedt 	void *p = NULL;
2243d82d6244SLi Zefan 	loff_t l;
2244d82d6244SLi Zefan 
224569a3083cSSteven Rostedt 	if (!(iter->flags & FTRACE_ITER_DO_HASH))
224669a3083cSSteven Rostedt 		return NULL;
224769a3083cSSteven Rostedt 
22482bccfffdSSteven Rostedt 	if (iter->func_pos > *pos)
22492bccfffdSSteven Rostedt 		return NULL;
22508fc0c701SSteven Rostedt 
2251d82d6244SLi Zefan 	iter->hidx = 0;
22522bccfffdSSteven Rostedt 	for (l = 0; l <= (*pos - iter->func_pos); ) {
22534aeb6967SSteven Rostedt 		p = t_hash_next(m, &l);
2254d82d6244SLi Zefan 		if (!p)
2255d82d6244SLi Zefan 			break;
2256d82d6244SLi Zefan 	}
22574aeb6967SSteven Rostedt 	if (!p)
22584aeb6967SSteven Rostedt 		return NULL;
22594aeb6967SSteven Rostedt 
226098c4fd04SSteven Rostedt 	/* Only set this if we have an item */
226198c4fd04SSteven Rostedt 	iter->flags |= FTRACE_ITER_HASH;
226298c4fd04SSteven Rostedt 
22634aeb6967SSteven Rostedt 	return iter;
22648fc0c701SSteven Rostedt }
22658fc0c701SSteven Rostedt 
22664aeb6967SSteven Rostedt static int
22674aeb6967SSteven Rostedt t_hash_show(struct seq_file *m, struct ftrace_iterator *iter)
22688fc0c701SSteven Rostedt {
2269b6887d79SSteven Rostedt 	struct ftrace_func_probe *rec;
22708fc0c701SSteven Rostedt 
22714aeb6967SSteven Rostedt 	rec = iter->probe;
22724aeb6967SSteven Rostedt 	if (WARN_ON_ONCE(!rec))
22734aeb6967SSteven Rostedt 		return -EIO;
22748fc0c701SSteven Rostedt 
2275809dcf29SSteven Rostedt 	if (rec->ops->print)
2276809dcf29SSteven Rostedt 		return rec->ops->print(m, rec->ip, rec->ops, rec->data);
2277809dcf29SSteven Rostedt 
2278b375a11aSSteven Rostedt 	seq_printf(m, "%ps:%ps", (void *)rec->ip, (void *)rec->ops->func);
22798fc0c701SSteven Rostedt 
22808fc0c701SSteven Rostedt 	if (rec->data)
22818fc0c701SSteven Rostedt 		seq_printf(m, ":%p", rec->data);
22828fc0c701SSteven Rostedt 	seq_putc(m, '\n');
22838fc0c701SSteven Rostedt 
22848fc0c701SSteven Rostedt 	return 0;
22858fc0c701SSteven Rostedt }
22868fc0c701SSteven Rostedt 
22878fc0c701SSteven Rostedt static void *
22885072c59fSSteven Rostedt t_next(struct seq_file *m, void *v, loff_t *pos)
22895072c59fSSteven Rostedt {
22905072c59fSSteven Rostedt 	struct ftrace_iterator *iter = m->private;
2291fc13cb0cSSteven Rostedt 	struct ftrace_ops *ops = iter->ops;
22925072c59fSSteven Rostedt 	struct dyn_ftrace *rec = NULL;
22935072c59fSSteven Rostedt 
229445a4a237SSteven Rostedt 	if (unlikely(ftrace_disabled))
229545a4a237SSteven Rostedt 		return NULL;
229645a4a237SSteven Rostedt 
22978fc0c701SSteven Rostedt 	if (iter->flags & FTRACE_ITER_HASH)
22984aeb6967SSteven Rostedt 		return t_hash_next(m, pos);
22998fc0c701SSteven Rostedt 
23005072c59fSSteven Rostedt 	(*pos)++;
23011106b699SJiri Olsa 	iter->pos = iter->func_pos = *pos;
23025072c59fSSteven Rostedt 
23030c75a3edSSteven Rostedt 	if (iter->flags & FTRACE_ITER_PRINTALL)
230457c072c7SSteven Rostedt 		return t_hash_start(m, pos);
23050c75a3edSSteven Rostedt 
23065072c59fSSteven Rostedt  retry:
23075072c59fSSteven Rostedt 	if (iter->idx >= iter->pg->index) {
23085072c59fSSteven Rostedt 		if (iter->pg->next) {
23095072c59fSSteven Rostedt 			iter->pg = iter->pg->next;
23105072c59fSSteven Rostedt 			iter->idx = 0;
23115072c59fSSteven Rostedt 			goto retry;
23125072c59fSSteven Rostedt 		}
23135072c59fSSteven Rostedt 	} else {
23145072c59fSSteven Rostedt 		rec = &iter->pg->records[iter->idx++];
231532082309SSteven Rostedt 		if (((iter->flags & FTRACE_ITER_FILTER) &&
2316f45948e8SSteven Rostedt 		     !(ftrace_lookup_ip(ops->filter_hash, rec->ip))) ||
23170183fb1cSSteven Rostedt 
231841c52c0dSSteven Rostedt 		    ((iter->flags & FTRACE_ITER_NOTRACE) &&
2319647bcd03SSteven Rostedt 		     !ftrace_lookup_ip(ops->notrace_hash, rec->ip)) ||
2320647bcd03SSteven Rostedt 
2321647bcd03SSteven Rostedt 		    ((iter->flags & FTRACE_ITER_ENABLED) &&
2322647bcd03SSteven Rostedt 		     !(rec->flags & ~FTRACE_FL_MASK))) {
2323647bcd03SSteven Rostedt 
23245072c59fSSteven Rostedt 			rec = NULL;
23255072c59fSSteven Rostedt 			goto retry;
23265072c59fSSteven Rostedt 		}
23275072c59fSSteven Rostedt 	}
23285072c59fSSteven Rostedt 
23294aeb6967SSteven Rostedt 	if (!rec)
233057c072c7SSteven Rostedt 		return t_hash_start(m, pos);
23314aeb6967SSteven Rostedt 
23324aeb6967SSteven Rostedt 	iter->func = rec;
23334aeb6967SSteven Rostedt 
23344aeb6967SSteven Rostedt 	return iter;
23355072c59fSSteven Rostedt }
23365072c59fSSteven Rostedt 
233798c4fd04SSteven Rostedt static void reset_iter_read(struct ftrace_iterator *iter)
233898c4fd04SSteven Rostedt {
233998c4fd04SSteven Rostedt 	iter->pos = 0;
234098c4fd04SSteven Rostedt 	iter->func_pos = 0;
234198c4fd04SSteven Rostedt 	iter->flags &= ~(FTRACE_ITER_PRINTALL & FTRACE_ITER_HASH);
23425072c59fSSteven Rostedt }
23435072c59fSSteven Rostedt 
23445072c59fSSteven Rostedt static void *t_start(struct seq_file *m, loff_t *pos)
23455072c59fSSteven Rostedt {
23465072c59fSSteven Rostedt 	struct ftrace_iterator *iter = m->private;
2347fc13cb0cSSteven Rostedt 	struct ftrace_ops *ops = iter->ops;
23485072c59fSSteven Rostedt 	void *p = NULL;
2349694ce0a5SLi Zefan 	loff_t l;
23505072c59fSSteven Rostedt 
23518fc0c701SSteven Rostedt 	mutex_lock(&ftrace_lock);
235245a4a237SSteven Rostedt 
235345a4a237SSteven Rostedt 	if (unlikely(ftrace_disabled))
235445a4a237SSteven Rostedt 		return NULL;
235545a4a237SSteven Rostedt 
23560c75a3edSSteven Rostedt 	/*
235798c4fd04SSteven Rostedt 	 * If an lseek was done, then reset and start from beginning.
235898c4fd04SSteven Rostedt 	 */
235998c4fd04SSteven Rostedt 	if (*pos < iter->pos)
236098c4fd04SSteven Rostedt 		reset_iter_read(iter);
236198c4fd04SSteven Rostedt 
236298c4fd04SSteven Rostedt 	/*
23630c75a3edSSteven Rostedt 	 * For set_ftrace_filter reading, if we have the filter
23640c75a3edSSteven Rostedt 	 * off, we can short cut and just print out that all
23650c75a3edSSteven Rostedt 	 * functions are enabled.
23660c75a3edSSteven Rostedt 	 */
236706a51d93SSteven Rostedt 	if (iter->flags & FTRACE_ITER_FILTER &&
236806a51d93SSteven Rostedt 	    ftrace_hash_empty(ops->filter_hash)) {
23690c75a3edSSteven Rostedt 		if (*pos > 0)
23708fc0c701SSteven Rostedt 			return t_hash_start(m, pos);
23710c75a3edSSteven Rostedt 		iter->flags |= FTRACE_ITER_PRINTALL;
2372df091625SChris Wright 		/* reset in case of seek/pread */
2373df091625SChris Wright 		iter->flags &= ~FTRACE_ITER_HASH;
23740c75a3edSSteven Rostedt 		return iter;
23750c75a3edSSteven Rostedt 	}
23760c75a3edSSteven Rostedt 
23778fc0c701SSteven Rostedt 	if (iter->flags & FTRACE_ITER_HASH)
23788fc0c701SSteven Rostedt 		return t_hash_start(m, pos);
23798fc0c701SSteven Rostedt 
238098c4fd04SSteven Rostedt 	/*
238198c4fd04SSteven Rostedt 	 * Unfortunately, we need to restart at ftrace_pages_start
238298c4fd04SSteven Rostedt 	 * every time we let go of the ftrace_mutex. This is because
238398c4fd04SSteven Rostedt 	 * those pointers can change without the lock.
238498c4fd04SSteven Rostedt 	 */
2385694ce0a5SLi Zefan 	iter->pg = ftrace_pages_start;
2386694ce0a5SLi Zefan 	iter->idx = 0;
2387694ce0a5SLi Zefan 	for (l = 0; l <= *pos; ) {
2388694ce0a5SLi Zefan 		p = t_next(m, p, &l);
2389694ce0a5SLi Zefan 		if (!p)
2390694ce0a5SLi Zefan 			break;
239150cdaf08SLiming Wang 	}
23925821e1b7Swalimis 
239369a3083cSSteven Rostedt 	if (!p)
23948fc0c701SSteven Rostedt 		return t_hash_start(m, pos);
23958fc0c701SSteven Rostedt 
23964aeb6967SSteven Rostedt 	return iter;
23975072c59fSSteven Rostedt }
23985072c59fSSteven Rostedt 
23995072c59fSSteven Rostedt static void t_stop(struct seq_file *m, void *p)
24005072c59fSSteven Rostedt {
24018fc0c701SSteven Rostedt 	mutex_unlock(&ftrace_lock);
24025072c59fSSteven Rostedt }
24035072c59fSSteven Rostedt 
24045072c59fSSteven Rostedt static int t_show(struct seq_file *m, void *v)
24055072c59fSSteven Rostedt {
24060c75a3edSSteven Rostedt 	struct ftrace_iterator *iter = m->private;
24074aeb6967SSteven Rostedt 	struct dyn_ftrace *rec;
24085072c59fSSteven Rostedt 
24098fc0c701SSteven Rostedt 	if (iter->flags & FTRACE_ITER_HASH)
24104aeb6967SSteven Rostedt 		return t_hash_show(m, iter);
24118fc0c701SSteven Rostedt 
24120c75a3edSSteven Rostedt 	if (iter->flags & FTRACE_ITER_PRINTALL) {
24130c75a3edSSteven Rostedt 		seq_printf(m, "#### all functions enabled ####\n");
24140c75a3edSSteven Rostedt 		return 0;
24150c75a3edSSteven Rostedt 	}
24160c75a3edSSteven Rostedt 
24174aeb6967SSteven Rostedt 	rec = iter->func;
24184aeb6967SSteven Rostedt 
24195072c59fSSteven Rostedt 	if (!rec)
24205072c59fSSteven Rostedt 		return 0;
24215072c59fSSteven Rostedt 
2422647bcd03SSteven Rostedt 	seq_printf(m, "%ps", (void *)rec->ip);
2423647bcd03SSteven Rostedt 	if (iter->flags & FTRACE_ITER_ENABLED)
2424647bcd03SSteven Rostedt 		seq_printf(m, " (%ld)",
2425647bcd03SSteven Rostedt 			   rec->flags & ~FTRACE_FL_MASK);
2426647bcd03SSteven Rostedt 	seq_printf(m, "\n");
24275072c59fSSteven Rostedt 
24285072c59fSSteven Rostedt 	return 0;
24295072c59fSSteven Rostedt }
24305072c59fSSteven Rostedt 
243188e9d34cSJames Morris static const struct seq_operations show_ftrace_seq_ops = {
24325072c59fSSteven Rostedt 	.start = t_start,
24335072c59fSSteven Rostedt 	.next = t_next,
24345072c59fSSteven Rostedt 	.stop = t_stop,
24355072c59fSSteven Rostedt 	.show = t_show,
24365072c59fSSteven Rostedt };
24375072c59fSSteven Rostedt 
2438e309b41dSIngo Molnar static int
24395072c59fSSteven Rostedt ftrace_avail_open(struct inode *inode, struct file *file)
24405072c59fSSteven Rostedt {
24415072c59fSSteven Rostedt 	struct ftrace_iterator *iter;
24425072c59fSSteven Rostedt 
24434eebcc81SSteven Rostedt 	if (unlikely(ftrace_disabled))
24444eebcc81SSteven Rostedt 		return -ENODEV;
24454eebcc81SSteven Rostedt 
244650e18b94SJiri Olsa 	iter = __seq_open_private(file, &show_ftrace_seq_ops, sizeof(*iter));
244750e18b94SJiri Olsa 	if (iter) {
24485072c59fSSteven Rostedt 		iter->pg = ftrace_pages_start;
2449fc13cb0cSSteven Rostedt 		iter->ops = &global_ops;
24504bf39a94SIngo Molnar 	}
24515072c59fSSteven Rostedt 
245250e18b94SJiri Olsa 	return iter ? 0 : -ENOMEM;
24535072c59fSSteven Rostedt }
24545072c59fSSteven Rostedt 
2455647bcd03SSteven Rostedt static int
2456647bcd03SSteven Rostedt ftrace_enabled_open(struct inode *inode, struct file *file)
2457647bcd03SSteven Rostedt {
2458647bcd03SSteven Rostedt 	struct ftrace_iterator *iter;
2459647bcd03SSteven Rostedt 
2460647bcd03SSteven Rostedt 	if (unlikely(ftrace_disabled))
2461647bcd03SSteven Rostedt 		return -ENODEV;
2462647bcd03SSteven Rostedt 
246350e18b94SJiri Olsa 	iter = __seq_open_private(file, &show_ftrace_seq_ops, sizeof(*iter));
246450e18b94SJiri Olsa 	if (iter) {
2465647bcd03SSteven Rostedt 		iter->pg = ftrace_pages_start;
2466647bcd03SSteven Rostedt 		iter->flags = FTRACE_ITER_ENABLED;
2467fc13cb0cSSteven Rostedt 		iter->ops = &global_ops;
2468647bcd03SSteven Rostedt 	}
2469647bcd03SSteven Rostedt 
247050e18b94SJiri Olsa 	return iter ? 0 : -ENOMEM;
2471647bcd03SSteven Rostedt }
2472647bcd03SSteven Rostedt 
24731cf41dd7SSteven Rostedt static void ftrace_filter_reset(struct ftrace_hash *hash)
24745072c59fSSteven Rostedt {
247552baf119SSteven Rostedt 	mutex_lock(&ftrace_lock);
24761cf41dd7SSteven Rostedt 	ftrace_hash_clear(hash);
247752baf119SSteven Rostedt 	mutex_unlock(&ftrace_lock);
24785072c59fSSteven Rostedt }
24795072c59fSSteven Rostedt 
2480fc13cb0cSSteven Rostedt /**
2481fc13cb0cSSteven Rostedt  * ftrace_regex_open - initialize function tracer filter files
2482fc13cb0cSSteven Rostedt  * @ops: The ftrace_ops that hold the hash filters
2483fc13cb0cSSteven Rostedt  * @flag: The type of filter to process
2484fc13cb0cSSteven Rostedt  * @inode: The inode, usually passed in to your open routine
2485fc13cb0cSSteven Rostedt  * @file: The file, usually passed in to your open routine
2486fc13cb0cSSteven Rostedt  *
2487fc13cb0cSSteven Rostedt  * ftrace_regex_open() initializes the filter files for the
2488fc13cb0cSSteven Rostedt  * @ops. Depending on @flag it may process the filter hash or
2489fc13cb0cSSteven Rostedt  * the notrace hash of @ops. With this called from the open
2490fc13cb0cSSteven Rostedt  * routine, you can use ftrace_filter_write() for the write
2491fc13cb0cSSteven Rostedt  * routine if @flag has FTRACE_ITER_FILTER set, or
2492fc13cb0cSSteven Rostedt  * ftrace_notrace_write() if @flag has FTRACE_ITER_NOTRACE set.
2493fc13cb0cSSteven Rostedt  * ftrace_regex_lseek() should be used as the lseek routine, and
2494fc13cb0cSSteven Rostedt  * release must call ftrace_regex_release().
2495fc13cb0cSSteven Rostedt  */
2496fc13cb0cSSteven Rostedt int
2497f45948e8SSteven Rostedt ftrace_regex_open(struct ftrace_ops *ops, int flag,
24981cf41dd7SSteven Rostedt 		  struct inode *inode, struct file *file)
24995072c59fSSteven Rostedt {
25005072c59fSSteven Rostedt 	struct ftrace_iterator *iter;
2501f45948e8SSteven Rostedt 	struct ftrace_hash *hash;
25025072c59fSSteven Rostedt 	int ret = 0;
25035072c59fSSteven Rostedt 
25044eebcc81SSteven Rostedt 	if (unlikely(ftrace_disabled))
25054eebcc81SSteven Rostedt 		return -ENODEV;
25064eebcc81SSteven Rostedt 
25075072c59fSSteven Rostedt 	iter = kzalloc(sizeof(*iter), GFP_KERNEL);
25085072c59fSSteven Rostedt 	if (!iter)
25095072c59fSSteven Rostedt 		return -ENOMEM;
25105072c59fSSteven Rostedt 
2511689fd8b6S[email protected] 	if (trace_parser_get_init(&iter->parser, FTRACE_BUFF_MAX)) {
2512689fd8b6S[email protected] 		kfree(iter);
2513689fd8b6S[email protected] 		return -ENOMEM;
2514689fd8b6S[email protected] 	}
2515689fd8b6S[email protected] 
2516f45948e8SSteven Rostedt 	if (flag & FTRACE_ITER_NOTRACE)
2517f45948e8SSteven Rostedt 		hash = ops->notrace_hash;
2518f45948e8SSteven Rostedt 	else
2519f45948e8SSteven Rostedt 		hash = ops->filter_hash;
2520f45948e8SSteven Rostedt 
252133dc9b12SSteven Rostedt 	iter->ops = ops;
252233dc9b12SSteven Rostedt 	iter->flags = flag;
252333dc9b12SSteven Rostedt 
252433dc9b12SSteven Rostedt 	if (file->f_mode & FMODE_WRITE) {
252533dc9b12SSteven Rostedt 		mutex_lock(&ftrace_lock);
252633dc9b12SSteven Rostedt 		iter->hash = alloc_and_copy_ftrace_hash(FTRACE_HASH_DEFAULT_BITS, hash);
252733dc9b12SSteven Rostedt 		mutex_unlock(&ftrace_lock);
252833dc9b12SSteven Rostedt 
252933dc9b12SSteven Rostedt 		if (!iter->hash) {
253033dc9b12SSteven Rostedt 			trace_parser_put(&iter->parser);
253133dc9b12SSteven Rostedt 			kfree(iter);
253233dc9b12SSteven Rostedt 			return -ENOMEM;
253333dc9b12SSteven Rostedt 		}
253433dc9b12SSteven Rostedt 	}
25351cf41dd7SSteven Rostedt 
253641c52c0dSSteven Rostedt 	mutex_lock(&ftrace_regex_lock);
253733dc9b12SSteven Rostedt 
25385072c59fSSteven Rostedt 	if ((file->f_mode & FMODE_WRITE) &&
25398650ae32SSteven Rostedt 	    (file->f_flags & O_TRUNC))
254033dc9b12SSteven Rostedt 		ftrace_filter_reset(iter->hash);
25415072c59fSSteven Rostedt 
25425072c59fSSteven Rostedt 	if (file->f_mode & FMODE_READ) {
25435072c59fSSteven Rostedt 		iter->pg = ftrace_pages_start;
25445072c59fSSteven Rostedt 
25455072c59fSSteven Rostedt 		ret = seq_open(file, &show_ftrace_seq_ops);
25465072c59fSSteven Rostedt 		if (!ret) {
25475072c59fSSteven Rostedt 			struct seq_file *m = file->private_data;
25485072c59fSSteven Rostedt 			m->private = iter;
254979fe249cSLi Zefan 		} else {
255033dc9b12SSteven Rostedt 			/* Failed */
255133dc9b12SSteven Rostedt 			free_ftrace_hash(iter->hash);
255279fe249cSLi Zefan 			trace_parser_put(&iter->parser);
25535072c59fSSteven Rostedt 			kfree(iter);
255479fe249cSLi Zefan 		}
25555072c59fSSteven Rostedt 	} else
25565072c59fSSteven Rostedt 		file->private_data = iter;
255741c52c0dSSteven Rostedt 	mutex_unlock(&ftrace_regex_lock);
25585072c59fSSteven Rostedt 
25595072c59fSSteven Rostedt 	return ret;
25605072c59fSSteven Rostedt }
25615072c59fSSteven Rostedt 
256241c52c0dSSteven Rostedt static int
256341c52c0dSSteven Rostedt ftrace_filter_open(struct inode *inode, struct file *file)
256441c52c0dSSteven Rostedt {
256569a3083cSSteven Rostedt 	return ftrace_regex_open(&global_ops,
256669a3083cSSteven Rostedt 			FTRACE_ITER_FILTER | FTRACE_ITER_DO_HASH,
25671cf41dd7SSteven Rostedt 			inode, file);
256841c52c0dSSteven Rostedt }
256941c52c0dSSteven Rostedt 
257041c52c0dSSteven Rostedt static int
257141c52c0dSSteven Rostedt ftrace_notrace_open(struct inode *inode, struct file *file)
257241c52c0dSSteven Rostedt {
2573f45948e8SSteven Rostedt 	return ftrace_regex_open(&global_ops, FTRACE_ITER_NOTRACE,
25741cf41dd7SSteven Rostedt 				 inode, file);
257541c52c0dSSteven Rostedt }
257641c52c0dSSteven Rostedt 
2577fc13cb0cSSteven Rostedt loff_t
257841c52c0dSSteven Rostedt ftrace_regex_lseek(struct file *file, loff_t offset, int origin)
25795072c59fSSteven Rostedt {
25805072c59fSSteven Rostedt 	loff_t ret;
25815072c59fSSteven Rostedt 
25825072c59fSSteven Rostedt 	if (file->f_mode & FMODE_READ)
25835072c59fSSteven Rostedt 		ret = seq_lseek(file, offset, origin);
25845072c59fSSteven Rostedt 	else
25855072c59fSSteven Rostedt 		file->f_pos = ret = 1;
25865072c59fSSteven Rostedt 
25875072c59fSSteven Rostedt 	return ret;
25885072c59fSSteven Rostedt }
25895072c59fSSteven Rostedt 
259064e7c440SSteven Rostedt static int ftrace_match(char *str, char *regex, int len, int type)
25919f4801e3SSteven Rostedt {
25929f4801e3SSteven Rostedt 	int matched = 0;
2593751e9983SLi Zefan 	int slen;
25949f4801e3SSteven Rostedt 
25959f4801e3SSteven Rostedt 	switch (type) {
25969f4801e3SSteven Rostedt 	case MATCH_FULL:
25979f4801e3SSteven Rostedt 		if (strcmp(str, regex) == 0)
25989f4801e3SSteven Rostedt 			matched = 1;
25999f4801e3SSteven Rostedt 		break;
26009f4801e3SSteven Rostedt 	case MATCH_FRONT_ONLY:
26019f4801e3SSteven Rostedt 		if (strncmp(str, regex, len) == 0)
26029f4801e3SSteven Rostedt 			matched = 1;
26039f4801e3SSteven Rostedt 		break;
26049f4801e3SSteven Rostedt 	case MATCH_MIDDLE_ONLY:
26059f4801e3SSteven Rostedt 		if (strstr(str, regex))
26069f4801e3SSteven Rostedt 			matched = 1;
26079f4801e3SSteven Rostedt 		break;
26089f4801e3SSteven Rostedt 	case MATCH_END_ONLY:
2609751e9983SLi Zefan 		slen = strlen(str);
2610751e9983SLi Zefan 		if (slen >= len && memcmp(str + slen - len, regex, len) == 0)
26119f4801e3SSteven Rostedt 			matched = 1;
26129f4801e3SSteven Rostedt 		break;
26139f4801e3SSteven Rostedt 	}
26149f4801e3SSteven Rostedt 
26159f4801e3SSteven Rostedt 	return matched;
26169f4801e3SSteven Rostedt }
26179f4801e3SSteven Rostedt 
2618b448c4e3SSteven Rostedt static int
26191cf41dd7SSteven Rostedt enter_record(struct ftrace_hash *hash, struct dyn_ftrace *rec, int not)
262064e7c440SSteven Rostedt {
2621b448c4e3SSteven Rostedt 	struct ftrace_func_entry *entry;
2622b448c4e3SSteven Rostedt 	int ret = 0;
2623b448c4e3SSteven Rostedt 
26241cf41dd7SSteven Rostedt 	entry = ftrace_lookup_ip(hash, rec->ip);
2625b448c4e3SSteven Rostedt 	if (not) {
2626b448c4e3SSteven Rostedt 		/* Do nothing if it doesn't exist */
2627b448c4e3SSteven Rostedt 		if (!entry)
2628b448c4e3SSteven Rostedt 			return 0;
2629b448c4e3SSteven Rostedt 
263033dc9b12SSteven Rostedt 		free_hash_entry(hash, entry);
2631b448c4e3SSteven Rostedt 	} else {
2632b448c4e3SSteven Rostedt 		/* Do nothing if it exists */
2633b448c4e3SSteven Rostedt 		if (entry)
2634b448c4e3SSteven Rostedt 			return 0;
2635b448c4e3SSteven Rostedt 
2636b448c4e3SSteven Rostedt 		ret = add_hash_entry(hash, rec->ip);
2637b448c4e3SSteven Rostedt 	}
2638b448c4e3SSteven Rostedt 	return ret;
2639996e87beSSteven Rostedt }
2640996e87beSSteven Rostedt 
264164e7c440SSteven Rostedt static int
2642b9df92d2SSteven Rostedt ftrace_match_record(struct dyn_ftrace *rec, char *mod,
2643b9df92d2SSteven Rostedt 		    char *regex, int len, int type)
264464e7c440SSteven Rostedt {
264564e7c440SSteven Rostedt 	char str[KSYM_SYMBOL_LEN];
2646b9df92d2SSteven Rostedt 	char *modname;
264764e7c440SSteven Rostedt 
2648b9df92d2SSteven Rostedt 	kallsyms_lookup(rec->ip, NULL, NULL, &modname, str);
2649b9df92d2SSteven Rostedt 
2650b9df92d2SSteven Rostedt 	if (mod) {
2651b9df92d2SSteven Rostedt 		/* module lookup requires matching the module */
2652b9df92d2SSteven Rostedt 		if (!modname || strcmp(modname, mod))
2653b9df92d2SSteven Rostedt 			return 0;
2654b9df92d2SSteven Rostedt 
2655b9df92d2SSteven Rostedt 		/* blank search means to match all funcs in the mod */
2656b9df92d2SSteven Rostedt 		if (!len)
2657b9df92d2SSteven Rostedt 			return 1;
2658b9df92d2SSteven Rostedt 	}
2659b9df92d2SSteven Rostedt 
266064e7c440SSteven Rostedt 	return ftrace_match(str, regex, len, type);
266164e7c440SSteven Rostedt }
266264e7c440SSteven Rostedt 
26631cf41dd7SSteven Rostedt static int
26641cf41dd7SSteven Rostedt match_records(struct ftrace_hash *hash, char *buff,
26651cf41dd7SSteven Rostedt 	      int len, char *mod, int not)
26669f4801e3SSteven Rostedt {
2667b9df92d2SSteven Rostedt 	unsigned search_len = 0;
26689f4801e3SSteven Rostedt 	struct ftrace_page *pg;
26699f4801e3SSteven Rostedt 	struct dyn_ftrace *rec;
2670b9df92d2SSteven Rostedt 	int type = MATCH_FULL;
2671b9df92d2SSteven Rostedt 	char *search = buff;
2672311d16daSLi Zefan 	int found = 0;
2673b448c4e3SSteven Rostedt 	int ret;
26749f4801e3SSteven Rostedt 
2675b9df92d2SSteven Rostedt 	if (len) {
26763f6fe06dSFrederic Weisbecker 		type = filter_parse_regex(buff, len, &search, &not);
26779f4801e3SSteven Rostedt 		search_len = strlen(search);
2678b9df92d2SSteven Rostedt 	}
2679b9df92d2SSteven Rostedt 
268052baf119SSteven Rostedt 	mutex_lock(&ftrace_lock);
2681b9df92d2SSteven Rostedt 
2682b9df92d2SSteven Rostedt 	if (unlikely(ftrace_disabled))
2683b9df92d2SSteven Rostedt 		goto out_unlock;
2684b9df92d2SSteven Rostedt 
2685265c831cSSteven Rostedt 	do_for_each_ftrace_rec(pg, rec) {
2686b9df92d2SSteven Rostedt 		if (ftrace_match_record(rec, mod, search, search_len, type)) {
26871cf41dd7SSteven Rostedt 			ret = enter_record(hash, rec, not);
2688b448c4e3SSteven Rostedt 			if (ret < 0) {
2689b448c4e3SSteven Rostedt 				found = ret;
2690b448c4e3SSteven Rostedt 				goto out_unlock;
2691b448c4e3SSteven Rostedt 			}
2692311d16daSLi Zefan 			found = 1;
26935072c59fSSteven Rostedt 		}
2694265c831cSSteven Rostedt 	} while_for_each_ftrace_rec();
2695b9df92d2SSteven Rostedt  out_unlock:
269652baf119SSteven Rostedt 	mutex_unlock(&ftrace_lock);
2697311d16daSLi Zefan 
2698311d16daSLi Zefan 	return found;
26995072c59fSSteven Rostedt }
27005072c59fSSteven Rostedt 
270164e7c440SSteven Rostedt static int
27021cf41dd7SSteven Rostedt ftrace_match_records(struct ftrace_hash *hash, char *buff, int len)
270364e7c440SSteven Rostedt {
27041cf41dd7SSteven Rostedt 	return match_records(hash, buff, len, NULL, 0);
270564e7c440SSteven Rostedt }
270664e7c440SSteven Rostedt 
27071cf41dd7SSteven Rostedt static int
27081cf41dd7SSteven Rostedt ftrace_match_module_records(struct ftrace_hash *hash, char *buff, char *mod)
270964e7c440SSteven Rostedt {
271064e7c440SSteven Rostedt 	int not = 0;
27116a24a244SSteven Rostedt 
271264e7c440SSteven Rostedt 	/* blank or '*' mean the same */
271364e7c440SSteven Rostedt 	if (strcmp(buff, "*") == 0)
271464e7c440SSteven Rostedt 		buff[0] = 0;
271564e7c440SSteven Rostedt 
271664e7c440SSteven Rostedt 	/* handle the case of 'dont filter this module' */
271764e7c440SSteven Rostedt 	if (strcmp(buff, "!") == 0 || strcmp(buff, "!*") == 0) {
271864e7c440SSteven Rostedt 		buff[0] = 0;
271964e7c440SSteven Rostedt 		not = 1;
272064e7c440SSteven Rostedt 	}
272164e7c440SSteven Rostedt 
27221cf41dd7SSteven Rostedt 	return match_records(hash, buff, strlen(buff), mod, not);
272364e7c440SSteven Rostedt }
272464e7c440SSteven Rostedt 
2725f6180773SSteven Rostedt /*
2726f6180773SSteven Rostedt  * We register the module command as a template to show others how
2727f6180773SSteven Rostedt  * to register the a command as well.
2728f6180773SSteven Rostedt  */
2729f6180773SSteven Rostedt 
2730f6180773SSteven Rostedt static int
273143dd61c9SSteven Rostedt ftrace_mod_callback(struct ftrace_hash *hash,
273243dd61c9SSteven Rostedt 		    char *func, char *cmd, char *param, int enable)
2733f6180773SSteven Rostedt {
2734f6180773SSteven Rostedt 	char *mod;
2735b448c4e3SSteven Rostedt 	int ret = -EINVAL;
2736f6180773SSteven Rostedt 
2737f6180773SSteven Rostedt 	/*
2738f6180773SSteven Rostedt 	 * cmd == 'mod' because we only registered this func
2739f6180773SSteven Rostedt 	 * for the 'mod' ftrace_func_command.
2740f6180773SSteven Rostedt 	 * But if you register one func with multiple commands,
2741f6180773SSteven Rostedt 	 * you can tell which command was used by the cmd
2742f6180773SSteven Rostedt 	 * parameter.
2743f6180773SSteven Rostedt 	 */
2744f6180773SSteven Rostedt 
2745f6180773SSteven Rostedt 	/* we must have a module name */
2746f6180773SSteven Rostedt 	if (!param)
2747b448c4e3SSteven Rostedt 		return ret;
2748f6180773SSteven Rostedt 
2749f6180773SSteven Rostedt 	mod = strsep(&param, ":");
2750f6180773SSteven Rostedt 	if (!strlen(mod))
2751b448c4e3SSteven Rostedt 		return ret;
2752f6180773SSteven Rostedt 
27531cf41dd7SSteven Rostedt 	ret = ftrace_match_module_records(hash, func, mod);
2754b448c4e3SSteven Rostedt 	if (!ret)
2755b448c4e3SSteven Rostedt 		ret = -EINVAL;
2756b448c4e3SSteven Rostedt 	if (ret < 0)
2757b448c4e3SSteven Rostedt 		return ret;
2758b448c4e3SSteven Rostedt 
2759f6180773SSteven Rostedt 	return 0;
2760f6180773SSteven Rostedt }
2761f6180773SSteven Rostedt 
2762f6180773SSteven Rostedt static struct ftrace_func_command ftrace_mod_cmd = {
2763f6180773SSteven Rostedt 	.name			= "mod",
2764f6180773SSteven Rostedt 	.func			= ftrace_mod_callback,
2765f6180773SSteven Rostedt };
2766f6180773SSteven Rostedt 
2767f6180773SSteven Rostedt static int __init ftrace_mod_cmd_init(void)
2768f6180773SSteven Rostedt {
2769f6180773SSteven Rostedt 	return register_ftrace_command(&ftrace_mod_cmd);
2770f6180773SSteven Rostedt }
2771f6180773SSteven Rostedt device_initcall(ftrace_mod_cmd_init);
2772f6180773SSteven Rostedt 
27732f5f6ad9SSteven Rostedt static void function_trace_probe_call(unsigned long ip, unsigned long parent_ip,
2774*a1e2e31dSSteven Rostedt 				      struct ftrace_ops *op, struct pt_regs *pt_regs)
277559df055fSSteven Rostedt {
2776b6887d79SSteven Rostedt 	struct ftrace_func_probe *entry;
277759df055fSSteven Rostedt 	struct hlist_head *hhd;
277859df055fSSteven Rostedt 	struct hlist_node *n;
277959df055fSSteven Rostedt 	unsigned long key;
278059df055fSSteven Rostedt 
278159df055fSSteven Rostedt 	key = hash_long(ip, FTRACE_HASH_BITS);
278259df055fSSteven Rostedt 
278359df055fSSteven Rostedt 	hhd = &ftrace_func_hash[key];
278459df055fSSteven Rostedt 
278559df055fSSteven Rostedt 	if (hlist_empty(hhd))
278659df055fSSteven Rostedt 		return;
278759df055fSSteven Rostedt 
278859df055fSSteven Rostedt 	/*
278959df055fSSteven Rostedt 	 * Disable preemption for these calls to prevent a RCU grace
279059df055fSSteven Rostedt 	 * period. This syncs the hash iteration and freeing of items
279159df055fSSteven Rostedt 	 * on the hash. rcu_read_lock is too dangerous here.
279259df055fSSteven Rostedt 	 */
27935168ae50SSteven Rostedt 	preempt_disable_notrace();
279459df055fSSteven Rostedt 	hlist_for_each_entry_rcu(entry, n, hhd, node) {
279559df055fSSteven Rostedt 		if (entry->ip == ip)
279659df055fSSteven Rostedt 			entry->ops->func(ip, parent_ip, &entry->data);
279759df055fSSteven Rostedt 	}
27985168ae50SSteven Rostedt 	preempt_enable_notrace();
279959df055fSSteven Rostedt }
280059df055fSSteven Rostedt 
2801b6887d79SSteven Rostedt static struct ftrace_ops trace_probe_ops __read_mostly =
280259df055fSSteven Rostedt {
2803b6887d79SSteven Rostedt 	.func		= function_trace_probe_call,
280459df055fSSteven Rostedt };
280559df055fSSteven Rostedt 
2806b6887d79SSteven Rostedt static int ftrace_probe_registered;
280759df055fSSteven Rostedt 
2808b6887d79SSteven Rostedt static void __enable_ftrace_function_probe(void)
280959df055fSSteven Rostedt {
2810b848914cSSteven Rostedt 	int ret;
281159df055fSSteven Rostedt 	int i;
281259df055fSSteven Rostedt 
2813b6887d79SSteven Rostedt 	if (ftrace_probe_registered)
281459df055fSSteven Rostedt 		return;
281559df055fSSteven Rostedt 
281659df055fSSteven Rostedt 	for (i = 0; i < FTRACE_FUNC_HASHSIZE; i++) {
281759df055fSSteven Rostedt 		struct hlist_head *hhd = &ftrace_func_hash[i];
281859df055fSSteven Rostedt 		if (hhd->first)
281959df055fSSteven Rostedt 			break;
282059df055fSSteven Rostedt 	}
282159df055fSSteven Rostedt 	/* Nothing registered? */
282259df055fSSteven Rostedt 	if (i == FTRACE_FUNC_HASHSIZE)
282359df055fSSteven Rostedt 		return;
282459df055fSSteven Rostedt 
2825b848914cSSteven Rostedt 	ret = __register_ftrace_function(&trace_probe_ops);
2826b848914cSSteven Rostedt 	if (!ret)
2827a1cd6173SSteven Rostedt 		ret = ftrace_startup(&trace_probe_ops, 0);
2828b848914cSSteven Rostedt 
2829b6887d79SSteven Rostedt 	ftrace_probe_registered = 1;
283059df055fSSteven Rostedt }
283159df055fSSteven Rostedt 
2832b6887d79SSteven Rostedt static void __disable_ftrace_function_probe(void)
283359df055fSSteven Rostedt {
2834b848914cSSteven Rostedt 	int ret;
283559df055fSSteven Rostedt 	int i;
283659df055fSSteven Rostedt 
2837b6887d79SSteven Rostedt 	if (!ftrace_probe_registered)
283859df055fSSteven Rostedt 		return;
283959df055fSSteven Rostedt 
284059df055fSSteven Rostedt 	for (i = 0; i < FTRACE_FUNC_HASHSIZE; i++) {
284159df055fSSteven Rostedt 		struct hlist_head *hhd = &ftrace_func_hash[i];
284259df055fSSteven Rostedt 		if (hhd->first)
284359df055fSSteven Rostedt 			return;
284459df055fSSteven Rostedt 	}
284559df055fSSteven Rostedt 
284659df055fSSteven Rostedt 	/* no more funcs left */
2847b848914cSSteven Rostedt 	ret = __unregister_ftrace_function(&trace_probe_ops);
2848b848914cSSteven Rostedt 	if (!ret)
2849b848914cSSteven Rostedt 		ftrace_shutdown(&trace_probe_ops, 0);
2850b848914cSSteven Rostedt 
2851b6887d79SSteven Rostedt 	ftrace_probe_registered = 0;
285259df055fSSteven Rostedt }
285359df055fSSteven Rostedt 
285459df055fSSteven Rostedt 
285559df055fSSteven Rostedt static void ftrace_free_entry_rcu(struct rcu_head *rhp)
285659df055fSSteven Rostedt {
2857b6887d79SSteven Rostedt 	struct ftrace_func_probe *entry =
2858b6887d79SSteven Rostedt 		container_of(rhp, struct ftrace_func_probe, rcu);
285959df055fSSteven Rostedt 
286059df055fSSteven Rostedt 	if (entry->ops->free)
286159df055fSSteven Rostedt 		entry->ops->free(&entry->data);
286259df055fSSteven Rostedt 	kfree(entry);
286359df055fSSteven Rostedt }
286459df055fSSteven Rostedt 
286559df055fSSteven Rostedt 
286659df055fSSteven Rostedt int
2867b6887d79SSteven Rostedt register_ftrace_function_probe(char *glob, struct ftrace_probe_ops *ops,
286859df055fSSteven Rostedt 			      void *data)
286959df055fSSteven Rostedt {
2870b6887d79SSteven Rostedt 	struct ftrace_func_probe *entry;
287159df055fSSteven Rostedt 	struct ftrace_page *pg;
287259df055fSSteven Rostedt 	struct dyn_ftrace *rec;
287359df055fSSteven Rostedt 	int type, len, not;
28746a24a244SSteven Rostedt 	unsigned long key;
287559df055fSSteven Rostedt 	int count = 0;
287659df055fSSteven Rostedt 	char *search;
287759df055fSSteven Rostedt 
28783f6fe06dSFrederic Weisbecker 	type = filter_parse_regex(glob, strlen(glob), &search, &not);
287959df055fSSteven Rostedt 	len = strlen(search);
288059df055fSSteven Rostedt 
2881b6887d79SSteven Rostedt 	/* we do not support '!' for function probes */
288259df055fSSteven Rostedt 	if (WARN_ON(not))
288359df055fSSteven Rostedt 		return -EINVAL;
288459df055fSSteven Rostedt 
288559df055fSSteven Rostedt 	mutex_lock(&ftrace_lock);
288659df055fSSteven Rostedt 
288745a4a237SSteven Rostedt 	if (unlikely(ftrace_disabled))
288845a4a237SSteven Rostedt 		goto out_unlock;
288945a4a237SSteven Rostedt 
289059df055fSSteven Rostedt 	do_for_each_ftrace_rec(pg, rec) {
289159df055fSSteven Rostedt 
2892b9df92d2SSteven Rostedt 		if (!ftrace_match_record(rec, NULL, search, len, type))
289359df055fSSteven Rostedt 			continue;
289459df055fSSteven Rostedt 
289559df055fSSteven Rostedt 		entry = kmalloc(sizeof(*entry), GFP_KERNEL);
289659df055fSSteven Rostedt 		if (!entry) {
2897b6887d79SSteven Rostedt 			/* If we did not process any, then return error */
289859df055fSSteven Rostedt 			if (!count)
289959df055fSSteven Rostedt 				count = -ENOMEM;
290059df055fSSteven Rostedt 			goto out_unlock;
290159df055fSSteven Rostedt 		}
290259df055fSSteven Rostedt 
290359df055fSSteven Rostedt 		count++;
290459df055fSSteven Rostedt 
290559df055fSSteven Rostedt 		entry->data = data;
290659df055fSSteven Rostedt 
290759df055fSSteven Rostedt 		/*
290859df055fSSteven Rostedt 		 * The caller might want to do something special
290959df055fSSteven Rostedt 		 * for each function we find. We call the callback
291059df055fSSteven Rostedt 		 * to give the caller an opportunity to do so.
291159df055fSSteven Rostedt 		 */
291259df055fSSteven Rostedt 		if (ops->callback) {
291359df055fSSteven Rostedt 			if (ops->callback(rec->ip, &entry->data) < 0) {
291459df055fSSteven Rostedt 				/* caller does not like this func */
291559df055fSSteven Rostedt 				kfree(entry);
291659df055fSSteven Rostedt 				continue;
291759df055fSSteven Rostedt 			}
291859df055fSSteven Rostedt 		}
291959df055fSSteven Rostedt 
292059df055fSSteven Rostedt 		entry->ops = ops;
292159df055fSSteven Rostedt 		entry->ip = rec->ip;
292259df055fSSteven Rostedt 
292359df055fSSteven Rostedt 		key = hash_long(entry->ip, FTRACE_HASH_BITS);
292459df055fSSteven Rostedt 		hlist_add_head_rcu(&entry->node, &ftrace_func_hash[key]);
292559df055fSSteven Rostedt 
292659df055fSSteven Rostedt 	} while_for_each_ftrace_rec();
2927b6887d79SSteven Rostedt 	__enable_ftrace_function_probe();
292859df055fSSteven Rostedt 
292959df055fSSteven Rostedt  out_unlock:
293059df055fSSteven Rostedt 	mutex_unlock(&ftrace_lock);
293159df055fSSteven Rostedt 
293259df055fSSteven Rostedt 	return count;
293359df055fSSteven Rostedt }
293459df055fSSteven Rostedt 
293559df055fSSteven Rostedt enum {
2936b6887d79SSteven Rostedt 	PROBE_TEST_FUNC		= 1,
2937b6887d79SSteven Rostedt 	PROBE_TEST_DATA		= 2
293859df055fSSteven Rostedt };
293959df055fSSteven Rostedt 
294059df055fSSteven Rostedt static void
2941b6887d79SSteven Rostedt __unregister_ftrace_function_probe(char *glob, struct ftrace_probe_ops *ops,
294259df055fSSteven Rostedt 				  void *data, int flags)
294359df055fSSteven Rostedt {
2944b6887d79SSteven Rostedt 	struct ftrace_func_probe *entry;
294559df055fSSteven Rostedt 	struct hlist_node *n, *tmp;
294659df055fSSteven Rostedt 	char str[KSYM_SYMBOL_LEN];
294759df055fSSteven Rostedt 	int type = MATCH_FULL;
294859df055fSSteven Rostedt 	int i, len = 0;
294959df055fSSteven Rostedt 	char *search;
295059df055fSSteven Rostedt 
2951b36461daSAtsushi Tsuji 	if (glob && (strcmp(glob, "*") == 0 || !strlen(glob)))
295259df055fSSteven Rostedt 		glob = NULL;
2953b36461daSAtsushi Tsuji 	else if (glob) {
295459df055fSSteven Rostedt 		int not;
295559df055fSSteven Rostedt 
29563f6fe06dSFrederic Weisbecker 		type = filter_parse_regex(glob, strlen(glob), &search, &not);
295759df055fSSteven Rostedt 		len = strlen(search);
295859df055fSSteven Rostedt 
2959b6887d79SSteven Rostedt 		/* we do not support '!' for function probes */
296059df055fSSteven Rostedt 		if (WARN_ON(not))
296159df055fSSteven Rostedt 			return;
296259df055fSSteven Rostedt 	}
296359df055fSSteven Rostedt 
296459df055fSSteven Rostedt 	mutex_lock(&ftrace_lock);
296559df055fSSteven Rostedt 	for (i = 0; i < FTRACE_FUNC_HASHSIZE; i++) {
296659df055fSSteven Rostedt 		struct hlist_head *hhd = &ftrace_func_hash[i];
296759df055fSSteven Rostedt 
296859df055fSSteven Rostedt 		hlist_for_each_entry_safe(entry, n, tmp, hhd, node) {
296959df055fSSteven Rostedt 
297059df055fSSteven Rostedt 			/* break up if statements for readability */
2971b6887d79SSteven Rostedt 			if ((flags & PROBE_TEST_FUNC) && entry->ops != ops)
297259df055fSSteven Rostedt 				continue;
297359df055fSSteven Rostedt 
2974b6887d79SSteven Rostedt 			if ((flags & PROBE_TEST_DATA) && entry->data != data)
297559df055fSSteven Rostedt 				continue;
297659df055fSSteven Rostedt 
297759df055fSSteven Rostedt 			/* do this last, since it is the most expensive */
297859df055fSSteven Rostedt 			if (glob) {
297959df055fSSteven Rostedt 				kallsyms_lookup(entry->ip, NULL, NULL,
298059df055fSSteven Rostedt 						NULL, str);
298159df055fSSteven Rostedt 				if (!ftrace_match(str, glob, len, type))
298259df055fSSteven Rostedt 					continue;
298359df055fSSteven Rostedt 			}
298459df055fSSteven Rostedt 
298559df055fSSteven Rostedt 			hlist_del(&entry->node);
298659df055fSSteven Rostedt 			call_rcu(&entry->rcu, ftrace_free_entry_rcu);
298759df055fSSteven Rostedt 		}
298859df055fSSteven Rostedt 	}
2989b6887d79SSteven Rostedt 	__disable_ftrace_function_probe();
299059df055fSSteven Rostedt 	mutex_unlock(&ftrace_lock);
299159df055fSSteven Rostedt }
299259df055fSSteven Rostedt 
299359df055fSSteven Rostedt void
2994b6887d79SSteven Rostedt unregister_ftrace_function_probe(char *glob, struct ftrace_probe_ops *ops,
299559df055fSSteven Rostedt 				void *data)
299659df055fSSteven Rostedt {
2997b6887d79SSteven Rostedt 	__unregister_ftrace_function_probe(glob, ops, data,
2998b6887d79SSteven Rostedt 					  PROBE_TEST_FUNC | PROBE_TEST_DATA);
299959df055fSSteven Rostedt }
300059df055fSSteven Rostedt 
300159df055fSSteven Rostedt void
3002b6887d79SSteven Rostedt unregister_ftrace_function_probe_func(char *glob, struct ftrace_probe_ops *ops)
300359df055fSSteven Rostedt {
3004b6887d79SSteven Rostedt 	__unregister_ftrace_function_probe(glob, ops, NULL, PROBE_TEST_FUNC);
300559df055fSSteven Rostedt }
300659df055fSSteven Rostedt 
3007b6887d79SSteven Rostedt void unregister_ftrace_function_probe_all(char *glob)
300859df055fSSteven Rostedt {
3009b6887d79SSteven Rostedt 	__unregister_ftrace_function_probe(glob, NULL, NULL, 0);
301059df055fSSteven Rostedt }
301159df055fSSteven Rostedt 
3012f6180773SSteven Rostedt static LIST_HEAD(ftrace_commands);
3013f6180773SSteven Rostedt static DEFINE_MUTEX(ftrace_cmd_mutex);
3014f6180773SSteven Rostedt 
3015f6180773SSteven Rostedt int register_ftrace_command(struct ftrace_func_command *cmd)
3016f6180773SSteven Rostedt {
3017f6180773SSteven Rostedt 	struct ftrace_func_command *p;
3018f6180773SSteven Rostedt 	int ret = 0;
3019f6180773SSteven Rostedt 
3020f6180773SSteven Rostedt 	mutex_lock(&ftrace_cmd_mutex);
3021f6180773SSteven Rostedt 	list_for_each_entry(p, &ftrace_commands, list) {
3022f6180773SSteven Rostedt 		if (strcmp(cmd->name, p->name) == 0) {
3023f6180773SSteven Rostedt 			ret = -EBUSY;
3024f6180773SSteven Rostedt 			goto out_unlock;
3025f6180773SSteven Rostedt 		}
3026f6180773SSteven Rostedt 	}
3027f6180773SSteven Rostedt 	list_add(&cmd->list, &ftrace_commands);
3028f6180773SSteven Rostedt  out_unlock:
3029f6180773SSteven Rostedt 	mutex_unlock(&ftrace_cmd_mutex);
3030f6180773SSteven Rostedt 
3031f6180773SSteven Rostedt 	return ret;
3032f6180773SSteven Rostedt }
3033f6180773SSteven Rostedt 
3034f6180773SSteven Rostedt int unregister_ftrace_command(struct ftrace_func_command *cmd)
3035f6180773SSteven Rostedt {
3036f6180773SSteven Rostedt 	struct ftrace_func_command *p, *n;
3037f6180773SSteven Rostedt 	int ret = -ENODEV;
3038f6180773SSteven Rostedt 
3039f6180773SSteven Rostedt 	mutex_lock(&ftrace_cmd_mutex);
3040f6180773SSteven Rostedt 	list_for_each_entry_safe(p, n, &ftrace_commands, list) {
3041f6180773SSteven Rostedt 		if (strcmp(cmd->name, p->name) == 0) {
3042f6180773SSteven Rostedt 			ret = 0;
3043f6180773SSteven Rostedt 			list_del_init(&p->list);
3044f6180773SSteven Rostedt 			goto out_unlock;
3045f6180773SSteven Rostedt 		}
3046f6180773SSteven Rostedt 	}
3047f6180773SSteven Rostedt  out_unlock:
3048f6180773SSteven Rostedt 	mutex_unlock(&ftrace_cmd_mutex);
3049f6180773SSteven Rostedt 
3050f6180773SSteven Rostedt 	return ret;
3051f6180773SSteven Rostedt }
3052f6180773SSteven Rostedt 
305333dc9b12SSteven Rostedt static int ftrace_process_regex(struct ftrace_hash *hash,
305433dc9b12SSteven Rostedt 				char *buff, int len, int enable)
305564e7c440SSteven Rostedt {
3056f6180773SSteven Rostedt 	char *func, *command, *next = buff;
30576a24a244SSteven Rostedt 	struct ftrace_func_command *p;
30580aff1c0cSGuoWen Li 	int ret = -EINVAL;
305964e7c440SSteven Rostedt 
306064e7c440SSteven Rostedt 	func = strsep(&next, ":");
306164e7c440SSteven Rostedt 
306264e7c440SSteven Rostedt 	if (!next) {
30631cf41dd7SSteven Rostedt 		ret = ftrace_match_records(hash, func, len);
3064b448c4e3SSteven Rostedt 		if (!ret)
3065b448c4e3SSteven Rostedt 			ret = -EINVAL;
3066b448c4e3SSteven Rostedt 		if (ret < 0)
3067311d16daSLi Zefan 			return ret;
3068b448c4e3SSteven Rostedt 		return 0;
306964e7c440SSteven Rostedt 	}
307064e7c440SSteven Rostedt 
3071f6180773SSteven Rostedt 	/* command found */
307264e7c440SSteven Rostedt 
307364e7c440SSteven Rostedt 	command = strsep(&next, ":");
307464e7c440SSteven Rostedt 
3075f6180773SSteven Rostedt 	mutex_lock(&ftrace_cmd_mutex);
3076f6180773SSteven Rostedt 	list_for_each_entry(p, &ftrace_commands, list) {
3077f6180773SSteven Rostedt 		if (strcmp(p->name, command) == 0) {
307843dd61c9SSteven Rostedt 			ret = p->func(hash, func, command, next, enable);
3079f6180773SSteven Rostedt 			goto out_unlock;
308064e7c440SSteven Rostedt 		}
3081f6180773SSteven Rostedt 	}
3082f6180773SSteven Rostedt  out_unlock:
3083f6180773SSteven Rostedt 	mutex_unlock(&ftrace_cmd_mutex);
308464e7c440SSteven Rostedt 
3085f6180773SSteven Rostedt 	return ret;
308664e7c440SSteven Rostedt }
308764e7c440SSteven Rostedt 
3088e309b41dSIngo Molnar static ssize_t
308941c52c0dSSteven Rostedt ftrace_regex_write(struct file *file, const char __user *ubuf,
309041c52c0dSSteven Rostedt 		   size_t cnt, loff_t *ppos, int enable)
30915072c59fSSteven Rostedt {
30925072c59fSSteven Rostedt 	struct ftrace_iterator *iter;
3093689fd8b6S[email protected] 	struct trace_parser *parser;
3094689fd8b6S[email protected] 	ssize_t ret, read;
30955072c59fSSteven Rostedt 
30964ba7978eSLi Zefan 	if (!cnt)
30975072c59fSSteven Rostedt 		return 0;
30985072c59fSSteven Rostedt 
309941c52c0dSSteven Rostedt 	mutex_lock(&ftrace_regex_lock);
31005072c59fSSteven Rostedt 
310145a4a237SSteven Rostedt 	ret = -ENODEV;
310245a4a237SSteven Rostedt 	if (unlikely(ftrace_disabled))
310345a4a237SSteven Rostedt 		goto out_unlock;
310445a4a237SSteven Rostedt 
31055072c59fSSteven Rostedt 	if (file->f_mode & FMODE_READ) {
31065072c59fSSteven Rostedt 		struct seq_file *m = file->private_data;
31075072c59fSSteven Rostedt 		iter = m->private;
31085072c59fSSteven Rostedt 	} else
31095072c59fSSteven Rostedt 		iter = file->private_data;
31105072c59fSSteven Rostedt 
3111689fd8b6S[email protected] 	parser = &iter->parser;
3112689fd8b6S[email protected] 	read = trace_get_user(parser, ubuf, cnt, ppos);
31135072c59fSSteven Rostedt 
31144ba7978eSLi Zefan 	if (read >= 0 && trace_parser_loaded(parser) &&
3115689fd8b6S[email protected] 	    !trace_parser_cont(parser)) {
311633dc9b12SSteven Rostedt 		ret = ftrace_process_regex(iter->hash, parser->buffer,
3117689fd8b6S[email protected] 					   parser->idx, enable);
3118313254a9SLi Zefan 		trace_parser_clear(parser);
31195072c59fSSteven Rostedt 		if (ret)
3120ed146b25SLi Zefan 			goto out_unlock;
31215072c59fSSteven Rostedt 	}
31225072c59fSSteven Rostedt 
31235072c59fSSteven Rostedt 	ret = read;
3124ed146b25SLi Zefan out_unlock:
312541c52c0dSSteven Rostedt 	mutex_unlock(&ftrace_regex_lock);
3126ed146b25SLi Zefan 
31275072c59fSSteven Rostedt 	return ret;
31285072c59fSSteven Rostedt }
31295072c59fSSteven Rostedt 
3130fc13cb0cSSteven Rostedt ssize_t
313141c52c0dSSteven Rostedt ftrace_filter_write(struct file *file, const char __user *ubuf,
313241c52c0dSSteven Rostedt 		    size_t cnt, loff_t *ppos)
313341c52c0dSSteven Rostedt {
313441c52c0dSSteven Rostedt 	return ftrace_regex_write(file, ubuf, cnt, ppos, 1);
313541c52c0dSSteven Rostedt }
313641c52c0dSSteven Rostedt 
3137fc13cb0cSSteven Rostedt ssize_t
313841c52c0dSSteven Rostedt ftrace_notrace_write(struct file *file, const char __user *ubuf,
313941c52c0dSSteven Rostedt 		     size_t cnt, loff_t *ppos)
314041c52c0dSSteven Rostedt {
314141c52c0dSSteven Rostedt 	return ftrace_regex_write(file, ubuf, cnt, ppos, 0);
314241c52c0dSSteven Rostedt }
314341c52c0dSSteven Rostedt 
314433dc9b12SSteven Rostedt static int
3145f45948e8SSteven Rostedt ftrace_set_regex(struct ftrace_ops *ops, unsigned char *buf, int len,
3146f45948e8SSteven Rostedt 		 int reset, int enable)
314741c52c0dSSteven Rostedt {
314833dc9b12SSteven Rostedt 	struct ftrace_hash **orig_hash;
3149f45948e8SSteven Rostedt 	struct ftrace_hash *hash;
315033dc9b12SSteven Rostedt 	int ret;
3151f45948e8SSteven Rostedt 
3152936e074bSSteven Rostedt 	/* All global ops uses the global ops filters */
3153936e074bSSteven Rostedt 	if (ops->flags & FTRACE_OPS_FL_GLOBAL)
3154936e074bSSteven Rostedt 		ops = &global_ops;
3155936e074bSSteven Rostedt 
315641c52c0dSSteven Rostedt 	if (unlikely(ftrace_disabled))
315733dc9b12SSteven Rostedt 		return -ENODEV;
315841c52c0dSSteven Rostedt 
3159f45948e8SSteven Rostedt 	if (enable)
316033dc9b12SSteven Rostedt 		orig_hash = &ops->filter_hash;
3161f45948e8SSteven Rostedt 	else
316233dc9b12SSteven Rostedt 		orig_hash = &ops->notrace_hash;
316333dc9b12SSteven Rostedt 
316433dc9b12SSteven Rostedt 	hash = alloc_and_copy_ftrace_hash(FTRACE_HASH_DEFAULT_BITS, *orig_hash);
316533dc9b12SSteven Rostedt 	if (!hash)
316633dc9b12SSteven Rostedt 		return -ENOMEM;
3167f45948e8SSteven Rostedt 
316841c52c0dSSteven Rostedt 	mutex_lock(&ftrace_regex_lock);
316941c52c0dSSteven Rostedt 	if (reset)
31701cf41dd7SSteven Rostedt 		ftrace_filter_reset(hash);
3171ac483c44SJiri Olsa 	if (buf && !ftrace_match_records(hash, buf, len)) {
3172ac483c44SJiri Olsa 		ret = -EINVAL;
3173ac483c44SJiri Olsa 		goto out_regex_unlock;
3174ac483c44SJiri Olsa 	}
317533dc9b12SSteven Rostedt 
317633dc9b12SSteven Rostedt 	mutex_lock(&ftrace_lock);
317741fb61c2SSteven Rostedt 	ret = ftrace_hash_move(ops, enable, orig_hash, hash);
3178072126f4SSteven Rostedt 	if (!ret && ops->flags & FTRACE_OPS_FL_ENABLED
3179072126f4SSteven Rostedt 	    && ftrace_enabled)
318030fb6aa7SJiri Olsa 		ftrace_run_update_code(FTRACE_UPDATE_CALLS);
3181072126f4SSteven Rostedt 
318233dc9b12SSteven Rostedt 	mutex_unlock(&ftrace_lock);
318333dc9b12SSteven Rostedt 
3184ac483c44SJiri Olsa  out_regex_unlock:
318541c52c0dSSteven Rostedt 	mutex_unlock(&ftrace_regex_lock);
318633dc9b12SSteven Rostedt 
318733dc9b12SSteven Rostedt 	free_ftrace_hash(hash);
318833dc9b12SSteven Rostedt 	return ret;
318941c52c0dSSteven Rostedt }
319041c52c0dSSteven Rostedt 
319177a2b37dSSteven Rostedt /**
319277a2b37dSSteven Rostedt  * ftrace_set_filter - set a function to filter on in ftrace
3193936e074bSSteven Rostedt  * @ops - the ops to set the filter with
319477a2b37dSSteven Rostedt  * @buf - the string that holds the function filter text.
319577a2b37dSSteven Rostedt  * @len - the length of the string.
319677a2b37dSSteven Rostedt  * @reset - non zero to reset all filters before applying this filter.
319777a2b37dSSteven Rostedt  *
319877a2b37dSSteven Rostedt  * Filters denote which functions should be enabled when tracing is enabled.
319977a2b37dSSteven Rostedt  * If @buf is NULL and reset is set, all functions will be enabled for tracing.
320077a2b37dSSteven Rostedt  */
3201ac483c44SJiri Olsa int ftrace_set_filter(struct ftrace_ops *ops, unsigned char *buf,
3202936e074bSSteven Rostedt 		       int len, int reset)
320377a2b37dSSteven Rostedt {
3204ac483c44SJiri Olsa 	return ftrace_set_regex(ops, buf, len, reset, 1);
320541c52c0dSSteven Rostedt }
3206936e074bSSteven Rostedt EXPORT_SYMBOL_GPL(ftrace_set_filter);
32074eebcc81SSteven Rostedt 
320841c52c0dSSteven Rostedt /**
320941c52c0dSSteven Rostedt  * ftrace_set_notrace - set a function to not trace in ftrace
3210936e074bSSteven Rostedt  * @ops - the ops to set the notrace filter with
321141c52c0dSSteven Rostedt  * @buf - the string that holds the function notrace text.
321241c52c0dSSteven Rostedt  * @len - the length of the string.
321341c52c0dSSteven Rostedt  * @reset - non zero to reset all filters before applying this filter.
321441c52c0dSSteven Rostedt  *
321541c52c0dSSteven Rostedt  * Notrace Filters denote which functions should not be enabled when tracing
321641c52c0dSSteven Rostedt  * is enabled. If @buf is NULL and reset is set, all functions will be enabled
321741c52c0dSSteven Rostedt  * for tracing.
321841c52c0dSSteven Rostedt  */
3219ac483c44SJiri Olsa int ftrace_set_notrace(struct ftrace_ops *ops, unsigned char *buf,
3220936e074bSSteven Rostedt 			int len, int reset)
3221936e074bSSteven Rostedt {
3222ac483c44SJiri Olsa 	return ftrace_set_regex(ops, buf, len, reset, 0);
3223936e074bSSteven Rostedt }
3224936e074bSSteven Rostedt EXPORT_SYMBOL_GPL(ftrace_set_notrace);
3225936e074bSSteven Rostedt /**
3226936e074bSSteven Rostedt  * ftrace_set_filter - set a function to filter on in ftrace
3227936e074bSSteven Rostedt  * @ops - the ops to set the filter with
3228936e074bSSteven Rostedt  * @buf - the string that holds the function filter text.
3229936e074bSSteven Rostedt  * @len - the length of the string.
3230936e074bSSteven Rostedt  * @reset - non zero to reset all filters before applying this filter.
3231936e074bSSteven Rostedt  *
3232936e074bSSteven Rostedt  * Filters denote which functions should be enabled when tracing is enabled.
3233936e074bSSteven Rostedt  * If @buf is NULL and reset is set, all functions will be enabled for tracing.
3234936e074bSSteven Rostedt  */
3235936e074bSSteven Rostedt void ftrace_set_global_filter(unsigned char *buf, int len, int reset)
3236936e074bSSteven Rostedt {
3237936e074bSSteven Rostedt 	ftrace_set_regex(&global_ops, buf, len, reset, 1);
3238936e074bSSteven Rostedt }
3239936e074bSSteven Rostedt EXPORT_SYMBOL_GPL(ftrace_set_global_filter);
3240936e074bSSteven Rostedt 
3241936e074bSSteven Rostedt /**
3242936e074bSSteven Rostedt  * ftrace_set_notrace - set a function to not trace in ftrace
3243936e074bSSteven Rostedt  * @ops - the ops to set the notrace filter with
3244936e074bSSteven Rostedt  * @buf - the string that holds the function notrace text.
3245936e074bSSteven Rostedt  * @len - the length of the string.
3246936e074bSSteven Rostedt  * @reset - non zero to reset all filters before applying this filter.
3247936e074bSSteven Rostedt  *
3248936e074bSSteven Rostedt  * Notrace Filters denote which functions should not be enabled when tracing
3249936e074bSSteven Rostedt  * is enabled. If @buf is NULL and reset is set, all functions will be enabled
3250936e074bSSteven Rostedt  * for tracing.
3251936e074bSSteven Rostedt  */
3252936e074bSSteven Rostedt void ftrace_set_global_notrace(unsigned char *buf, int len, int reset)
325341c52c0dSSteven Rostedt {
3254f45948e8SSteven Rostedt 	ftrace_set_regex(&global_ops, buf, len, reset, 0);
325577a2b37dSSteven Rostedt }
3256936e074bSSteven Rostedt EXPORT_SYMBOL_GPL(ftrace_set_global_notrace);
325777a2b37dSSteven Rostedt 
32582af15d6aSSteven Rostedt /*
32592af15d6aSSteven Rostedt  * command line interface to allow users to set filters on boot up.
32602af15d6aSSteven Rostedt  */
32612af15d6aSSteven Rostedt #define FTRACE_FILTER_SIZE		COMMAND_LINE_SIZE
32622af15d6aSSteven Rostedt static char ftrace_notrace_buf[FTRACE_FILTER_SIZE] __initdata;
32632af15d6aSSteven Rostedt static char ftrace_filter_buf[FTRACE_FILTER_SIZE] __initdata;
32642af15d6aSSteven Rostedt 
32652af15d6aSSteven Rostedt static int __init set_ftrace_notrace(char *str)
32662af15d6aSSteven Rostedt {
32672af15d6aSSteven Rostedt 	strncpy(ftrace_notrace_buf, str, FTRACE_FILTER_SIZE);
32682af15d6aSSteven Rostedt 	return 1;
32692af15d6aSSteven Rostedt }
32702af15d6aSSteven Rostedt __setup("ftrace_notrace=", set_ftrace_notrace);
32712af15d6aSSteven Rostedt 
32722af15d6aSSteven Rostedt static int __init set_ftrace_filter(char *str)
32732af15d6aSSteven Rostedt {
32742af15d6aSSteven Rostedt 	strncpy(ftrace_filter_buf, str, FTRACE_FILTER_SIZE);
32752af15d6aSSteven Rostedt 	return 1;
32762af15d6aSSteven Rostedt }
32772af15d6aSSteven Rostedt __setup("ftrace_filter=", set_ftrace_filter);
32782af15d6aSSteven Rostedt 
3279369bc18fSStefan Assmann #ifdef CONFIG_FUNCTION_GRAPH_TRACER
3280f6060f46SLai Jiangshan static char ftrace_graph_buf[FTRACE_FILTER_SIZE] __initdata;
3281801c29fdSSteven Rostedt static int ftrace_set_func(unsigned long *array, int *idx, char *buffer);
3282801c29fdSSteven Rostedt 
3283369bc18fSStefan Assmann static int __init set_graph_function(char *str)
3284369bc18fSStefan Assmann {
328506f43d66SFrederic Weisbecker 	strlcpy(ftrace_graph_buf, str, FTRACE_FILTER_SIZE);
3286369bc18fSStefan Assmann 	return 1;
3287369bc18fSStefan Assmann }
3288369bc18fSStefan Assmann __setup("ftrace_graph_filter=", set_graph_function);
3289369bc18fSStefan Assmann 
3290369bc18fSStefan Assmann static void __init set_ftrace_early_graph(char *buf)
3291369bc18fSStefan Assmann {
3292369bc18fSStefan Assmann 	int ret;
3293369bc18fSStefan Assmann 	char *func;
3294369bc18fSStefan Assmann 
3295369bc18fSStefan Assmann 	while (buf) {
3296369bc18fSStefan Assmann 		func = strsep(&buf, ",");
3297369bc18fSStefan Assmann 		/* we allow only one expression at a time */
3298369bc18fSStefan Assmann 		ret = ftrace_set_func(ftrace_graph_funcs, &ftrace_graph_count,
3299369bc18fSStefan Assmann 				      func);
3300369bc18fSStefan Assmann 		if (ret)
3301369bc18fSStefan Assmann 			printk(KERN_DEBUG "ftrace: function %s not "
3302369bc18fSStefan Assmann 					  "traceable\n", func);
3303369bc18fSStefan Assmann 	}
3304369bc18fSStefan Assmann }
3305369bc18fSStefan Assmann #endif /* CONFIG_FUNCTION_GRAPH_TRACER */
3306369bc18fSStefan Assmann 
33072a85a37fSSteven Rostedt void __init
33082a85a37fSSteven Rostedt ftrace_set_early_filter(struct ftrace_ops *ops, char *buf, int enable)
33092af15d6aSSteven Rostedt {
33102af15d6aSSteven Rostedt 	char *func;
33112af15d6aSSteven Rostedt 
33122af15d6aSSteven Rostedt 	while (buf) {
33132af15d6aSSteven Rostedt 		func = strsep(&buf, ",");
3314f45948e8SSteven Rostedt 		ftrace_set_regex(ops, func, strlen(func), 0, enable);
33152af15d6aSSteven Rostedt 	}
33162af15d6aSSteven Rostedt }
33172af15d6aSSteven Rostedt 
33182af15d6aSSteven Rostedt static void __init set_ftrace_early_filters(void)
33192af15d6aSSteven Rostedt {
33202af15d6aSSteven Rostedt 	if (ftrace_filter_buf[0])
33212a85a37fSSteven Rostedt 		ftrace_set_early_filter(&global_ops, ftrace_filter_buf, 1);
33222af15d6aSSteven Rostedt 	if (ftrace_notrace_buf[0])
33232a85a37fSSteven Rostedt 		ftrace_set_early_filter(&global_ops, ftrace_notrace_buf, 0);
3324369bc18fSStefan Assmann #ifdef CONFIG_FUNCTION_GRAPH_TRACER
3325369bc18fSStefan Assmann 	if (ftrace_graph_buf[0])
3326369bc18fSStefan Assmann 		set_ftrace_early_graph(ftrace_graph_buf);
3327369bc18fSStefan Assmann #endif /* CONFIG_FUNCTION_GRAPH_TRACER */
33282af15d6aSSteven Rostedt }
33292af15d6aSSteven Rostedt 
3330fc13cb0cSSteven Rostedt int ftrace_regex_release(struct inode *inode, struct file *file)
33315072c59fSSteven Rostedt {
33325072c59fSSteven Rostedt 	struct seq_file *m = (struct seq_file *)file->private_data;
33335072c59fSSteven Rostedt 	struct ftrace_iterator *iter;
333433dc9b12SSteven Rostedt 	struct ftrace_hash **orig_hash;
3335689fd8b6S[email protected] 	struct trace_parser *parser;
3336ed926f9bSSteven Rostedt 	int filter_hash;
333733dc9b12SSteven Rostedt 	int ret;
33385072c59fSSteven Rostedt 
333941c52c0dSSteven Rostedt 	mutex_lock(&ftrace_regex_lock);
33405072c59fSSteven Rostedt 	if (file->f_mode & FMODE_READ) {
33415072c59fSSteven Rostedt 		iter = m->private;
33425072c59fSSteven Rostedt 
33435072c59fSSteven Rostedt 		seq_release(inode, file);
33445072c59fSSteven Rostedt 	} else
33455072c59fSSteven Rostedt 		iter = file->private_data;
33465072c59fSSteven Rostedt 
3347689fd8b6S[email protected] 	parser = &iter->parser;
3348689fd8b6S[email protected] 	if (trace_parser_loaded(parser)) {
3349689fd8b6S[email protected] 		parser->buffer[parser->idx] = 0;
33501cf41dd7SSteven Rostedt 		ftrace_match_records(iter->hash, parser->buffer, parser->idx);
33515072c59fSSteven Rostedt 	}
33525072c59fSSteven Rostedt 
3353058e297dSSteven Rostedt 	trace_parser_put(parser);
3354058e297dSSteven Rostedt 
3355058e297dSSteven Rostedt 	if (file->f_mode & FMODE_WRITE) {
3356ed926f9bSSteven Rostedt 		filter_hash = !!(iter->flags & FTRACE_ITER_FILTER);
3357ed926f9bSSteven Rostedt 
3358ed926f9bSSteven Rostedt 		if (filter_hash)
335933dc9b12SSteven Rostedt 			orig_hash = &iter->ops->filter_hash;
3360ed926f9bSSteven Rostedt 		else
3361ed926f9bSSteven Rostedt 			orig_hash = &iter->ops->notrace_hash;
336233dc9b12SSteven Rostedt 
3363e6ea44e9SSteven Rostedt 		mutex_lock(&ftrace_lock);
336441fb61c2SSteven Rostedt 		ret = ftrace_hash_move(iter->ops, filter_hash,
336541fb61c2SSteven Rostedt 				       orig_hash, iter->hash);
336641fb61c2SSteven Rostedt 		if (!ret && (iter->ops->flags & FTRACE_OPS_FL_ENABLED)
3367ed926f9bSSteven Rostedt 		    && ftrace_enabled)
336830fb6aa7SJiri Olsa 			ftrace_run_update_code(FTRACE_UPDATE_CALLS);
336941fb61c2SSteven Rostedt 
3370e6ea44e9SSteven Rostedt 		mutex_unlock(&ftrace_lock);
3371058e297dSSteven Rostedt 	}
337233dc9b12SSteven Rostedt 	free_ftrace_hash(iter->hash);
337333dc9b12SSteven Rostedt 	kfree(iter);
3374689fd8b6S[email protected] 
337541c52c0dSSteven Rostedt 	mutex_unlock(&ftrace_regex_lock);
33765072c59fSSteven Rostedt 	return 0;
33775072c59fSSteven Rostedt }
33785072c59fSSteven Rostedt 
33795e2336a0SSteven Rostedt static const struct file_operations ftrace_avail_fops = {
33805072c59fSSteven Rostedt 	.open = ftrace_avail_open,
33815072c59fSSteven Rostedt 	.read = seq_read,
33825072c59fSSteven Rostedt 	.llseek = seq_lseek,
33833be04b47SLi Zefan 	.release = seq_release_private,
33845072c59fSSteven Rostedt };
33855072c59fSSteven Rostedt 
3386647bcd03SSteven Rostedt static const struct file_operations ftrace_enabled_fops = {
3387647bcd03SSteven Rostedt 	.open = ftrace_enabled_open,
3388647bcd03SSteven Rostedt 	.read = seq_read,
3389647bcd03SSteven Rostedt 	.llseek = seq_lseek,
3390647bcd03SSteven Rostedt 	.release = seq_release_private,
3391647bcd03SSteven Rostedt };
3392647bcd03SSteven Rostedt 
33935e2336a0SSteven Rostedt static const struct file_operations ftrace_filter_fops = {
33945072c59fSSteven Rostedt 	.open = ftrace_filter_open,
3395850a80cfSLai Jiangshan 	.read = seq_read,
33965072c59fSSteven Rostedt 	.write = ftrace_filter_write,
339798c4fd04SSteven Rostedt 	.llseek = ftrace_regex_lseek,
33981cf41dd7SSteven Rostedt 	.release = ftrace_regex_release,
33995072c59fSSteven Rostedt };
34005072c59fSSteven Rostedt 
34015e2336a0SSteven Rostedt static const struct file_operations ftrace_notrace_fops = {
340241c52c0dSSteven Rostedt 	.open = ftrace_notrace_open,
3403850a80cfSLai Jiangshan 	.read = seq_read,
340441c52c0dSSteven Rostedt 	.write = ftrace_notrace_write,
340541c52c0dSSteven Rostedt 	.llseek = ftrace_regex_lseek,
34061cf41dd7SSteven Rostedt 	.release = ftrace_regex_release,
340741c52c0dSSteven Rostedt };
340841c52c0dSSteven Rostedt 
3409ea4e2bc4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
3410ea4e2bc4SSteven Rostedt 
3411ea4e2bc4SSteven Rostedt static DEFINE_MUTEX(graph_lock);
3412ea4e2bc4SSteven Rostedt 
3413ea4e2bc4SSteven Rostedt int ftrace_graph_count;
3414c7c6b1feSLi Zefan int ftrace_graph_filter_enabled;
3415ea4e2bc4SSteven Rostedt unsigned long ftrace_graph_funcs[FTRACE_GRAPH_MAX_FUNCS] __read_mostly;
3416ea4e2bc4SSteven Rostedt 
3417ea4e2bc4SSteven Rostedt static void *
341885951842SLi Zefan __g_next(struct seq_file *m, loff_t *pos)
3419ea4e2bc4SSteven Rostedt {
342085951842SLi Zefan 	if (*pos >= ftrace_graph_count)
3421ea4e2bc4SSteven Rostedt 		return NULL;
3422a4ec5e0cSLi Zefan 	return &ftrace_graph_funcs[*pos];
342385951842SLi Zefan }
3424ea4e2bc4SSteven Rostedt 
342585951842SLi Zefan static void *
342685951842SLi Zefan g_next(struct seq_file *m, void *v, loff_t *pos)
342785951842SLi Zefan {
342885951842SLi Zefan 	(*pos)++;
342985951842SLi Zefan 	return __g_next(m, pos);
3430ea4e2bc4SSteven Rostedt }
3431ea4e2bc4SSteven Rostedt 
3432ea4e2bc4SSteven Rostedt static void *g_start(struct seq_file *m, loff_t *pos)
3433ea4e2bc4SSteven Rostedt {
3434ea4e2bc4SSteven Rostedt 	mutex_lock(&graph_lock);
3435ea4e2bc4SSteven Rostedt 
3436f9349a8fSFrederic Weisbecker 	/* Nothing, tell g_show to print all functions are enabled */
3437c7c6b1feSLi Zefan 	if (!ftrace_graph_filter_enabled && !*pos)
3438f9349a8fSFrederic Weisbecker 		return (void *)1;
3439f9349a8fSFrederic Weisbecker 
344085951842SLi Zefan 	return __g_next(m, pos);
3441ea4e2bc4SSteven Rostedt }
3442ea4e2bc4SSteven Rostedt 
3443ea4e2bc4SSteven Rostedt static void g_stop(struct seq_file *m, void *p)
3444ea4e2bc4SSteven Rostedt {
3445ea4e2bc4SSteven Rostedt 	mutex_unlock(&graph_lock);
3446ea4e2bc4SSteven Rostedt }
3447ea4e2bc4SSteven Rostedt 
3448ea4e2bc4SSteven Rostedt static int g_show(struct seq_file *m, void *v)
3449ea4e2bc4SSteven Rostedt {
3450ea4e2bc4SSteven Rostedt 	unsigned long *ptr = v;
3451ea4e2bc4SSteven Rostedt 
3452ea4e2bc4SSteven Rostedt 	if (!ptr)
3453ea4e2bc4SSteven Rostedt 		return 0;
3454ea4e2bc4SSteven Rostedt 
3455f9349a8fSFrederic Weisbecker 	if (ptr == (unsigned long *)1) {
3456f9349a8fSFrederic Weisbecker 		seq_printf(m, "#### all functions enabled ####\n");
3457f9349a8fSFrederic Weisbecker 		return 0;
3458f9349a8fSFrederic Weisbecker 	}
3459f9349a8fSFrederic Weisbecker 
3460b375a11aSSteven Rostedt 	seq_printf(m, "%ps\n", (void *)*ptr);
3461ea4e2bc4SSteven Rostedt 
3462ea4e2bc4SSteven Rostedt 	return 0;
3463ea4e2bc4SSteven Rostedt }
3464ea4e2bc4SSteven Rostedt 
346588e9d34cSJames Morris static const struct seq_operations ftrace_graph_seq_ops = {
3466ea4e2bc4SSteven Rostedt 	.start = g_start,
3467ea4e2bc4SSteven Rostedt 	.next = g_next,
3468ea4e2bc4SSteven Rostedt 	.stop = g_stop,
3469ea4e2bc4SSteven Rostedt 	.show = g_show,
3470ea4e2bc4SSteven Rostedt };
3471ea4e2bc4SSteven Rostedt 
3472ea4e2bc4SSteven Rostedt static int
3473ea4e2bc4SSteven Rostedt ftrace_graph_open(struct inode *inode, struct file *file)
3474ea4e2bc4SSteven Rostedt {
3475ea4e2bc4SSteven Rostedt 	int ret = 0;
3476ea4e2bc4SSteven Rostedt 
3477ea4e2bc4SSteven Rostedt 	if (unlikely(ftrace_disabled))
3478ea4e2bc4SSteven Rostedt 		return -ENODEV;
3479ea4e2bc4SSteven Rostedt 
3480ea4e2bc4SSteven Rostedt 	mutex_lock(&graph_lock);
3481ea4e2bc4SSteven Rostedt 	if ((file->f_mode & FMODE_WRITE) &&
34828650ae32SSteven Rostedt 	    (file->f_flags & O_TRUNC)) {
3483c7c6b1feSLi Zefan 		ftrace_graph_filter_enabled = 0;
3484ea4e2bc4SSteven Rostedt 		ftrace_graph_count = 0;
3485ea4e2bc4SSteven Rostedt 		memset(ftrace_graph_funcs, 0, sizeof(ftrace_graph_funcs));
3486ea4e2bc4SSteven Rostedt 	}
3487ea4e2bc4SSteven Rostedt 	mutex_unlock(&graph_lock);
3488ea4e2bc4SSteven Rostedt 
3489a4ec5e0cSLi Zefan 	if (file->f_mode & FMODE_READ)
3490a4ec5e0cSLi Zefan 		ret = seq_open(file, &ftrace_graph_seq_ops);
3491a4ec5e0cSLi Zefan 
3492ea4e2bc4SSteven Rostedt 	return ret;
3493ea4e2bc4SSteven Rostedt }
3494ea4e2bc4SSteven Rostedt 
3495ea4e2bc4SSteven Rostedt static int
349687827111SLi Zefan ftrace_graph_release(struct inode *inode, struct file *file)
349787827111SLi Zefan {
349887827111SLi Zefan 	if (file->f_mode & FMODE_READ)
349987827111SLi Zefan 		seq_release(inode, file);
350087827111SLi Zefan 	return 0;
350187827111SLi Zefan }
350287827111SLi Zefan 
350387827111SLi Zefan static int
3504f9349a8fSFrederic Weisbecker ftrace_set_func(unsigned long *array, int *idx, char *buffer)
3505ea4e2bc4SSteven Rostedt {
3506ea4e2bc4SSteven Rostedt 	struct dyn_ftrace *rec;
3507ea4e2bc4SSteven Rostedt 	struct ftrace_page *pg;
3508f9349a8fSFrederic Weisbecker 	int search_len;
3509c7c6b1feSLi Zefan 	int fail = 1;
3510f9349a8fSFrederic Weisbecker 	int type, not;
3511f9349a8fSFrederic Weisbecker 	char *search;
3512f9349a8fSFrederic Weisbecker 	bool exists;
3513f9349a8fSFrederic Weisbecker 	int i;
3514ea4e2bc4SSteven Rostedt 
3515f9349a8fSFrederic Weisbecker 	/* decode regex */
35163f6fe06dSFrederic Weisbecker 	type = filter_parse_regex(buffer, strlen(buffer), &search, &not);
3517c7c6b1feSLi Zefan 	if (!not && *idx >= FTRACE_GRAPH_MAX_FUNCS)
3518c7c6b1feSLi Zefan 		return -EBUSY;
3519f9349a8fSFrederic Weisbecker 
3520f9349a8fSFrederic Weisbecker 	search_len = strlen(search);
3521f9349a8fSFrederic Weisbecker 
352252baf119SSteven Rostedt 	mutex_lock(&ftrace_lock);
352345a4a237SSteven Rostedt 
352445a4a237SSteven Rostedt 	if (unlikely(ftrace_disabled)) {
352545a4a237SSteven Rostedt 		mutex_unlock(&ftrace_lock);
352645a4a237SSteven Rostedt 		return -ENODEV;
352745a4a237SSteven Rostedt 	}
352845a4a237SSteven Rostedt 
3529265c831cSSteven Rostedt 	do_for_each_ftrace_rec(pg, rec) {
3530ea4e2bc4SSteven Rostedt 
3531b9df92d2SSteven Rostedt 		if (ftrace_match_record(rec, NULL, search, search_len, type)) {
3532c7c6b1feSLi Zefan 			/* if it is in the array */
3533f9349a8fSFrederic Weisbecker 			exists = false;
3534c7c6b1feSLi Zefan 			for (i = 0; i < *idx; i++) {
3535f9349a8fSFrederic Weisbecker 				if (array[i] == rec->ip) {
3536f9349a8fSFrederic Weisbecker 					exists = true;
3537faec2ec5SLiming Wang 					break;
3538faec2ec5SLiming Wang 				}
3539c7c6b1feSLi Zefan 			}
3540c7c6b1feSLi Zefan 
3541c7c6b1feSLi Zefan 			if (!not) {
3542c7c6b1feSLi Zefan 				fail = 0;
3543c7c6b1feSLi Zefan 				if (!exists) {
3544f9349a8fSFrederic Weisbecker 					array[(*idx)++] = rec->ip;
3545c7c6b1feSLi Zefan 					if (*idx >= FTRACE_GRAPH_MAX_FUNCS)
3546c7c6b1feSLi Zefan 						goto out;
3547c7c6b1feSLi Zefan 				}
3548c7c6b1feSLi Zefan 			} else {
3549c7c6b1feSLi Zefan 				if (exists) {
3550c7c6b1feSLi Zefan 					array[i] = array[--(*idx)];
3551c7c6b1feSLi Zefan 					array[*idx] = 0;
3552c7c6b1feSLi Zefan 					fail = 0;
3553c7c6b1feSLi Zefan 				}
3554c7c6b1feSLi Zefan 			}
3555f9349a8fSFrederic Weisbecker 		}
3556265c831cSSteven Rostedt 	} while_for_each_ftrace_rec();
3557c7c6b1feSLi Zefan out:
355852baf119SSteven Rostedt 	mutex_unlock(&ftrace_lock);
3559ea4e2bc4SSteven Rostedt 
3560c7c6b1feSLi Zefan 	if (fail)
3561c7c6b1feSLi Zefan 		return -EINVAL;
3562c7c6b1feSLi Zefan 
3563c7c6b1feSLi Zefan 	ftrace_graph_filter_enabled = 1;
3564c7c6b1feSLi Zefan 	return 0;
3565ea4e2bc4SSteven Rostedt }
3566ea4e2bc4SSteven Rostedt 
3567ea4e2bc4SSteven Rostedt static ssize_t
3568ea4e2bc4SSteven Rostedt ftrace_graph_write(struct file *file, const char __user *ubuf,
3569ea4e2bc4SSteven Rostedt 		   size_t cnt, loff_t *ppos)
3570ea4e2bc4SSteven Rostedt {
3571689fd8b6S[email protected] 	struct trace_parser parser;
35724ba7978eSLi Zefan 	ssize_t read, ret;
3573ea4e2bc4SSteven Rostedt 
3574c7c6b1feSLi Zefan 	if (!cnt)
3575ea4e2bc4SSteven Rostedt 		return 0;
3576ea4e2bc4SSteven Rostedt 
3577ea4e2bc4SSteven Rostedt 	mutex_lock(&graph_lock);
3578ea4e2bc4SSteven Rostedt 
3579689fd8b6S[email protected] 	if (trace_parser_get_init(&parser, FTRACE_BUFF_MAX)) {
3580689fd8b6S[email protected] 		ret = -ENOMEM;
35811eb90f13SLi Zefan 		goto out_unlock;
3582ea4e2bc4SSteven Rostedt 	}
3583ea4e2bc4SSteven Rostedt 
3584689fd8b6S[email protected] 	read = trace_get_user(&parser, ubuf, cnt, ppos);
3585689fd8b6S[email protected] 
35864ba7978eSLi Zefan 	if (read >= 0 && trace_parser_loaded((&parser))) {
3587689fd8b6S[email protected] 		parser.buffer[parser.idx] = 0;
3588ea4e2bc4SSteven Rostedt 
3589f9349a8fSFrederic Weisbecker 		/* we allow only one expression at a time */
3590a4ec5e0cSLi Zefan 		ret = ftrace_set_func(ftrace_graph_funcs, &ftrace_graph_count,
3591689fd8b6S[email protected] 					parser.buffer);
3592ea4e2bc4SSteven Rostedt 		if (ret)
35931eb90f13SLi Zefan 			goto out_free;
3594689fd8b6S[email protected] 	}
3595ea4e2bc4SSteven Rostedt 
3596ea4e2bc4SSteven Rostedt 	ret = read;
35971eb90f13SLi Zefan 
35981eb90f13SLi Zefan out_free:
3599689fd8b6S[email protected] 	trace_parser_put(&parser);
36001eb90f13SLi Zefan out_unlock:
3601ea4e2bc4SSteven Rostedt 	mutex_unlock(&graph_lock);
3602ea4e2bc4SSteven Rostedt 
3603ea4e2bc4SSteven Rostedt 	return ret;
3604ea4e2bc4SSteven Rostedt }
3605ea4e2bc4SSteven Rostedt 
3606ea4e2bc4SSteven Rostedt static const struct file_operations ftrace_graph_fops = {
3607ea4e2bc4SSteven Rostedt 	.open		= ftrace_graph_open,
3608850a80cfSLai Jiangshan 	.read		= seq_read,
3609ea4e2bc4SSteven Rostedt 	.write		= ftrace_graph_write,
361087827111SLi Zefan 	.release	= ftrace_graph_release,
36116038f373SArnd Bergmann 	.llseek		= seq_lseek,
3612ea4e2bc4SSteven Rostedt };
3613ea4e2bc4SSteven Rostedt #endif /* CONFIG_FUNCTION_GRAPH_TRACER */
3614ea4e2bc4SSteven Rostedt 
3615df4fc315SSteven Rostedt static __init int ftrace_init_dyn_debugfs(struct dentry *d_tracer)
36165072c59fSSteven Rostedt {
36175072c59fSSteven Rostedt 
36185452af66SFrederic Weisbecker 	trace_create_file("available_filter_functions", 0444,
36195072c59fSSteven Rostedt 			d_tracer, NULL, &ftrace_avail_fops);
36205072c59fSSteven Rostedt 
3621647bcd03SSteven Rostedt 	trace_create_file("enabled_functions", 0444,
3622647bcd03SSteven Rostedt 			d_tracer, NULL, &ftrace_enabled_fops);
3623647bcd03SSteven Rostedt 
36245452af66SFrederic Weisbecker 	trace_create_file("set_ftrace_filter", 0644, d_tracer,
36255072c59fSSteven Rostedt 			NULL, &ftrace_filter_fops);
362641c52c0dSSteven Rostedt 
36275452af66SFrederic Weisbecker 	trace_create_file("set_ftrace_notrace", 0644, d_tracer,
362841c52c0dSSteven Rostedt 				    NULL, &ftrace_notrace_fops);
3629ad90c0e3SSteven Rostedt 
3630ea4e2bc4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
36315452af66SFrederic Weisbecker 	trace_create_file("set_graph_function", 0444, d_tracer,
3632ea4e2bc4SSteven Rostedt 				    NULL,
3633ea4e2bc4SSteven Rostedt 				    &ftrace_graph_fops);
3634ea4e2bc4SSteven Rostedt #endif /* CONFIG_FUNCTION_GRAPH_TRACER */
3635ea4e2bc4SSteven Rostedt 
36365072c59fSSteven Rostedt 	return 0;
36375072c59fSSteven Rostedt }
36385072c59fSSteven Rostedt 
36399fd49328SSteven Rostedt static int ftrace_cmp_ips(const void *a, const void *b)
364068950619SSteven Rostedt {
36419fd49328SSteven Rostedt 	const unsigned long *ipa = a;
36429fd49328SSteven Rostedt 	const unsigned long *ipb = b;
364368950619SSteven Rostedt 
36449fd49328SSteven Rostedt 	if (*ipa > *ipb)
36459fd49328SSteven Rostedt 		return 1;
36469fd49328SSteven Rostedt 	if (*ipa < *ipb)
36479fd49328SSteven Rostedt 		return -1;
36489fd49328SSteven Rostedt 	return 0;
36499fd49328SSteven Rostedt }
36509fd49328SSteven Rostedt 
36519fd49328SSteven Rostedt static void ftrace_swap_ips(void *a, void *b, int size)
36529fd49328SSteven Rostedt {
36539fd49328SSteven Rostedt 	unsigned long *ipa = a;
36549fd49328SSteven Rostedt 	unsigned long *ipb = b;
36559fd49328SSteven Rostedt 	unsigned long t;
36569fd49328SSteven Rostedt 
36579fd49328SSteven Rostedt 	t = *ipa;
36589fd49328SSteven Rostedt 	*ipa = *ipb;
36599fd49328SSteven Rostedt 	*ipb = t;
366068950619SSteven Rostedt }
366168950619SSteven Rostedt 
36625cb084bbSJiri Olsa static int ftrace_process_locs(struct module *mod,
366331e88909SSteven Rostedt 			       unsigned long *start,
366468bf21aaSSteven Rostedt 			       unsigned long *end)
366568bf21aaSSteven Rostedt {
3666706c81f8SSteven Rostedt 	struct ftrace_page *start_pg;
3667a7900875SSteven Rostedt 	struct ftrace_page *pg;
3668706c81f8SSteven Rostedt 	struct dyn_ftrace *rec;
3669a7900875SSteven Rostedt 	unsigned long count;
367068bf21aaSSteven Rostedt 	unsigned long *p;
367168bf21aaSSteven Rostedt 	unsigned long addr;
36724376cac6SSteven Rostedt 	unsigned long flags = 0; /* Shut up gcc */
3673a7900875SSteven Rostedt 	int ret = -ENOMEM;
3674a7900875SSteven Rostedt 
3675a7900875SSteven Rostedt 	count = end - start;
3676a7900875SSteven Rostedt 
3677a7900875SSteven Rostedt 	if (!count)
3678a7900875SSteven Rostedt 		return 0;
3679a7900875SSteven Rostedt 
36809fd49328SSteven Rostedt 	sort(start, count, sizeof(*start),
36819fd49328SSteven Rostedt 	     ftrace_cmp_ips, ftrace_swap_ips);
36829fd49328SSteven Rostedt 
3683706c81f8SSteven Rostedt 	start_pg = ftrace_allocate_pages(count);
3684706c81f8SSteven Rostedt 	if (!start_pg)
3685a7900875SSteven Rostedt 		return -ENOMEM;
368668bf21aaSSteven Rostedt 
3687e6ea44e9SSteven Rostedt 	mutex_lock(&ftrace_lock);
3688a7900875SSteven Rostedt 
368932082309SSteven Rostedt 	/*
369032082309SSteven Rostedt 	 * Core and each module needs their own pages, as
369132082309SSteven Rostedt 	 * modules will free them when they are removed.
369232082309SSteven Rostedt 	 * Force a new page to be allocated for modules.
369332082309SSteven Rostedt 	 */
3694a7900875SSteven Rostedt 	if (!mod) {
3695a7900875SSteven Rostedt 		WARN_ON(ftrace_pages || ftrace_pages_start);
3696a7900875SSteven Rostedt 		/* First initialization */
3697706c81f8SSteven Rostedt 		ftrace_pages = ftrace_pages_start = start_pg;
3698a7900875SSteven Rostedt 	} else {
369932082309SSteven Rostedt 		if (!ftrace_pages)
3700a7900875SSteven Rostedt 			goto out;
370132082309SSteven Rostedt 
3702a7900875SSteven Rostedt 		if (WARN_ON(ftrace_pages->next)) {
3703a7900875SSteven Rostedt 			/* Hmm, we have free pages? */
3704a7900875SSteven Rostedt 			while (ftrace_pages->next)
370532082309SSteven Rostedt 				ftrace_pages = ftrace_pages->next;
370632082309SSteven Rostedt 		}
3707a7900875SSteven Rostedt 
3708706c81f8SSteven Rostedt 		ftrace_pages->next = start_pg;
370932082309SSteven Rostedt 	}
371032082309SSteven Rostedt 
371168bf21aaSSteven Rostedt 	p = start;
3712706c81f8SSteven Rostedt 	pg = start_pg;
371368bf21aaSSteven Rostedt 	while (p < end) {
371468bf21aaSSteven Rostedt 		addr = ftrace_call_adjust(*p++);
371520e5227eSSteven Rostedt 		/*
371620e5227eSSteven Rostedt 		 * Some architecture linkers will pad between
371720e5227eSSteven Rostedt 		 * the different mcount_loc sections of different
371820e5227eSSteven Rostedt 		 * object files to satisfy alignments.
371920e5227eSSteven Rostedt 		 * Skip any NULL pointers.
372020e5227eSSteven Rostedt 		 */
372120e5227eSSteven Rostedt 		if (!addr)
372220e5227eSSteven Rostedt 			continue;
3723706c81f8SSteven Rostedt 
3724706c81f8SSteven Rostedt 		if (pg->index == pg->size) {
3725706c81f8SSteven Rostedt 			/* We should have allocated enough */
3726706c81f8SSteven Rostedt 			if (WARN_ON(!pg->next))
3727a7900875SSteven Rostedt 				break;
3728706c81f8SSteven Rostedt 			pg = pg->next;
372968bf21aaSSteven Rostedt 		}
373068bf21aaSSteven Rostedt 
3731706c81f8SSteven Rostedt 		rec = &pg->records[pg->index++];
3732706c81f8SSteven Rostedt 		rec->ip = addr;
3733706c81f8SSteven Rostedt 	}
3734706c81f8SSteven Rostedt 
3735706c81f8SSteven Rostedt 	/* We should have used all pages */
3736706c81f8SSteven Rostedt 	WARN_ON(pg->next);
3737706c81f8SSteven Rostedt 
3738706c81f8SSteven Rostedt 	/* Assign the last page to ftrace_pages */
3739706c81f8SSteven Rostedt 	ftrace_pages = pg;
3740706c81f8SSteven Rostedt 
374185ae32aeSSteven Rostedt 	/* These new locations need to be initialized */
3742706c81f8SSteven Rostedt 	ftrace_new_pgs = start_pg;
374385ae32aeSSteven Rostedt 
3744a4f18ed1SSteven Rostedt 	/*
37454376cac6SSteven Rostedt 	 * We only need to disable interrupts on start up
37464376cac6SSteven Rostedt 	 * because we are modifying code that an interrupt
37474376cac6SSteven Rostedt 	 * may execute, and the modification is not atomic.
37484376cac6SSteven Rostedt 	 * But for modules, nothing runs the code we modify
37494376cac6SSteven Rostedt 	 * until we are finished with it, and there's no
37504376cac6SSteven Rostedt 	 * reason to cause large interrupt latencies while we do it.
3751a4f18ed1SSteven Rostedt 	 */
37524376cac6SSteven Rostedt 	if (!mod)
3753a4f18ed1SSteven Rostedt 		local_irq_save(flags);
375431e88909SSteven Rostedt 	ftrace_update_code(mod);
37554376cac6SSteven Rostedt 	if (!mod)
3756a4f18ed1SSteven Rostedt 		local_irq_restore(flags);
3757a7900875SSteven Rostedt 	ret = 0;
3758a7900875SSteven Rostedt  out:
3759e6ea44e9SSteven Rostedt 	mutex_unlock(&ftrace_lock);
376068bf21aaSSteven Rostedt 
3761a7900875SSteven Rostedt 	return ret;
376268bf21aaSSteven Rostedt }
376368bf21aaSSteven Rostedt 
376493eb677dSSteven Rostedt #ifdef CONFIG_MODULES
376532082309SSteven Rostedt 
376632082309SSteven Rostedt #define next_to_ftrace_page(p) container_of(p, struct ftrace_page, next)
376732082309SSteven Rostedt 
3768e7247a15S[email protected] void ftrace_release_mod(struct module *mod)
376993eb677dSSteven Rostedt {
377093eb677dSSteven Rostedt 	struct dyn_ftrace *rec;
377132082309SSteven Rostedt 	struct ftrace_page **last_pg;
377293eb677dSSteven Rostedt 	struct ftrace_page *pg;
3773a7900875SSteven Rostedt 	int order;
377493eb677dSSteven Rostedt 
377593eb677dSSteven Rostedt 	mutex_lock(&ftrace_lock);
377645a4a237SSteven Rostedt 
377745a4a237SSteven Rostedt 	if (ftrace_disabled)
377845a4a237SSteven Rostedt 		goto out_unlock;
377945a4a237SSteven Rostedt 
378032082309SSteven Rostedt 	/*
378132082309SSteven Rostedt 	 * Each module has its own ftrace_pages, remove
378232082309SSteven Rostedt 	 * them from the list.
378332082309SSteven Rostedt 	 */
378432082309SSteven Rostedt 	last_pg = &ftrace_pages_start;
378532082309SSteven Rostedt 	for (pg = ftrace_pages_start; pg; pg = *last_pg) {
378632082309SSteven Rostedt 		rec = &pg->records[0];
3787e7247a15S[email protected] 		if (within_module_core(rec->ip, mod)) {
378893eb677dSSteven Rostedt 			/*
378932082309SSteven Rostedt 			 * As core pages are first, the first
379032082309SSteven Rostedt 			 * page should never be a module page.
379193eb677dSSteven Rostedt 			 */
379232082309SSteven Rostedt 			if (WARN_ON(pg == ftrace_pages_start))
379332082309SSteven Rostedt 				goto out_unlock;
379432082309SSteven Rostedt 
379532082309SSteven Rostedt 			/* Check if we are deleting the last page */
379632082309SSteven Rostedt 			if (pg == ftrace_pages)
379732082309SSteven Rostedt 				ftrace_pages = next_to_ftrace_page(last_pg);
379832082309SSteven Rostedt 
379932082309SSteven Rostedt 			*last_pg = pg->next;
3800a7900875SSteven Rostedt 			order = get_count_order(pg->size / ENTRIES_PER_PAGE);
3801a7900875SSteven Rostedt 			free_pages((unsigned long)pg->records, order);
3802a7900875SSteven Rostedt 			kfree(pg);
380332082309SSteven Rostedt 		} else
380432082309SSteven Rostedt 			last_pg = &pg->next;
380593eb677dSSteven Rostedt 	}
380645a4a237SSteven Rostedt  out_unlock:
380793eb677dSSteven Rostedt 	mutex_unlock(&ftrace_lock);
380893eb677dSSteven Rostedt }
380993eb677dSSteven Rostedt 
381093eb677dSSteven Rostedt static void ftrace_init_module(struct module *mod,
381131e88909SSteven Rostedt 			       unsigned long *start, unsigned long *end)
381290d595feSSteven Rostedt {
381300fd61aeSSteven Rostedt 	if (ftrace_disabled || start == end)
3814fed1939cSSteven Rostedt 		return;
38155cb084bbSJiri Olsa 	ftrace_process_locs(mod, start, end);
381690d595feSSteven Rostedt }
381790d595feSSteven Rostedt 
381893eb677dSSteven Rostedt static int ftrace_module_notify(struct notifier_block *self,
381993eb677dSSteven Rostedt 				unsigned long val, void *data)
382093eb677dSSteven Rostedt {
382193eb677dSSteven Rostedt 	struct module *mod = data;
382293eb677dSSteven Rostedt 
382393eb677dSSteven Rostedt 	switch (val) {
382493eb677dSSteven Rostedt 	case MODULE_STATE_COMING:
382593eb677dSSteven Rostedt 		ftrace_init_module(mod, mod->ftrace_callsites,
382693eb677dSSteven Rostedt 				   mod->ftrace_callsites +
382793eb677dSSteven Rostedt 				   mod->num_ftrace_callsites);
382893eb677dSSteven Rostedt 		break;
382993eb677dSSteven Rostedt 	case MODULE_STATE_GOING:
3830e7247a15S[email protected] 		ftrace_release_mod(mod);
383193eb677dSSteven Rostedt 		break;
383293eb677dSSteven Rostedt 	}
383393eb677dSSteven Rostedt 
383493eb677dSSteven Rostedt 	return 0;
383593eb677dSSteven Rostedt }
383693eb677dSSteven Rostedt #else
383793eb677dSSteven Rostedt static int ftrace_module_notify(struct notifier_block *self,
383893eb677dSSteven Rostedt 				unsigned long val, void *data)
383993eb677dSSteven Rostedt {
384093eb677dSSteven Rostedt 	return 0;
384193eb677dSSteven Rostedt }
384293eb677dSSteven Rostedt #endif /* CONFIG_MODULES */
384393eb677dSSteven Rostedt 
384493eb677dSSteven Rostedt struct notifier_block ftrace_module_nb = {
384593eb677dSSteven Rostedt 	.notifier_call = ftrace_module_notify,
384693eb677dSSteven Rostedt 	.priority = 0,
384793eb677dSSteven Rostedt };
384893eb677dSSteven Rostedt 
384968bf21aaSSteven Rostedt extern unsigned long __start_mcount_loc[];
385068bf21aaSSteven Rostedt extern unsigned long __stop_mcount_loc[];
385168bf21aaSSteven Rostedt 
385268bf21aaSSteven Rostedt void __init ftrace_init(void)
385368bf21aaSSteven Rostedt {
385468bf21aaSSteven Rostedt 	unsigned long count, addr, flags;
385568bf21aaSSteven Rostedt 	int ret;
385668bf21aaSSteven Rostedt 
385768bf21aaSSteven Rostedt 	/* Keep the ftrace pointer to the stub */
385868bf21aaSSteven Rostedt 	addr = (unsigned long)ftrace_stub;
385968bf21aaSSteven Rostedt 
386068bf21aaSSteven Rostedt 	local_irq_save(flags);
386168bf21aaSSteven Rostedt 	ftrace_dyn_arch_init(&addr);
386268bf21aaSSteven Rostedt 	local_irq_restore(flags);
386368bf21aaSSteven Rostedt 
386468bf21aaSSteven Rostedt 	/* ftrace_dyn_arch_init places the return code in addr */
386568bf21aaSSteven Rostedt 	if (addr)
386668bf21aaSSteven Rostedt 		goto failed;
386768bf21aaSSteven Rostedt 
386868bf21aaSSteven Rostedt 	count = __stop_mcount_loc - __start_mcount_loc;
386968bf21aaSSteven Rostedt 
387068bf21aaSSteven Rostedt 	ret = ftrace_dyn_table_alloc(count);
387168bf21aaSSteven Rostedt 	if (ret)
387268bf21aaSSteven Rostedt 		goto failed;
387368bf21aaSSteven Rostedt 
387468bf21aaSSteven Rostedt 	last_ftrace_enabled = ftrace_enabled = 1;
387568bf21aaSSteven Rostedt 
38765cb084bbSJiri Olsa 	ret = ftrace_process_locs(NULL,
387731e88909SSteven Rostedt 				  __start_mcount_loc,
387868bf21aaSSteven Rostedt 				  __stop_mcount_loc);
387968bf21aaSSteven Rostedt 
388093eb677dSSteven Rostedt 	ret = register_module_notifier(&ftrace_module_nb);
388124ed0c4bSMing Lei 	if (ret)
388293eb677dSSteven Rostedt 		pr_warning("Failed to register trace ftrace module notifier\n");
388393eb677dSSteven Rostedt 
38842af15d6aSSteven Rostedt 	set_ftrace_early_filters();
38852af15d6aSSteven Rostedt 
388668bf21aaSSteven Rostedt 	return;
388768bf21aaSSteven Rostedt  failed:
388868bf21aaSSteven Rostedt 	ftrace_disabled = 1;
388968bf21aaSSteven Rostedt }
389068bf21aaSSteven Rostedt 
38913d083395SSteven Rostedt #else
38920b6e4d56SFrederic Weisbecker 
38932b499381SSteven Rostedt static struct ftrace_ops global_ops = {
3894bd69c30bSSteven Rostedt 	.func			= ftrace_stub,
3895bd69c30bSSteven Rostedt };
3896bd69c30bSSteven Rostedt 
38970b6e4d56SFrederic Weisbecker static int __init ftrace_nodyn_init(void)
38980b6e4d56SFrederic Weisbecker {
38990b6e4d56SFrederic Weisbecker 	ftrace_enabled = 1;
39000b6e4d56SFrederic Weisbecker 	return 0;
39010b6e4d56SFrederic Weisbecker }
39020b6e4d56SFrederic Weisbecker device_initcall(ftrace_nodyn_init);
39030b6e4d56SFrederic Weisbecker 
3904df4fc315SSteven Rostedt static inline int ftrace_init_dyn_debugfs(struct dentry *d_tracer) { return 0; }
3905df4fc315SSteven Rostedt static inline void ftrace_startup_enable(int command) { }
39065a45cfe1SSteven Rostedt /* Keep as macros so we do not need to define the commands */
39073b6cfdb1SSteven Rostedt # define ftrace_startup(ops, command)			\
39083b6cfdb1SSteven Rostedt 	({						\
39093b6cfdb1SSteven Rostedt 		(ops)->flags |= FTRACE_OPS_FL_ENABLED;	\
39103b6cfdb1SSteven Rostedt 		0;					\
39113b6cfdb1SSteven Rostedt 	})
3912bd69c30bSSteven Rostedt # define ftrace_shutdown(ops, command)	do { } while (0)
3913b0fc494fSSteven Rostedt # define ftrace_startup_sysctl()	do { } while (0)
3914b0fc494fSSteven Rostedt # define ftrace_shutdown_sysctl()	do { } while (0)
3915b848914cSSteven Rostedt 
3916b848914cSSteven Rostedt static inline int
3917b848914cSSteven Rostedt ftrace_ops_test(struct ftrace_ops *ops, unsigned long ip)
3918b848914cSSteven Rostedt {
3919b848914cSSteven Rostedt 	return 1;
3920b848914cSSteven Rostedt }
3921b848914cSSteven Rostedt 
39223d083395SSteven Rostedt #endif /* CONFIG_DYNAMIC_FTRACE */
39233d083395SSteven Rostedt 
3924b848914cSSteven Rostedt static void
39252f5f6ad9SSteven Rostedt ftrace_ops_control_func(unsigned long ip, unsigned long parent_ip,
3926*a1e2e31dSSteven Rostedt 			struct ftrace_ops *op, struct pt_regs *regs)
3927e248491aSJiri Olsa {
3928e248491aSJiri Olsa 	if (unlikely(trace_recursion_test(TRACE_CONTROL_BIT)))
3929e248491aSJiri Olsa 		return;
3930e248491aSJiri Olsa 
3931e248491aSJiri Olsa 	/*
3932e248491aSJiri Olsa 	 * Some of the ops may be dynamically allocated,
3933e248491aSJiri Olsa 	 * they must be freed after a synchronize_sched().
3934e248491aSJiri Olsa 	 */
3935e248491aSJiri Olsa 	preempt_disable_notrace();
3936e248491aSJiri Olsa 	trace_recursion_set(TRACE_CONTROL_BIT);
3937e248491aSJiri Olsa 	op = rcu_dereference_raw(ftrace_control_list);
3938e248491aSJiri Olsa 	while (op != &ftrace_list_end) {
3939e248491aSJiri Olsa 		if (!ftrace_function_local_disabled(op) &&
3940e248491aSJiri Olsa 		    ftrace_ops_test(op, ip))
3941*a1e2e31dSSteven Rostedt 			op->func(ip, parent_ip, op, regs);
3942e248491aSJiri Olsa 
3943e248491aSJiri Olsa 		op = rcu_dereference_raw(op->next);
3944e248491aSJiri Olsa 	};
3945e248491aSJiri Olsa 	trace_recursion_clear(TRACE_CONTROL_BIT);
3946e248491aSJiri Olsa 	preempt_enable_notrace();
3947e248491aSJiri Olsa }
3948e248491aSJiri Olsa 
3949e248491aSJiri Olsa static struct ftrace_ops control_ops = {
3950e248491aSJiri Olsa 	.func = ftrace_ops_control_func,
3951e248491aSJiri Olsa };
3952e248491aSJiri Olsa 
39532f5f6ad9SSteven Rostedt static inline void
39542f5f6ad9SSteven Rostedt __ftrace_ops_list_func(unsigned long ip, unsigned long parent_ip,
3955*a1e2e31dSSteven Rostedt 		       struct ftrace_ops *ignored, struct pt_regs *regs)
3956b848914cSSteven Rostedt {
3957cdbe61bfSSteven Rostedt 	struct ftrace_ops *op;
3958b848914cSSteven Rostedt 
3959ccf3672dSSteven Rostedt 	if (function_trace_stop)
3960ccf3672dSSteven Rostedt 		return;
3961ccf3672dSSteven Rostedt 
3962b1cff0adSSteven Rostedt 	if (unlikely(trace_recursion_test(TRACE_INTERNAL_BIT)))
3963b1cff0adSSteven Rostedt 		return;
3964b1cff0adSSteven Rostedt 
3965b1cff0adSSteven Rostedt 	trace_recursion_set(TRACE_INTERNAL_BIT);
3966cdbe61bfSSteven Rostedt 	/*
3967cdbe61bfSSteven Rostedt 	 * Some of the ops may be dynamically allocated,
3968cdbe61bfSSteven Rostedt 	 * they must be freed after a synchronize_sched().
3969cdbe61bfSSteven Rostedt 	 */
3970cdbe61bfSSteven Rostedt 	preempt_disable_notrace();
3971cdbe61bfSSteven Rostedt 	op = rcu_dereference_raw(ftrace_ops_list);
3972b848914cSSteven Rostedt 	while (op != &ftrace_list_end) {
3973b848914cSSteven Rostedt 		if (ftrace_ops_test(op, ip))
3974*a1e2e31dSSteven Rostedt 			op->func(ip, parent_ip, op, regs);
3975b848914cSSteven Rostedt 		op = rcu_dereference_raw(op->next);
3976b848914cSSteven Rostedt 	};
3977cdbe61bfSSteven Rostedt 	preempt_enable_notrace();
3978b1cff0adSSteven Rostedt 	trace_recursion_clear(TRACE_INTERNAL_BIT);
3979b848914cSSteven Rostedt }
3980b848914cSSteven Rostedt 
39812f5f6ad9SSteven Rostedt /*
39822f5f6ad9SSteven Rostedt  * Some archs only support passing ip and parent_ip. Even though
39832f5f6ad9SSteven Rostedt  * the list function ignores the op parameter, we do not want any
39842f5f6ad9SSteven Rostedt  * C side effects, where a function is called without the caller
39852f5f6ad9SSteven Rostedt  * sending a third parameter.
3986*a1e2e31dSSteven Rostedt  * Archs are to support both the regs and ftrace_ops at the same time.
3987*a1e2e31dSSteven Rostedt  * If they support ftrace_ops, it is assumed they support regs.
3988*a1e2e31dSSteven Rostedt  * If call backs want to use regs, they must either check for regs
3989*a1e2e31dSSteven Rostedt  * being NULL, or ARCH_SUPPORTS_FTRACE_SAVE_REGS.
3990*a1e2e31dSSteven Rostedt  * Note, ARCH_SUPPORT_SAVE_REGS expects a full regs to be saved.
3991*a1e2e31dSSteven Rostedt  * An architecture can pass partial regs with ftrace_ops and still
3992*a1e2e31dSSteven Rostedt  * set the ARCH_SUPPORT_FTARCE_OPS.
39932f5f6ad9SSteven Rostedt  */
39942f5f6ad9SSteven Rostedt #if ARCH_SUPPORTS_FTRACE_OPS
39952f5f6ad9SSteven Rostedt static void ftrace_ops_list_func(unsigned long ip, unsigned long parent_ip,
3996*a1e2e31dSSteven Rostedt 				 struct ftrace_ops *op, struct pt_regs *regs)
39972f5f6ad9SSteven Rostedt {
3998*a1e2e31dSSteven Rostedt 	__ftrace_ops_list_func(ip, parent_ip, NULL, regs);
39992f5f6ad9SSteven Rostedt }
40002f5f6ad9SSteven Rostedt #else
40012f5f6ad9SSteven Rostedt static void ftrace_ops_no_ops(unsigned long ip, unsigned long parent_ip)
40022f5f6ad9SSteven Rostedt {
4003*a1e2e31dSSteven Rostedt 	__ftrace_ops_list_func(ip, parent_ip, NULL, NULL);
40042f5f6ad9SSteven Rostedt }
40052f5f6ad9SSteven Rostedt #endif
40062f5f6ad9SSteven Rostedt 
4007e32d8956SSteven Rostedt static void clear_ftrace_swapper(void)
4008e32d8956SSteven Rostedt {
4009e32d8956SSteven Rostedt 	struct task_struct *p;
4010e32d8956SSteven Rostedt 	int cpu;
4011e32d8956SSteven Rostedt 
4012e32d8956SSteven Rostedt 	get_online_cpus();
4013e32d8956SSteven Rostedt 	for_each_online_cpu(cpu) {
4014e32d8956SSteven Rostedt 		p = idle_task(cpu);
4015e32d8956SSteven Rostedt 		clear_tsk_trace_trace(p);
4016e32d8956SSteven Rostedt 	}
4017e32d8956SSteven Rostedt 	put_online_cpus();
4018e32d8956SSteven Rostedt }
4019e32d8956SSteven Rostedt 
4020e32d8956SSteven Rostedt static void set_ftrace_swapper(void)
4021e32d8956SSteven Rostedt {
4022e32d8956SSteven Rostedt 	struct task_struct *p;
4023e32d8956SSteven Rostedt 	int cpu;
4024e32d8956SSteven Rostedt 
4025e32d8956SSteven Rostedt 	get_online_cpus();
4026e32d8956SSteven Rostedt 	for_each_online_cpu(cpu) {
4027e32d8956SSteven Rostedt 		p = idle_task(cpu);
4028e32d8956SSteven Rostedt 		set_tsk_trace_trace(p);
4029e32d8956SSteven Rostedt 	}
4030e32d8956SSteven Rostedt 	put_online_cpus();
4031e32d8956SSteven Rostedt }
4032e32d8956SSteven Rostedt 
4033e32d8956SSteven Rostedt static void clear_ftrace_pid(struct pid *pid)
4034978f3a45SSteven Rostedt {
4035978f3a45SSteven Rostedt 	struct task_struct *p;
4036978f3a45SSteven Rostedt 
4037229c4ef8SOleg Nesterov 	rcu_read_lock();
4038e32d8956SSteven Rostedt 	do_each_pid_task(pid, PIDTYPE_PID, p) {
4039978f3a45SSteven Rostedt 		clear_tsk_trace_trace(p);
4040e32d8956SSteven Rostedt 	} while_each_pid_task(pid, PIDTYPE_PID, p);
4041229c4ef8SOleg Nesterov 	rcu_read_unlock();
4042229c4ef8SOleg Nesterov 
4043e32d8956SSteven Rostedt 	put_pid(pid);
4044978f3a45SSteven Rostedt }
4045978f3a45SSteven Rostedt 
4046e32d8956SSteven Rostedt static void set_ftrace_pid(struct pid *pid)
4047978f3a45SSteven Rostedt {
4048978f3a45SSteven Rostedt 	struct task_struct *p;
4049978f3a45SSteven Rostedt 
4050229c4ef8SOleg Nesterov 	rcu_read_lock();
4051978f3a45SSteven Rostedt 	do_each_pid_task(pid, PIDTYPE_PID, p) {
4052978f3a45SSteven Rostedt 		set_tsk_trace_trace(p);
4053978f3a45SSteven Rostedt 	} while_each_pid_task(pid, PIDTYPE_PID, p);
4054229c4ef8SOleg Nesterov 	rcu_read_unlock();
4055978f3a45SSteven Rostedt }
4056978f3a45SSteven Rostedt 
4057756d17eeS[email protected] static void clear_ftrace_pid_task(struct pid *pid)
4058e32d8956SSteven Rostedt {
4059756d17eeS[email protected] 	if (pid == ftrace_swapper_pid)
4060e32d8956SSteven Rostedt 		clear_ftrace_swapper();
4061e32d8956SSteven Rostedt 	else
4062756d17eeS[email protected] 		clear_ftrace_pid(pid);
4063e32d8956SSteven Rostedt }
4064e32d8956SSteven Rostedt 
4065e32d8956SSteven Rostedt static void set_ftrace_pid_task(struct pid *pid)
4066e32d8956SSteven Rostedt {
4067e32d8956SSteven Rostedt 	if (pid == ftrace_swapper_pid)
4068e32d8956SSteven Rostedt 		set_ftrace_swapper();
4069e32d8956SSteven Rostedt 	else
4070e32d8956SSteven Rostedt 		set_ftrace_pid(pid);
4071e32d8956SSteven Rostedt }
4072e32d8956SSteven Rostedt 
4073756d17eeS[email protected] static int ftrace_pid_add(int p)
4074756d17eeS[email protected] {
4075756d17eeS[email protected] 	struct pid *pid;
4076756d17eeS[email protected] 	struct ftrace_pid *fpid;
4077756d17eeS[email protected] 	int ret = -EINVAL;
4078756d17eeS[email protected] 
4079756d17eeS[email protected] 	mutex_lock(&ftrace_lock);
4080756d17eeS[email protected] 
4081756d17eeS[email protected] 	if (!p)
4082756d17eeS[email protected] 		pid = ftrace_swapper_pid;
4083756d17eeS[email protected] 	else
4084756d17eeS[email protected] 		pid = find_get_pid(p);
4085756d17eeS[email protected] 
4086756d17eeS[email protected] 	if (!pid)
4087756d17eeS[email protected] 		goto out;
4088756d17eeS[email protected] 
4089756d17eeS[email protected] 	ret = 0;
4090756d17eeS[email protected] 
4091756d17eeS[email protected] 	list_for_each_entry(fpid, &ftrace_pids, list)
4092756d17eeS[email protected] 		if (fpid->pid == pid)
4093756d17eeS[email protected] 			goto out_put;
4094756d17eeS[email protected] 
4095756d17eeS[email protected] 	ret = -ENOMEM;
4096756d17eeS[email protected] 
4097756d17eeS[email protected] 	fpid = kmalloc(sizeof(*fpid), GFP_KERNEL);
4098756d17eeS[email protected] 	if (!fpid)
4099756d17eeS[email protected] 		goto out_put;
4100756d17eeS[email protected] 
4101756d17eeS[email protected] 	list_add(&fpid->list, &ftrace_pids);
4102756d17eeS[email protected] 	fpid->pid = pid;
4103756d17eeS[email protected] 
4104756d17eeS[email protected] 	set_ftrace_pid_task(pid);
4105756d17eeS[email protected] 
4106756d17eeS[email protected] 	ftrace_update_pid_func();
4107756d17eeS[email protected] 	ftrace_startup_enable(0);
4108756d17eeS[email protected] 
4109756d17eeS[email protected] 	mutex_unlock(&ftrace_lock);
4110756d17eeS[email protected] 	return 0;
4111756d17eeS[email protected] 
4112756d17eeS[email protected] out_put:
4113756d17eeS[email protected] 	if (pid != ftrace_swapper_pid)
4114756d17eeS[email protected] 		put_pid(pid);
4115756d17eeS[email protected] 
4116756d17eeS[email protected] out:
4117756d17eeS[email protected] 	mutex_unlock(&ftrace_lock);
4118756d17eeS[email protected] 	return ret;
4119756d17eeS[email protected] }
4120756d17eeS[email protected] 
4121756d17eeS[email protected] static void ftrace_pid_reset(void)
4122756d17eeS[email protected] {
4123756d17eeS[email protected] 	struct ftrace_pid *fpid, *safe;
4124756d17eeS[email protected] 
4125756d17eeS[email protected] 	mutex_lock(&ftrace_lock);
4126756d17eeS[email protected] 	list_for_each_entry_safe(fpid, safe, &ftrace_pids, list) {
4127756d17eeS[email protected] 		struct pid *pid = fpid->pid;
4128756d17eeS[email protected] 
4129756d17eeS[email protected] 		clear_ftrace_pid_task(pid);
4130756d17eeS[email protected] 
4131756d17eeS[email protected] 		list_del(&fpid->list);
4132756d17eeS[email protected] 		kfree(fpid);
4133756d17eeS[email protected] 	}
4134756d17eeS[email protected] 
4135756d17eeS[email protected] 	ftrace_update_pid_func();
4136756d17eeS[email protected] 	ftrace_startup_enable(0);
4137756d17eeS[email protected] 
4138756d17eeS[email protected] 	mutex_unlock(&ftrace_lock);
4139756d17eeS[email protected] }
4140756d17eeS[email protected] 
4141756d17eeS[email protected] static void *fpid_start(struct seq_file *m, loff_t *pos)
4142756d17eeS[email protected] {
4143756d17eeS[email protected] 	mutex_lock(&ftrace_lock);
4144756d17eeS[email protected] 
4145756d17eeS[email protected] 	if (list_empty(&ftrace_pids) && (!*pos))
4146756d17eeS[email protected] 		return (void *) 1;
4147756d17eeS[email protected] 
4148756d17eeS[email protected] 	return seq_list_start(&ftrace_pids, *pos);
4149756d17eeS[email protected] }
4150756d17eeS[email protected] 
4151756d17eeS[email protected] static void *fpid_next(struct seq_file *m, void *v, loff_t *pos)
4152756d17eeS[email protected] {
4153756d17eeS[email protected] 	if (v == (void *)1)
4154756d17eeS[email protected] 		return NULL;
4155756d17eeS[email protected] 
4156756d17eeS[email protected] 	return seq_list_next(v, &ftrace_pids, pos);
4157756d17eeS[email protected] }
4158756d17eeS[email protected] 
4159756d17eeS[email protected] static void fpid_stop(struct seq_file *m, void *p)
4160756d17eeS[email protected] {
4161756d17eeS[email protected] 	mutex_unlock(&ftrace_lock);
4162756d17eeS[email protected] }
4163756d17eeS[email protected] 
4164756d17eeS[email protected] static int fpid_show(struct seq_file *m, void *v)
4165756d17eeS[email protected] {
4166756d17eeS[email protected] 	const struct ftrace_pid *fpid = list_entry(v, struct ftrace_pid, list);
4167756d17eeS[email protected] 
4168756d17eeS[email protected] 	if (v == (void *)1) {
4169756d17eeS[email protected] 		seq_printf(m, "no pid\n");
4170756d17eeS[email protected] 		return 0;
4171756d17eeS[email protected] 	}
4172756d17eeS[email protected] 
4173756d17eeS[email protected] 	if (fpid->pid == ftrace_swapper_pid)
4174756d17eeS[email protected] 		seq_printf(m, "swapper tasks\n");
4175756d17eeS[email protected] 	else
4176756d17eeS[email protected] 		seq_printf(m, "%u\n", pid_vnr(fpid->pid));
4177756d17eeS[email protected] 
4178756d17eeS[email protected] 	return 0;
4179756d17eeS[email protected] }
4180756d17eeS[email protected] 
4181756d17eeS[email protected] static const struct seq_operations ftrace_pid_sops = {
4182756d17eeS[email protected] 	.start = fpid_start,
4183756d17eeS[email protected] 	.next = fpid_next,
4184756d17eeS[email protected] 	.stop = fpid_stop,
4185756d17eeS[email protected] 	.show = fpid_show,
4186756d17eeS[email protected] };
4187756d17eeS[email protected] 
4188756d17eeS[email protected] static int
4189756d17eeS[email protected] ftrace_pid_open(struct inode *inode, struct file *file)
4190756d17eeS[email protected] {
4191756d17eeS[email protected] 	int ret = 0;
4192756d17eeS[email protected] 
4193756d17eeS[email protected] 	if ((file->f_mode & FMODE_WRITE) &&
4194756d17eeS[email protected] 	    (file->f_flags & O_TRUNC))
4195756d17eeS[email protected] 		ftrace_pid_reset();
4196756d17eeS[email protected] 
4197756d17eeS[email protected] 	if (file->f_mode & FMODE_READ)
4198756d17eeS[email protected] 		ret = seq_open(file, &ftrace_pid_sops);
4199756d17eeS[email protected] 
4200756d17eeS[email protected] 	return ret;
4201756d17eeS[email protected] }
4202756d17eeS[email protected] 
4203df4fc315SSteven Rostedt static ssize_t
4204df4fc315SSteven Rostedt ftrace_pid_write(struct file *filp, const char __user *ubuf,
4205df4fc315SSteven Rostedt 		   size_t cnt, loff_t *ppos)
4206df4fc315SSteven Rostedt {
4207457dc928SIngo Molnar 	char buf[64], *tmp;
4208df4fc315SSteven Rostedt 	long val;
4209df4fc315SSteven Rostedt 	int ret;
4210df4fc315SSteven Rostedt 
4211df4fc315SSteven Rostedt 	if (cnt >= sizeof(buf))
4212df4fc315SSteven Rostedt 		return -EINVAL;
4213df4fc315SSteven Rostedt 
4214df4fc315SSteven Rostedt 	if (copy_from_user(&buf, ubuf, cnt))
4215df4fc315SSteven Rostedt 		return -EFAULT;
4216df4fc315SSteven Rostedt 
4217df4fc315SSteven Rostedt 	buf[cnt] = 0;
4218df4fc315SSteven Rostedt 
4219756d17eeS[email protected] 	/*
4220756d17eeS[email protected] 	 * Allow "echo > set_ftrace_pid" or "echo -n '' > set_ftrace_pid"
4221756d17eeS[email protected] 	 * to clean the filter quietly.
4222756d17eeS[email protected] 	 */
4223457dc928SIngo Molnar 	tmp = strstrip(buf);
4224457dc928SIngo Molnar 	if (strlen(tmp) == 0)
4225756d17eeS[email protected] 		return 1;
4226756d17eeS[email protected] 
4227457dc928SIngo Molnar 	ret = strict_strtol(tmp, 10, &val);
4228df4fc315SSteven Rostedt 	if (ret < 0)
4229df4fc315SSteven Rostedt 		return ret;
4230df4fc315SSteven Rostedt 
4231756d17eeS[email protected] 	ret = ftrace_pid_add(val);
4232978f3a45SSteven Rostedt 
4233756d17eeS[email protected] 	return ret ? ret : cnt;
4234e32d8956SSteven Rostedt }
4235978f3a45SSteven Rostedt 
4236756d17eeS[email protected] static int
4237756d17eeS[email protected] ftrace_pid_release(struct inode *inode, struct file *file)
4238756d17eeS[email protected] {
4239756d17eeS[email protected] 	if (file->f_mode & FMODE_READ)
4240756d17eeS[email protected] 		seq_release(inode, file);
4241978f3a45SSteven Rostedt 
4242756d17eeS[email protected] 	return 0;
4243df4fc315SSteven Rostedt }
4244df4fc315SSteven Rostedt 
42455e2336a0SSteven Rostedt static const struct file_operations ftrace_pid_fops = {
4246756d17eeS[email protected] 	.open		= ftrace_pid_open,
4247df4fc315SSteven Rostedt 	.write		= ftrace_pid_write,
4248756d17eeS[email protected] 	.read		= seq_read,
4249756d17eeS[email protected] 	.llseek		= seq_lseek,
4250756d17eeS[email protected] 	.release	= ftrace_pid_release,
4251df4fc315SSteven Rostedt };
4252df4fc315SSteven Rostedt 
4253df4fc315SSteven Rostedt static __init int ftrace_init_debugfs(void)
4254df4fc315SSteven Rostedt {
4255df4fc315SSteven Rostedt 	struct dentry *d_tracer;
4256df4fc315SSteven Rostedt 
4257df4fc315SSteven Rostedt 	d_tracer = tracing_init_dentry();
4258df4fc315SSteven Rostedt 	if (!d_tracer)
4259df4fc315SSteven Rostedt 		return 0;
4260df4fc315SSteven Rostedt 
4261df4fc315SSteven Rostedt 	ftrace_init_dyn_debugfs(d_tracer);
4262df4fc315SSteven Rostedt 
42635452af66SFrederic Weisbecker 	trace_create_file("set_ftrace_pid", 0644, d_tracer,
4264df4fc315SSteven Rostedt 			    NULL, &ftrace_pid_fops);
4265493762fcSSteven Rostedt 
4266493762fcSSteven Rostedt 	ftrace_profile_debugfs(d_tracer);
4267493762fcSSteven Rostedt 
4268df4fc315SSteven Rostedt 	return 0;
4269df4fc315SSteven Rostedt }
4270df4fc315SSteven Rostedt fs_initcall(ftrace_init_debugfs);
4271df4fc315SSteven Rostedt 
42723d083395SSteven Rostedt /**
427381adbdc0SSteven Rostedt  * ftrace_kill - kill ftrace
4274a2bb6a3dSSteven Rostedt  *
4275a2bb6a3dSSteven Rostedt  * This function should be used by panic code. It stops ftrace
4276a2bb6a3dSSteven Rostedt  * but in a not so nice way. If you need to simply kill ftrace
4277a2bb6a3dSSteven Rostedt  * from a non-atomic section, use ftrace_kill.
4278a2bb6a3dSSteven Rostedt  */
427981adbdc0SSteven Rostedt void ftrace_kill(void)
4280a2bb6a3dSSteven Rostedt {
4281a2bb6a3dSSteven Rostedt 	ftrace_disabled = 1;
4282a2bb6a3dSSteven Rostedt 	ftrace_enabled = 0;
4283a2bb6a3dSSteven Rostedt 	clear_ftrace_function();
4284a2bb6a3dSSteven Rostedt }
4285a2bb6a3dSSteven Rostedt 
4286a2bb6a3dSSteven Rostedt /**
4287e0a413f6SSteven Rostedt  * Test if ftrace is dead or not.
4288e0a413f6SSteven Rostedt  */
4289e0a413f6SSteven Rostedt int ftrace_is_dead(void)
4290e0a413f6SSteven Rostedt {
4291e0a413f6SSteven Rostedt 	return ftrace_disabled;
4292e0a413f6SSteven Rostedt }
4293e0a413f6SSteven Rostedt 
4294e0a413f6SSteven Rostedt /**
42953d083395SSteven Rostedt  * register_ftrace_function - register a function for profiling
42963d083395SSteven Rostedt  * @ops - ops structure that holds the function for profiling.
42973d083395SSteven Rostedt  *
42983d083395SSteven Rostedt  * Register a function to be called by all functions in the
42993d083395SSteven Rostedt  * kernel.
43003d083395SSteven Rostedt  *
43013d083395SSteven Rostedt  * Note: @ops->func and all the functions it calls must be labeled
43023d083395SSteven Rostedt  *       with "notrace", otherwise it will go into a
43033d083395SSteven Rostedt  *       recursive loop.
43043d083395SSteven Rostedt  */
43053d083395SSteven Rostedt int register_ftrace_function(struct ftrace_ops *ops)
43063d083395SSteven Rostedt {
430745a4a237SSteven Rostedt 	int ret = -1;
43084eebcc81SSteven Rostedt 
4309e6ea44e9SSteven Rostedt 	mutex_lock(&ftrace_lock);
4310e7d3737eSFrederic Weisbecker 
4311b0fc494fSSteven Rostedt 	ret = __register_ftrace_function(ops);
4312b848914cSSteven Rostedt 	if (!ret)
4313a1cd6173SSteven Rostedt 		ret = ftrace_startup(ops, 0);
4314b848914cSSteven Rostedt 
4315e6ea44e9SSteven Rostedt 	mutex_unlock(&ftrace_lock);
43168d240dd8SBorislav Petkov 
4317b0fc494fSSteven Rostedt 	return ret;
43183d083395SSteven Rostedt }
4319cdbe61bfSSteven Rostedt EXPORT_SYMBOL_GPL(register_ftrace_function);
43203d083395SSteven Rostedt 
43213d083395SSteven Rostedt /**
432232632920SUwe Kleine-Koenig  * unregister_ftrace_function - unregister a function for profiling.
43233d083395SSteven Rostedt  * @ops - ops structure that holds the function to unregister
43243d083395SSteven Rostedt  *
43253d083395SSteven Rostedt  * Unregister a function that was added to be called by ftrace profiling.
43263d083395SSteven Rostedt  */
43273d083395SSteven Rostedt int unregister_ftrace_function(struct ftrace_ops *ops)
43283d083395SSteven Rostedt {
43293d083395SSteven Rostedt 	int ret;
43303d083395SSteven Rostedt 
4331e6ea44e9SSteven Rostedt 	mutex_lock(&ftrace_lock);
43323d083395SSteven Rostedt 	ret = __unregister_ftrace_function(ops);
4333b848914cSSteven Rostedt 	if (!ret)
4334b848914cSSteven Rostedt 		ftrace_shutdown(ops, 0);
4335e6ea44e9SSteven Rostedt 	mutex_unlock(&ftrace_lock);
4336b0fc494fSSteven Rostedt 
4337b0fc494fSSteven Rostedt 	return ret;
4338b0fc494fSSteven Rostedt }
4339cdbe61bfSSteven Rostedt EXPORT_SYMBOL_GPL(unregister_ftrace_function);
4340b0fc494fSSteven Rostedt 
4341e309b41dSIngo Molnar int
4342b0fc494fSSteven Rostedt ftrace_enable_sysctl(struct ctl_table *table, int write,
43438d65af78SAlexey Dobriyan 		     void __user *buffer, size_t *lenp,
4344b0fc494fSSteven Rostedt 		     loff_t *ppos)
4345b0fc494fSSteven Rostedt {
434645a4a237SSteven Rostedt 	int ret = -ENODEV;
43474eebcc81SSteven Rostedt 
4348e6ea44e9SSteven Rostedt 	mutex_lock(&ftrace_lock);
4349b0fc494fSSteven Rostedt 
435045a4a237SSteven Rostedt 	if (unlikely(ftrace_disabled))
435145a4a237SSteven Rostedt 		goto out;
435245a4a237SSteven Rostedt 
43538d65af78SAlexey Dobriyan 	ret = proc_dointvec(table, write, buffer, lenp, ppos);
4354b0fc494fSSteven Rostedt 
4355a32c7765SLi Zefan 	if (ret || !write || (last_ftrace_enabled == !!ftrace_enabled))
4356b0fc494fSSteven Rostedt 		goto out;
4357b0fc494fSSteven Rostedt 
4358a32c7765SLi Zefan 	last_ftrace_enabled = !!ftrace_enabled;
4359b0fc494fSSteven Rostedt 
4360b0fc494fSSteven Rostedt 	if (ftrace_enabled) {
4361b0fc494fSSteven Rostedt 
4362b0fc494fSSteven Rostedt 		ftrace_startup_sysctl();
4363b0fc494fSSteven Rostedt 
4364b0fc494fSSteven Rostedt 		/* we are starting ftrace again */
4365b848914cSSteven Rostedt 		if (ftrace_ops_list != &ftrace_list_end) {
4366b848914cSSteven Rostedt 			if (ftrace_ops_list->next == &ftrace_list_end)
4367b848914cSSteven Rostedt 				ftrace_trace_function = ftrace_ops_list->func;
4368b0fc494fSSteven Rostedt 			else
4369b848914cSSteven Rostedt 				ftrace_trace_function = ftrace_ops_list_func;
4370b0fc494fSSteven Rostedt 		}
4371b0fc494fSSteven Rostedt 
4372b0fc494fSSteven Rostedt 	} else {
4373b0fc494fSSteven Rostedt 		/* stopping ftrace calls (just send to ftrace_stub) */
4374b0fc494fSSteven Rostedt 		ftrace_trace_function = ftrace_stub;
4375b0fc494fSSteven Rostedt 
4376b0fc494fSSteven Rostedt 		ftrace_shutdown_sysctl();
4377b0fc494fSSteven Rostedt 	}
4378b0fc494fSSteven Rostedt 
4379b0fc494fSSteven Rostedt  out:
4380e6ea44e9SSteven Rostedt 	mutex_unlock(&ftrace_lock);
43813d083395SSteven Rostedt 	return ret;
438216444a8aSArnaldo Carvalho de Melo }
4383f17845e5SIngo Molnar 
4384fb52607aSFrederic Weisbecker #ifdef CONFIG_FUNCTION_GRAPH_TRACER
4385e7d3737eSFrederic Weisbecker 
4386597af815SSteven Rostedt static int ftrace_graph_active;
43874a2b8ddaSFrederic Weisbecker static struct notifier_block ftrace_suspend_notifier;
4388f201ae23SFrederic Weisbecker 
4389e49dc19cSSteven Rostedt int ftrace_graph_entry_stub(struct ftrace_graph_ent *trace)
4390e49dc19cSSteven Rostedt {
4391e49dc19cSSteven Rostedt 	return 0;
4392e49dc19cSSteven Rostedt }
4393e49dc19cSSteven Rostedt 
4394287b6e68SFrederic Weisbecker /* The callbacks that hook a function */
4395287b6e68SFrederic Weisbecker trace_func_graph_ret_t ftrace_graph_return =
4396287b6e68SFrederic Weisbecker 			(trace_func_graph_ret_t)ftrace_stub;
4397e49dc19cSSteven Rostedt trace_func_graph_ent_t ftrace_graph_entry = ftrace_graph_entry_stub;
4398f201ae23SFrederic Weisbecker 
4399f201ae23SFrederic Weisbecker /* Try to assign a return stack array on FTRACE_RETSTACK_ALLOC_SIZE tasks. */
4400f201ae23SFrederic Weisbecker static int alloc_retstack_tasklist(struct ftrace_ret_stack **ret_stack_list)
4401f201ae23SFrederic Weisbecker {
4402f201ae23SFrederic Weisbecker 	int i;
4403f201ae23SFrederic Weisbecker 	int ret = 0;
4404f201ae23SFrederic Weisbecker 	unsigned long flags;
4405f201ae23SFrederic Weisbecker 	int start = 0, end = FTRACE_RETSTACK_ALLOC_SIZE;
4406f201ae23SFrederic Weisbecker 	struct task_struct *g, *t;
4407f201ae23SFrederic Weisbecker 
4408f201ae23SFrederic Weisbecker 	for (i = 0; i < FTRACE_RETSTACK_ALLOC_SIZE; i++) {
4409f201ae23SFrederic Weisbecker 		ret_stack_list[i] = kmalloc(FTRACE_RETFUNC_DEPTH
4410f201ae23SFrederic Weisbecker 					* sizeof(struct ftrace_ret_stack),
4411f201ae23SFrederic Weisbecker 					GFP_KERNEL);
4412f201ae23SFrederic Weisbecker 		if (!ret_stack_list[i]) {
4413f201ae23SFrederic Weisbecker 			start = 0;
4414f201ae23SFrederic Weisbecker 			end = i;
4415f201ae23SFrederic Weisbecker 			ret = -ENOMEM;
4416f201ae23SFrederic Weisbecker 			goto free;
4417f201ae23SFrederic Weisbecker 		}
4418f201ae23SFrederic Weisbecker 	}
4419f201ae23SFrederic Weisbecker 
4420f201ae23SFrederic Weisbecker 	read_lock_irqsave(&tasklist_lock, flags);
4421f201ae23SFrederic Weisbecker 	do_each_thread(g, t) {
4422f201ae23SFrederic Weisbecker 		if (start == end) {
4423f201ae23SFrederic Weisbecker 			ret = -EAGAIN;
4424f201ae23SFrederic Weisbecker 			goto unlock;
4425f201ae23SFrederic Weisbecker 		}
4426f201ae23SFrederic Weisbecker 
4427f201ae23SFrederic Weisbecker 		if (t->ret_stack == NULL) {
4428380c4b14SFrederic Weisbecker 			atomic_set(&t->tracing_graph_pause, 0);
4429f201ae23SFrederic Weisbecker 			atomic_set(&t->trace_overrun, 0);
443026c01624SSteven Rostedt 			t->curr_ret_stack = -1;
443126c01624SSteven Rostedt 			/* Make sure the tasks see the -1 first: */
443226c01624SSteven Rostedt 			smp_wmb();
443326c01624SSteven Rostedt 			t->ret_stack = ret_stack_list[start++];
4434f201ae23SFrederic Weisbecker 		}
4435f201ae23SFrederic Weisbecker 	} while_each_thread(g, t);
4436f201ae23SFrederic Weisbecker 
4437f201ae23SFrederic Weisbecker unlock:
4438f201ae23SFrederic Weisbecker 	read_unlock_irqrestore(&tasklist_lock, flags);
4439f201ae23SFrederic Weisbecker free:
4440f201ae23SFrederic Weisbecker 	for (i = start; i < end; i++)
4441f201ae23SFrederic Weisbecker 		kfree(ret_stack_list[i]);
4442f201ae23SFrederic Weisbecker 	return ret;
4443f201ae23SFrederic Weisbecker }
4444f201ae23SFrederic Weisbecker 
44458aef2d28SSteven Rostedt static void
444638516ab5SSteven Rostedt ftrace_graph_probe_sched_switch(void *ignore,
444738516ab5SSteven Rostedt 			struct task_struct *prev, struct task_struct *next)
44488aef2d28SSteven Rostedt {
44498aef2d28SSteven Rostedt 	unsigned long long timestamp;
44508aef2d28SSteven Rostedt 	int index;
44518aef2d28SSteven Rostedt 
4452be6f164aSSteven Rostedt 	/*
4453be6f164aSSteven Rostedt 	 * Does the user want to count the time a function was asleep.
4454be6f164aSSteven Rostedt 	 * If so, do not update the time stamps.
4455be6f164aSSteven Rostedt 	 */
4456be6f164aSSteven Rostedt 	if (trace_flags & TRACE_ITER_SLEEP_TIME)
4457be6f164aSSteven Rostedt 		return;
4458be6f164aSSteven Rostedt 
44598aef2d28SSteven Rostedt 	timestamp = trace_clock_local();
44608aef2d28SSteven Rostedt 
44618aef2d28SSteven Rostedt 	prev->ftrace_timestamp = timestamp;
44628aef2d28SSteven Rostedt 
44638aef2d28SSteven Rostedt 	/* only process tasks that we timestamped */
44648aef2d28SSteven Rostedt 	if (!next->ftrace_timestamp)
44658aef2d28SSteven Rostedt 		return;
44668aef2d28SSteven Rostedt 
44678aef2d28SSteven Rostedt 	/*
44688aef2d28SSteven Rostedt 	 * Update all the counters in next to make up for the
44698aef2d28SSteven Rostedt 	 * time next was sleeping.
44708aef2d28SSteven Rostedt 	 */
44718aef2d28SSteven Rostedt 	timestamp -= next->ftrace_timestamp;
44728aef2d28SSteven Rostedt 
44738aef2d28SSteven Rostedt 	for (index = next->curr_ret_stack; index >= 0; index--)
44748aef2d28SSteven Rostedt 		next->ret_stack[index].calltime += timestamp;
44758aef2d28SSteven Rostedt }
44768aef2d28SSteven Rostedt 
4477f201ae23SFrederic Weisbecker /* Allocate a return stack for each task */
4478fb52607aSFrederic Weisbecker static int start_graph_tracing(void)
4479f201ae23SFrederic Weisbecker {
4480f201ae23SFrederic Weisbecker 	struct ftrace_ret_stack **ret_stack_list;
44815b058bcdSFrederic Weisbecker 	int ret, cpu;
4482f201ae23SFrederic Weisbecker 
4483f201ae23SFrederic Weisbecker 	ret_stack_list = kmalloc(FTRACE_RETSTACK_ALLOC_SIZE *
4484f201ae23SFrederic Weisbecker 				sizeof(struct ftrace_ret_stack *),
4485f201ae23SFrederic Weisbecker 				GFP_KERNEL);
4486f201ae23SFrederic Weisbecker 
4487f201ae23SFrederic Weisbecker 	if (!ret_stack_list)
4488f201ae23SFrederic Weisbecker 		return -ENOMEM;
4489f201ae23SFrederic Weisbecker 
44905b058bcdSFrederic Weisbecker 	/* The cpu_boot init_task->ret_stack will never be freed */
4491179c498aSSteven Rostedt 	for_each_online_cpu(cpu) {
4492179c498aSSteven Rostedt 		if (!idle_task(cpu)->ret_stack)
4493868baf07SSteven Rostedt 			ftrace_graph_init_idle_task(idle_task(cpu), cpu);
4494179c498aSSteven Rostedt 	}
44955b058bcdSFrederic Weisbecker 
4496f201ae23SFrederic Weisbecker 	do {
4497f201ae23SFrederic Weisbecker 		ret = alloc_retstack_tasklist(ret_stack_list);
4498f201ae23SFrederic Weisbecker 	} while (ret == -EAGAIN);
4499f201ae23SFrederic Weisbecker 
45008aef2d28SSteven Rostedt 	if (!ret) {
450138516ab5SSteven Rostedt 		ret = register_trace_sched_switch(ftrace_graph_probe_sched_switch, NULL);
45028aef2d28SSteven Rostedt 		if (ret)
45038aef2d28SSteven Rostedt 			pr_info("ftrace_graph: Couldn't activate tracepoint"
45048aef2d28SSteven Rostedt 				" probe to kernel_sched_switch\n");
45058aef2d28SSteven Rostedt 	}
45068aef2d28SSteven Rostedt 
4507f201ae23SFrederic Weisbecker 	kfree(ret_stack_list);
4508f201ae23SFrederic Weisbecker 	return ret;
4509f201ae23SFrederic Weisbecker }
4510f201ae23SFrederic Weisbecker 
45114a2b8ddaSFrederic Weisbecker /*
45124a2b8ddaSFrederic Weisbecker  * Hibernation protection.
45134a2b8ddaSFrederic Weisbecker  * The state of the current task is too much unstable during
45144a2b8ddaSFrederic Weisbecker  * suspend/restore to disk. We want to protect against that.
45154a2b8ddaSFrederic Weisbecker  */
45164a2b8ddaSFrederic Weisbecker static int
45174a2b8ddaSFrederic Weisbecker ftrace_suspend_notifier_call(struct notifier_block *bl, unsigned long state,
45184a2b8ddaSFrederic Weisbecker 							void *unused)
45194a2b8ddaSFrederic Weisbecker {
45204a2b8ddaSFrederic Weisbecker 	switch (state) {
45214a2b8ddaSFrederic Weisbecker 	case PM_HIBERNATION_PREPARE:
45224a2b8ddaSFrederic Weisbecker 		pause_graph_tracing();
45234a2b8ddaSFrederic Weisbecker 		break;
45244a2b8ddaSFrederic Weisbecker 
45254a2b8ddaSFrederic Weisbecker 	case PM_POST_HIBERNATION:
45264a2b8ddaSFrederic Weisbecker 		unpause_graph_tracing();
45274a2b8ddaSFrederic Weisbecker 		break;
45284a2b8ddaSFrederic Weisbecker 	}
45294a2b8ddaSFrederic Weisbecker 	return NOTIFY_DONE;
45304a2b8ddaSFrederic Weisbecker }
45314a2b8ddaSFrederic Weisbecker 
4532287b6e68SFrederic Weisbecker int register_ftrace_graph(trace_func_graph_ret_t retfunc,
4533287b6e68SFrederic Weisbecker 			trace_func_graph_ent_t entryfunc)
453415e6cb36SFrederic Weisbecker {
4535e7d3737eSFrederic Weisbecker 	int ret = 0;
4536e7d3737eSFrederic Weisbecker 
4537e6ea44e9SSteven Rostedt 	mutex_lock(&ftrace_lock);
4538e7d3737eSFrederic Weisbecker 
453905ce5818SSteven Rostedt 	/* we currently allow only one tracer registered at a time */
4540597af815SSteven Rostedt 	if (ftrace_graph_active) {
454105ce5818SSteven Rostedt 		ret = -EBUSY;
454205ce5818SSteven Rostedt 		goto out;
454305ce5818SSteven Rostedt 	}
454405ce5818SSteven Rostedt 
45454a2b8ddaSFrederic Weisbecker 	ftrace_suspend_notifier.notifier_call = ftrace_suspend_notifier_call;
45464a2b8ddaSFrederic Weisbecker 	register_pm_notifier(&ftrace_suspend_notifier);
45474a2b8ddaSFrederic Weisbecker 
4548597af815SSteven Rostedt 	ftrace_graph_active++;
4549fb52607aSFrederic Weisbecker 	ret = start_graph_tracing();
4550f201ae23SFrederic Weisbecker 	if (ret) {
4551597af815SSteven Rostedt 		ftrace_graph_active--;
4552f201ae23SFrederic Weisbecker 		goto out;
4553f201ae23SFrederic Weisbecker 	}
4554e53a6319SSteven Rostedt 
4555287b6e68SFrederic Weisbecker 	ftrace_graph_return = retfunc;
4556287b6e68SFrederic Weisbecker 	ftrace_graph_entry = entryfunc;
4557e53a6319SSteven Rostedt 
4558a1cd6173SSteven Rostedt 	ret = ftrace_startup(&global_ops, FTRACE_START_FUNC_RET);
4559e7d3737eSFrederic Weisbecker 
4560e7d3737eSFrederic Weisbecker out:
4561e6ea44e9SSteven Rostedt 	mutex_unlock(&ftrace_lock);
4562e7d3737eSFrederic Weisbecker 	return ret;
456315e6cb36SFrederic Weisbecker }
456415e6cb36SFrederic Weisbecker 
4565fb52607aSFrederic Weisbecker void unregister_ftrace_graph(void)
456615e6cb36SFrederic Weisbecker {
4567e6ea44e9SSteven Rostedt 	mutex_lock(&ftrace_lock);
4568e7d3737eSFrederic Weisbecker 
4569597af815SSteven Rostedt 	if (unlikely(!ftrace_graph_active))
45702aad1b76SSteven Rostedt 		goto out;
45712aad1b76SSteven Rostedt 
4572597af815SSteven Rostedt 	ftrace_graph_active--;
4573287b6e68SFrederic Weisbecker 	ftrace_graph_return = (trace_func_graph_ret_t)ftrace_stub;
4574e49dc19cSSteven Rostedt 	ftrace_graph_entry = ftrace_graph_entry_stub;
4575bd69c30bSSteven Rostedt 	ftrace_shutdown(&global_ops, FTRACE_STOP_FUNC_RET);
45764a2b8ddaSFrederic Weisbecker 	unregister_pm_notifier(&ftrace_suspend_notifier);
457738516ab5SSteven Rostedt 	unregister_trace_sched_switch(ftrace_graph_probe_sched_switch, NULL);
4578e7d3737eSFrederic Weisbecker 
45792aad1b76SSteven Rostedt  out:
4580e6ea44e9SSteven Rostedt 	mutex_unlock(&ftrace_lock);
458115e6cb36SFrederic Weisbecker }
4582f201ae23SFrederic Weisbecker 
4583868baf07SSteven Rostedt static DEFINE_PER_CPU(struct ftrace_ret_stack *, idle_ret_stack);
4584868baf07SSteven Rostedt 
4585868baf07SSteven Rostedt static void
4586868baf07SSteven Rostedt graph_init_task(struct task_struct *t, struct ftrace_ret_stack *ret_stack)
4587868baf07SSteven Rostedt {
4588868baf07SSteven Rostedt 	atomic_set(&t->tracing_graph_pause, 0);
4589868baf07SSteven Rostedt 	atomic_set(&t->trace_overrun, 0);
4590868baf07SSteven Rostedt 	t->ftrace_timestamp = 0;
459125985edcSLucas De Marchi 	/* make curr_ret_stack visible before we add the ret_stack */
4592868baf07SSteven Rostedt 	smp_wmb();
4593868baf07SSteven Rostedt 	t->ret_stack = ret_stack;
4594868baf07SSteven Rostedt }
4595868baf07SSteven Rostedt 
4596868baf07SSteven Rostedt /*
4597868baf07SSteven Rostedt  * Allocate a return stack for the idle task. May be the first
4598868baf07SSteven Rostedt  * time through, or it may be done by CPU hotplug online.
4599868baf07SSteven Rostedt  */
4600868baf07SSteven Rostedt void ftrace_graph_init_idle_task(struct task_struct *t, int cpu)
4601868baf07SSteven Rostedt {
4602868baf07SSteven Rostedt 	t->curr_ret_stack = -1;
4603868baf07SSteven Rostedt 	/*
4604868baf07SSteven Rostedt 	 * The idle task has no parent, it either has its own
4605868baf07SSteven Rostedt 	 * stack or no stack at all.
4606868baf07SSteven Rostedt 	 */
4607868baf07SSteven Rostedt 	if (t->ret_stack)
4608868baf07SSteven Rostedt 		WARN_ON(t->ret_stack != per_cpu(idle_ret_stack, cpu));
4609868baf07SSteven Rostedt 
4610868baf07SSteven Rostedt 	if (ftrace_graph_active) {
4611868baf07SSteven Rostedt 		struct ftrace_ret_stack *ret_stack;
4612868baf07SSteven Rostedt 
4613868baf07SSteven Rostedt 		ret_stack = per_cpu(idle_ret_stack, cpu);
4614868baf07SSteven Rostedt 		if (!ret_stack) {
4615868baf07SSteven Rostedt 			ret_stack = kmalloc(FTRACE_RETFUNC_DEPTH
4616868baf07SSteven Rostedt 					    * sizeof(struct ftrace_ret_stack),
4617868baf07SSteven Rostedt 					    GFP_KERNEL);
4618868baf07SSteven Rostedt 			if (!ret_stack)
4619868baf07SSteven Rostedt 				return;
4620868baf07SSteven Rostedt 			per_cpu(idle_ret_stack, cpu) = ret_stack;
4621868baf07SSteven Rostedt 		}
4622868baf07SSteven Rostedt 		graph_init_task(t, ret_stack);
4623868baf07SSteven Rostedt 	}
4624868baf07SSteven Rostedt }
4625868baf07SSteven Rostedt 
4626f201ae23SFrederic Weisbecker /* Allocate a return stack for newly created task */
4627fb52607aSFrederic Weisbecker void ftrace_graph_init_task(struct task_struct *t)
4628f201ae23SFrederic Weisbecker {
462984047e36SSteven Rostedt 	/* Make sure we do not use the parent ret_stack */
463084047e36SSteven Rostedt 	t->ret_stack = NULL;
4631ea14eb71SSteven Rostedt 	t->curr_ret_stack = -1;
463284047e36SSteven Rostedt 
4633597af815SSteven Rostedt 	if (ftrace_graph_active) {
463482310a32SSteven Rostedt 		struct ftrace_ret_stack *ret_stack;
463582310a32SSteven Rostedt 
463682310a32SSteven Rostedt 		ret_stack = kmalloc(FTRACE_RETFUNC_DEPTH
4637f201ae23SFrederic Weisbecker 				* sizeof(struct ftrace_ret_stack),
4638f201ae23SFrederic Weisbecker 				GFP_KERNEL);
463982310a32SSteven Rostedt 		if (!ret_stack)
4640f201ae23SFrederic Weisbecker 			return;
4641868baf07SSteven Rostedt 		graph_init_task(t, ret_stack);
464284047e36SSteven Rostedt 	}
4643f201ae23SFrederic Weisbecker }
4644f201ae23SFrederic Weisbecker 
4645fb52607aSFrederic Weisbecker void ftrace_graph_exit_task(struct task_struct *t)
4646f201ae23SFrederic Weisbecker {
4647eae849caSFrederic Weisbecker 	struct ftrace_ret_stack	*ret_stack = t->ret_stack;
4648eae849caSFrederic Weisbecker 
4649f201ae23SFrederic Weisbecker 	t->ret_stack = NULL;
4650eae849caSFrederic Weisbecker 	/* NULL must become visible to IRQs before we free it: */
4651eae849caSFrederic Weisbecker 	barrier();
4652eae849caSFrederic Weisbecker 
4653eae849caSFrederic Weisbecker 	kfree(ret_stack);
4654f201ae23SFrederic Weisbecker }
465514a866c5SSteven Rostedt 
465614a866c5SSteven Rostedt void ftrace_graph_stop(void)
465714a866c5SSteven Rostedt {
465814a866c5SSteven Rostedt 	ftrace_stop();
465914a866c5SSteven Rostedt }
466015e6cb36SFrederic Weisbecker #endif
4661