On Fri, 5 Jan 2024 17:09:10 +0000
Mark Rutland <mark.rutland@xxxxxxx> wrote:
> On Mon, Dec 18, 2023 at 10:13:46PM +0900, Masami Hiramatsu (Google) wrote:
> > From: Steven Rostedt (VMware) <rostedt@xxxxxxxxxxx>
> >
> > Allow for instances to have their own ftrace_ops part of the fgraph_ops
> > that makes the funtion_graph tracer filter on the set_ftrace_filter file
> > of the instance and not the top instance.
> >
> > This also change how the function_graph handles multiple instances on the
> > shadow stack. Previously we use ARRAY type entries to record which one
> > is enabled, and this makes it a bitmap of the fgraph_array's indexes.
> > Previous function_graph_enter() expects calling back from
> > prepare_ftrace_return() function which is called back only once if it is
> > enabled. But this introduces different ftrace_ops for each fgraph
> > instance and those are called from ftrace_graph_func() one by one. Thus
> > we can not loop on the fgraph_array(), and need to reuse the ret_stack
> > pushed by the previous instance. Finding the ret_stack is easy because
> > we can check the ret_stack->func. But that is not enough for the self-
> > recursive tail-call case. Thus fgraph uses the bitmap entry to find it
> > is already set (this means that entry is for previous tail call).
> >
> > Signed-off-by: Steven Rostedt (VMware) <rostedt@xxxxxxxxxxx>
> > Signed-off-by: Masami Hiramatsu (Google) <mhiramat@xxxxxxxxxx>
>
> As a heads-up, while testing the topic/fprobe-on-fgraph branch on arm64, I get
> a warning which bisets down to this commit:
Hmm, so does this happen when enabling function graph tracer?
>
> | Testing tracer function_graph:
> | ------------[ cut here ]------------
> | WARNING: CPU: 2 PID: 0 at arch/arm64/kernel/stacktrace.c:84 arch_stack_walk+0x3c0/0x3d8
> | Modules linked in:
> | CPU: 2 PID: 0 Comm: swapper/2 Not tainted 6.7.0-rc2-00026-gea1e68a341c2 #12
> | Hardware name: linux,dummy-virt (DT)
> | pstate: 604000c5 (nZCv daIF +PAN -UAO -TCO -DIT -SSBS BTYPE=--)
> | pc : arch_stack_walk+0x3c0/0x3d8
> | lr : arch_stack_walk+0x260/0x3d8
> | sp : ffff80008318be00
> | x29: ffff80008318be00 x28: ffff000003c0ae80 x27: 0000000000000000
> | x26: 0000000000000000 x25: ffff000003c0ae80 x24: 0000000000000000
> | x23: ffff8000800234c8 x22: ffff80008002dc30 x21: ffff800080035d10
> | x20: ffff80008318bee8 x19: ffff800080023460 x18: ffff800083453c68
> | x17: 0000000000000000 x16: ffff800083188000 x15: 000000008ccc5058
> | x14: 0000000000000004 x13: ffff800082b8c4f0 x12: 0000000000000000
> | x11: ffff800081fba9b0 x10: ffff80008318bff0 x9 : ffff800080010798
> | x8 : ffff80008002dc30 x7 : ffff000003c0ae80 x6 : 00000000ffffffff
> | x5 : 0000000000000000 x4 : ffff8000832a3c18 x3 : ffff80008318bff0
> | x2 : ffff80008002dc30 x1 : ffff80008002dc30 x0 : ffff80008002dc30
> | Call trace:
> | arch_stack_walk+0x3c0/0x3d8
> | return_address+0x40/0x80
> | trace_hardirqs_on+0x8c/0x198
> | __do_softirq+0xe8/0x440
> | ---[ end trace 0000000000000000 ]---
>
> That's a warning in arm64's unwind_recover_return_address() function, which
> fires when ftrace_graph_ret_addr() finds return_to_handler:
>
> if (state->task->ret_stack &&
> (state->pc == (unsigned long)return_to_handler)) {
> unsigned long orig_pc;
> orig_pc = ftrace_graph_ret_addr(state->task, NULL, state->pc,
> (void *)state->fp);
> if (WARN_ON_ONCE(state->pc == orig_pc))
> return -EINVAL;
> state->pc = orig_pc;
> }
>
> The rationale there is that since tail calls are (currently) disabled on arm64,
> the only reason for ftrace_graph_ret_addr() to return return_to_handler is when
> it fails to find the original return address.
Yes. what about FP check?
>
> Does this change make it legitimate for ftrace_graph_ret_addr() to return
> return_to_handler in other cases, or is that a bug?
It should be a bug to be fixed.
>
> Either way, we'll need *some* way to recover the original return addresss...
At least it needs to dump the shadow stack so that we can analyze what
happened.
Thank you!
>
> Mark.
>
> > ---
> > Changes in v4:
> > - Simplify get_ret_stack() sanity check and use WARN_ON_ONCE() for
> > obviously wrong value.
> > - Do not check ret == return_to_handler but always read the previous
> > ret_stack in ftrace_push_return_trace() to check it is reusable.
> > - Set the bit 0 of the bitmap entry always in function_graph_enter()
> > because it uses bit 0 to check re-usability.
> > - Fix to ensure the ret_stack entry is bitmap type when checking the
> > bitmap.
> > Changes in v3:
> > - Pass current fgraph_ops to the new entry handler
> > (function_graph_enter_ops) if fgraph use ftrace.
> > - Add fgraph_ops::idx in this patch.
> > - Replace the array type with the bitmap type so that it can record
> > which fgraph is called.
> > - Fix some helper function to use passed task_struct instead of current.
> > - Reduce the ret-index size to 1024 words.
> > - Make the ret-index directly points the ret_stack.
> > - Fix ftrace_graph_ret_addr() to handle tail-call case correctly.
> > Changes in v2:
> > - Use ftrace_graph_func and FTRACE_OPS_GRAPH_STUB instead of
> > ftrace_stub and FTRACE_OPS_FL_STUB for new ftrace based fgraph.
> > ---
> > arch/arm64/kernel/ftrace.c | 19 ++
> > arch/x86/kernel/ftrace.c | 19 ++
> > include/linux/ftrace.h | 7 +
> > kernel/trace/fgraph.c | 369 ++++++++++++++++++++--------------
> > kernel/trace/ftrace.c | 6 -
> > kernel/trace/trace.h | 16 +
> > kernel/trace/trace_functions.c | 2
> > kernel/trace/trace_functions_graph.c | 8 +
> > 8 files changed, 277 insertions(+), 169 deletions(-)
> >
> > diff --git a/arch/arm64/kernel/ftrace.c b/arch/arm64/kernel/ftrace.c
> > index a650f5e11fc5..205937e04ece 100644
> > --- a/arch/arm64/kernel/ftrace.c
> > +++ b/arch/arm64/kernel/ftrace.c
> > @@ -481,7 +481,24 @@ void prepare_ftrace_return(unsigned long self_addr, unsigned long *parent,
> > void ftrace_graph_func(unsigned long ip, unsigned long parent_ip,
> > struct ftrace_ops *op, struct ftrace_regs *fregs)
> > {
> > - prepare_ftrace_return(ip, &fregs->lr, fregs->fp);
> > + unsigned long *parent = &fregs->lr;
> > + struct fgraph_ops *gops = container_of(op, struct fgraph_ops, ops);
> > + int bit;
> > +
> > + if (unlikely(ftrace_graph_is_dead()))
> > + return;
> > +
> > + if (unlikely(atomic_read(¤t->tracing_graph_pause)))
> > + return;
> > +
> > + bit = ftrace_test_recursion_trylock(ip, *parent);
> > + if (bit < 0)
> > + return;
> > +
> > + if (!function_graph_enter_ops(*parent, ip, fregs->fp, parent, gops))
> > + *parent = (unsigned long)&return_to_handler;
> > +
> > + ftrace_test_recursion_unlock(bit);
> > }
> > #else
> > /*
> > diff --git a/arch/x86/kernel/ftrace.c b/arch/x86/kernel/ftrace.c
> > index 12df54ff0e81..845e29b4254f 100644
> > --- a/arch/x86/kernel/ftrace.c
> > +++ b/arch/x86/kernel/ftrace.c
> > @@ -657,9 +657,24 @@ void ftrace_graph_func(unsigned long ip, unsigned long parent_ip,
> > struct ftrace_ops *op, struct ftrace_regs *fregs)
> > {
> > struct pt_regs *regs = &fregs->regs;
> > - unsigned long *stack = (unsigned long *)kernel_stack_pointer(regs);
> > + unsigned long *parent = (unsigned long *)kernel_stack_pointer(regs);
> > + struct fgraph_ops *gops = container_of(op, struct fgraph_ops, ops);
> > + int bit;
> > +
> > + if (unlikely(ftrace_graph_is_dead()))
> > + return;
> > +
> > + if (unlikely(atomic_read(¤t->tracing_graph_pause)))
> > + return;
> >
> > - prepare_ftrace_return(ip, (unsigned long *)stack, 0);
> > + bit = ftrace_test_recursion_trylock(ip, *parent);
> > + if (bit < 0)
> > + return;
> > +
> > + if (!function_graph_enter_ops(*parent, ip, 0, parent, gops))
> > + *parent = (unsigned long)&return_to_handler;
> > +
> > + ftrace_test_recursion_unlock(bit);
> > }
> > #endif
> >
> > diff --git a/include/linux/ftrace.h b/include/linux/ftrace.h
> > index 7b08169aa51d..c431a33fe789 100644
> > --- a/include/linux/ftrace.h
> > +++ b/include/linux/ftrace.h
> > @@ -1070,7 +1070,9 @@ extern int ftrace_graph_entry_stub(struct ftrace_graph_ent *trace, struct fgraph
> > struct fgraph_ops {
> > trace_func_graph_ent_t entryfunc;
> > trace_func_graph_ret_t retfunc;
> > + struct ftrace_ops ops; /* for the hash lists */
> > void *private;
> > + int idx;
> > };
> >
> > /*
> > @@ -1104,6 +1106,11 @@ extern int
> > function_graph_enter(unsigned long ret, unsigned long func,
> > unsigned long frame_pointer, unsigned long *retp);
> >
> > +extern int
> > +function_graph_enter_ops(unsigned long ret, unsigned long func,
> > + unsigned long frame_pointer, unsigned long *retp,
> > + struct fgraph_ops *gops);
> > +
> > struct ftrace_ret_stack *
> > ftrace_graph_get_ret_stack(struct task_struct *task, int idx);
> >
> > diff --git a/kernel/trace/fgraph.c b/kernel/trace/fgraph.c
> > index 62c35d6d95f9..6f537ebd3ed7 100644
> > --- a/kernel/trace/fgraph.c
> > +++ b/kernel/trace/fgraph.c
> > @@ -7,6 +7,7 @@
> > *
> > * Highly modified by Steven Rostedt (VMware).
> > */
> > +#include <linux/bits.h>
> > #include <linux/jump_label.h>
> > #include <linux/suspend.h>
> > #include <linux/ftrace.h>
> > @@ -17,22 +18,15 @@
> > #include "ftrace_internal.h"
> > #include "trace.h"
> >
> > -#ifdef CONFIG_DYNAMIC_FTRACE
> > -#define ASSIGN_OPS_HASH(opsname, val) \
> > - .func_hash = val, \
> > - .local_hash.regex_lock = __MUTEX_INITIALIZER(opsname.local_hash.regex_lock),
> > -#else
> > -#define ASSIGN_OPS_HASH(opsname, val)
> > -#endif
> > -
> > #define FGRAPH_RET_SIZE sizeof(struct ftrace_ret_stack)
> > #define FGRAPH_RET_INDEX (FGRAPH_RET_SIZE / sizeof(long))
> >
> > /*
> > * On entry to a function (via function_graph_enter()), a new ftrace_ret_stack
> > - * is allocated on the task's ret_stack, then each fgraph_ops on the
> > - * fgraph_array[]'s entryfunc is called and if that returns non-zero, the
> > - * index into the fgraph_array[] for that fgraph_ops is added to the ret_stack.
> > + * is allocated on the task's ret_stack with indexes entry, then each
> > + * fgraph_ops on the fgraph_array[]'s entryfunc is called and if that returns
> > + * non-zero, the index into the fgraph_array[] for that fgraph_ops is recorded
> > + * on the indexes entry as a bit flag.
> > * As the associated ftrace_ret_stack saved for those fgraph_ops needs to
> > * be found, the index to it is also added to the ret_stack along with the
> > * index of the fgraph_array[] to each fgraph_ops that needs their retfunc
> > @@ -42,61 +36,59 @@
> > * to the last ftrace_ret_stack saved. All references to the
> > * ftrace_ret_stack has the format of:
> > *
> > - * bits: 0 - 13 Index in words from the previous ftrace_ret_stack
> > - * bits: 14 - 15 Type of storage
> > + * bits: 0 - 9 offset in words from the previous ftrace_ret_stack
> > + * (bitmap type should have FGRAPH_RET_INDEX always)
> > + * bits: 10 - 11 Type of storage
> > * 0 - reserved
> > - * 1 - fgraph_array index
> > - * For fgraph_array_index:
> > - * bits: 16 - 23 The fgraph_ops fgraph_array index
> > + * 1 - bitmap of fgraph_array index
> > + *
> > + * For bitmap of fgraph_array index
> > + * bits: 12 - 27 The bitmap of fgraph_ops fgraph_array index
> > *
> > * That is, at the end of function_graph_enter, if the first and forth
> > * fgraph_ops on the fgraph_array[] (index 0 and 3) needs their retfunc called
> > * on the return of the function being traced, this is what will be on the
> > * task's shadow ret_stack: (the stack grows upward)
> > *
> > - * | | <- task->curr_ret_stack
> > - * +----------------------------------+
> > - * | (3 << FGRAPH_ARRAY_SHIFT)|(2) | ( 3 for index of fourth fgraph_ops)
> > - * +----------------------------------+
> > - * | (0 << FGRAPH_ARRAY_SHIFT)|(1) | ( 0 for index of first fgraph_ops)
> > - * +----------------------------------+
> > - * | struct ftrace_ret_stack |
> > - * | (stores the saved ret pointer) |
> > - * +----------------------------------+
> > - * | (X) | (N) | ( N words away from previous ret_stack)
> > - * | |
> > + * | | <- task->curr_ret_stack
> > + * +--------------------------------------------+
> > + * | bitmap_type(bitmap:(BIT(3)|BIT(0)), |
> > + * | offset:FGRAPH_RET_INDEX) | <- the offset is from here
> > + * +--------------------------------------------+
> > + * | struct ftrace_ret_stack |
> > + * | (stores the saved ret pointer) | <- the offset points here
> > + * +--------------------------------------------+
> > + * | (X) | (N) | ( N words away from
> > + * | | previous ret_stack)
> > *
> > * If a backtrace is required, and the real return pointer needs to be
> > * fetched, then it looks at the task's curr_ret_stack index, if it
> > - * is greater than zero, it would subtact one, and then mask the value
> > - * on the ret_stack by FGRAPH_RET_INDEX_MASK and subtract FGRAPH_RET_INDEX
> > - * from that, to get the index of the ftrace_ret_stack structure stored
> > - * on the shadow stack.
> > + * is greater than zero (reserved, or right before poped), it would mask
> > + * the value by FGRAPH_RET_INDEX_MASK to get the offset index of the
> > + * ftrace_ret_stack structure stored on the shadow stack.
> > */
> >
> > -#define FGRAPH_RET_INDEX_SIZE 14
> > -#define FGRAPH_RET_INDEX_MASK ((1 << FGRAPH_RET_INDEX_SIZE) - 1)
> > -
> > +#define FGRAPH_RET_INDEX_SIZE 10
> > +#define FGRAPH_RET_INDEX_MASK GENMASK(FGRAPH_RET_INDEX_SIZE - 1, 0)
> >
> > #define FGRAPH_TYPE_SIZE 2
> > -#define FGRAPH_TYPE_MASK ((1 << FGRAPH_TYPE_SIZE) - 1)
> > +#define FGRAPH_TYPE_MASK GENMASK(FGRAPH_TYPE_SIZE - 1, 0)
> > #define FGRAPH_TYPE_SHIFT FGRAPH_RET_INDEX_SIZE
> >
> > enum {
> > FGRAPH_TYPE_RESERVED = 0,
> > - FGRAPH_TYPE_ARRAY = 1,
> > + FGRAPH_TYPE_BITMAP = 1,
> > };
> >
> > -#define FGRAPH_ARRAY_SIZE 16
> > -#define FGRAPH_ARRAY_MASK ((1 << FGRAPH_ARRAY_SIZE) - 1)
> > -#define FGRAPH_ARRAY_SHIFT (FGRAPH_TYPE_SHIFT + FGRAPH_TYPE_SIZE)
> > +#define FGRAPH_INDEX_SIZE 16
> > +#define FGRAPH_INDEX_MASK GENMASK(FGRAPH_INDEX_SIZE - 1, 0)
> > +#define FGRAPH_INDEX_SHIFT (FGRAPH_TYPE_SHIFT + FGRAPH_TYPE_SIZE)
> >
> > /* Currently the max stack index can't be more than register callers */
> > -#define FGRAPH_MAX_INDEX FGRAPH_ARRAY_SIZE
> > +#define FGRAPH_MAX_INDEX (FGRAPH_INDEX_SIZE + FGRAPH_RET_INDEX)
> > +
> > +#define FGRAPH_ARRAY_SIZE FGRAPH_INDEX_SIZE
> >
> > -#define FGRAPH_FRAME_SIZE (FGRAPH_RET_SIZE + FGRAPH_ARRAY_SIZE * (sizeof(long)))
> > -#define FGRAPH_FRAME_INDEX (ALIGN(FGRAPH_FRAME_SIZE, \
> > - sizeof(long)) / sizeof(long))
> > #define SHADOW_STACK_SIZE (PAGE_SIZE)
> > #define SHADOW_STACK_INDEX (SHADOW_STACK_SIZE / sizeof(long))
> > /* Leave on a buffer at the end */
> > @@ -113,19 +105,36 @@ static struct fgraph_ops *fgraph_array[FGRAPH_ARRAY_SIZE];
> >
> > static inline int get_ret_stack_index(struct task_struct *t, int offset)
> > {
> > - return current->ret_stack[offset] & FGRAPH_RET_INDEX_MASK;
> > + return t->ret_stack[offset] & FGRAPH_RET_INDEX_MASK;
> > }
> >
> > static inline int get_fgraph_type(struct task_struct *t, int offset)
> > {
> > - return (current->ret_stack[offset] >> FGRAPH_TYPE_SHIFT) &
> > - FGRAPH_TYPE_MASK;
> > + return (t->ret_stack[offset] >> FGRAPH_TYPE_SHIFT) & FGRAPH_TYPE_MASK;
> > +}
> > +
> > +static inline unsigned long
> > +get_fgraph_index_bitmap(struct task_struct *t, int offset)
> > +{
> > + return (t->ret_stack[offset] >> FGRAPH_INDEX_SHIFT) & FGRAPH_INDEX_MASK;
> > }
> >
> > -static inline int get_fgraph_array(struct task_struct *t, int offset)
> > +static inline void
> > +set_fgraph_index_bitmap(struct task_struct *t, int offset, unsigned long bitmap)
> > {
> > - return (current->ret_stack[offset] >> FGRAPH_ARRAY_SHIFT) &
> > - FGRAPH_ARRAY_MASK;
> > + t->ret_stack[offset] = (bitmap << FGRAPH_INDEX_SHIFT) |
> > + (FGRAPH_TYPE_BITMAP << FGRAPH_TYPE_SHIFT) | FGRAPH_RET_INDEX;
> > +}
> > +
> > +static inline bool is_fgraph_index_set(struct task_struct *t, int offset, int idx)
> > +{
> > + return !!(get_fgraph_index_bitmap(t, offset) & BIT(idx));
> > +}
> > +
> > +static inline void
> > +add_fgraph_index_bitmap(struct task_struct *t, int offset, unsigned long bitmap)
> > +{
> > + t->ret_stack[offset] |= (bitmap << FGRAPH_INDEX_SHIFT);
> > }
> >
> > /* ftrace_graph_entry set to this to tell some archs to run function graph */
> > @@ -160,17 +169,14 @@ get_ret_stack(struct task_struct *t, int offset, int *index)
> >
> > BUILD_BUG_ON(FGRAPH_RET_SIZE % sizeof(long));
> >
> > - if (offset <= 0)
> > + if (unlikely(offset <= 0))
> > return NULL;
> >
> > - idx = get_ret_stack_index(t, offset - 1);
> > -
> > - if (idx <= 0 || idx > FGRAPH_MAX_INDEX)
> > + idx = get_ret_stack_index(t, --offset);
> > + if (WARN_ON_ONCE(idx <= 0 || idx > offset))
> > return NULL;
> >
> > - offset -= idx + FGRAPH_RET_INDEX;
> > - if (offset < 0)
> > - return NULL;
> > + offset -= idx;
> >
> > *index = offset;
> > return RET_STACK(t, offset);
> > @@ -231,10 +237,12 @@ void ftrace_graph_stop(void)
> > /* Add a function return address to the trace stack on thread info.*/
> > static int
> > ftrace_push_return_trace(unsigned long ret, unsigned long func,
> > - unsigned long frame_pointer, unsigned long *retp)
> > + unsigned long frame_pointer, unsigned long *retp,
> > + int fgraph_idx)
> > {
> > struct ftrace_ret_stack *ret_stack;
> > unsigned long long calltime;
> > + unsigned long val;
> > int index;
> >
> > if (unlikely(ftrace_graph_is_dead()))
> > @@ -243,6 +251,21 @@ ftrace_push_return_trace(unsigned long ret, unsigned long func,
> > if (!current->ret_stack)
> > return -EBUSY;
> >
> > + /*
> > + * At first, check whether the previous fgraph callback is pushed by
> > + * the fgraph on the same function entry.
> > + * But if @func is the self tail-call function, we also need to ensure
> > + * the ret_stack is not for the previous call by checking whether the
> > + * bit of @fgraph_idx is set or not.
> > + */
> > + ret_stack = get_ret_stack(current, current->curr_ret_stack, &index);
> > + if (ret_stack && ret_stack->func == func &&
> > + get_fgraph_type(current, index + FGRAPH_RET_INDEX) == FGRAPH_TYPE_BITMAP &&
> > + !is_fgraph_index_set(current, index + FGRAPH_RET_INDEX, fgraph_idx))
> > + return index + FGRAPH_RET_INDEX;
> > +
> > + val = (FGRAPH_TYPE_RESERVED << FGRAPH_TYPE_SHIFT) | FGRAPH_RET_INDEX;
> > +
> > BUILD_BUG_ON(SHADOW_STACK_SIZE % sizeof(long));
> >
> > /*
> > @@ -252,17 +275,19 @@ ftrace_push_return_trace(unsigned long ret, unsigned long func,
> > smp_rmb();
> >
> > /* The return trace stack is full */
> > - if (current->curr_ret_stack >= SHADOW_STACK_MAX_INDEX) {
> > + if (current->curr_ret_stack + FGRAPH_RET_INDEX >= SHADOW_STACK_MAX_INDEX) {
> > atomic_inc(¤t->trace_overrun);
> > return -EBUSY;
> > }
> >
> > calltime = trace_clock_local();
> >
> > - index = current->curr_ret_stack;
> > - /* ret offset = 1 ; type = reserved */
> > - current->ret_stack[index + FGRAPH_RET_INDEX] = 1;
> > + index = READ_ONCE(current->curr_ret_stack);
> > ret_stack = RET_STACK(current, index);
> > + index += FGRAPH_RET_INDEX;
> > +
> > + /* ret offset = FGRAPH_RET_INDEX ; type = reserved */
> > + current->ret_stack[index] = val;
> > ret_stack->ret = ret;
> > /*
> > * The unwinders expect curr_ret_stack to point to either zero
> > @@ -278,7 +303,7 @@ ftrace_push_return_trace(unsigned long ret, unsigned long func,
> > * at least a correct index!
> > */
> > barrier();
> > - current->curr_ret_stack += FGRAPH_RET_INDEX + 1;
> > + current->curr_ret_stack = index + 1;
> > /*
> > * This next barrier is to ensure that an interrupt coming in
> > * will not corrupt what we are about to write.
> > @@ -286,7 +311,7 @@ ftrace_push_return_trace(unsigned long ret, unsigned long func,
> > barrier();
> >
> > /* Still keep it reserved even if an interrupt came in */
> > - current->ret_stack[index + FGRAPH_RET_INDEX] = 1;
> > + current->ret_stack[index] = val;
> >
> > ret_stack->ret = ret;
> > ret_stack->func = func;
> > @@ -297,7 +322,7 @@ ftrace_push_return_trace(unsigned long ret, unsigned long func,
> > #ifdef HAVE_FUNCTION_GRAPH_RET_ADDR_PTR
> > ret_stack->retp = retp;
> > #endif
> > - return 0;
> > + return index;
> > }
> >
> > /*
> > @@ -314,15 +339,13 @@ ftrace_push_return_trace(unsigned long ret, unsigned long func,
> > # define MCOUNT_INSN_SIZE 0
> > #endif
> >
> > +/* If the caller does not use ftrace, call this function. */
> > int function_graph_enter(unsigned long ret, unsigned long func,
> > unsigned long frame_pointer, unsigned long *retp)
> > {
> > struct ftrace_graph_ent trace;
> > - int offset;
> > - int start;
> > - int type;
> > - int val;
> > - int cnt = 0;
> > + unsigned long bitmap = 0;
> > + int index;
> > int i;
> >
> > #ifndef CONFIG_HAVE_DYNAMIC_FTRACE_WITH_ARGS
> > @@ -337,69 +360,33 @@ int function_graph_enter(unsigned long ret, unsigned long func,
> > return -EBUSY;
> > #endif
> >
> > - if (!ftrace_ops_test(&global_ops, func, NULL))
> > - return -EBUSY;
> > -
> > trace.func = func;
> > trace.depth = ++current->curr_ret_depth;
> >
> > - if (ftrace_push_return_trace(ret, func, frame_pointer, retp))
> > + index = ftrace_push_return_trace(ret, func, frame_pointer, retp, 0);
> > + if (index < 0)
> > goto out;
> >
> > - /* Use start for the distance to ret_stack (skipping over reserve) */
> > - start = offset = current->curr_ret_stack - 2;
> > -
> > for (i = 0; i < fgraph_array_cnt; i++) {
> > struct fgraph_ops *gops = fgraph_array[i];
> >
> > if (gops == &fgraph_stub)
> > continue;
> >
> > - if ((offset == start) &&
> > - (current->curr_ret_stack >= SHADOW_STACK_INDEX - 1)) {
> > - atomic_inc(¤t->trace_overrun);
> > - break;
> > - }
> > - if (fgraph_array[i]->entryfunc(&trace, fgraph_array[i])) {
> > - offset = current->curr_ret_stack;
> > - /* Check the top level stored word */
> > - type = get_fgraph_type(current, offset - 1);
> > -
> > - val = (i << FGRAPH_ARRAY_SHIFT) |
> > - (FGRAPH_TYPE_ARRAY << FGRAPH_TYPE_SHIFT) |
> > - ((offset - start) - 1);
> > -
> > - /* We can reuse the top word if it is reserved */
> > - if (type == FGRAPH_TYPE_RESERVED) {
> > - current->ret_stack[offset - 1] = val;
> > - cnt++;
> > - continue;
> > - }
> > - val++;
> > -
> > - current->ret_stack[offset] = val;
> > - /*
> > - * Write the value before we increment, so that
> > - * if an interrupt comes in after we increment
> > - * it will still see the value and skip over
> > - * this.
> > - */
> > - barrier();
> > - current->curr_ret_stack++;
> > - /*
> > - * Have to write again, in case an interrupt
> > - * came in before the increment and after we
> > - * wrote the value.
> > - */
> > - barrier();
> > - current->ret_stack[offset] = val;
> > - cnt++;
> > - }
> > + if (ftrace_ops_test(&gops->ops, func, NULL) &&
> > + gops->entryfunc(&trace, gops))
> > + bitmap |= BIT(i);
> > }
> >
> > - if (!cnt)
> > + if (!bitmap)
> > goto out_ret;
> >
> > + /*
> > + * Since this function uses fgraph_idx = 0 as a tail-call checking
> > + * flag, set that bit always.
> > + */
> > + set_fgraph_index_bitmap(current, index, bitmap | BIT(0));
> > +
> > return 0;
> > out_ret:
> > current->curr_ret_stack -= FGRAPH_RET_INDEX + 1;
> > @@ -408,15 +395,51 @@ int function_graph_enter(unsigned long ret, unsigned long func,
> > return -EBUSY;
> > }
> >
> > +/* This is called from ftrace_graph_func() via ftrace */
> > +int function_graph_enter_ops(unsigned long ret, unsigned long func,
> > + unsigned long frame_pointer, unsigned long *retp,
> > + struct fgraph_ops *gops)
> > +{
> > + struct ftrace_graph_ent trace;
> > + int index;
> > + int type;
> > +
> > +
> > + /* Use start for the distance to ret_stack (skipping over reserve) */
> > + index = ftrace_push_return_trace(ret, func, frame_pointer, retp, gops->idx);
> > + if (index < 0)
> > + return index;
> > + type = get_fgraph_type(current, index);
> > +
> > + /* This is the first ret_stack for this fentry */
> > + if (type == FGRAPH_TYPE_RESERVED)
> > + ++current->curr_ret_depth;
> > +
> > + trace.func = func;
> > + trace.depth = current->curr_ret_depth;
> > + if (gops->entryfunc(&trace, gops)) {
> > + if (type == FGRAPH_TYPE_RESERVED)
> > + set_fgraph_index_bitmap(current, index, BIT(gops->idx));
> > + else
> > + add_fgraph_index_bitmap(current, index, BIT(gops->idx));
> > + return 0;
> > + }
> > +
> > + if (type == FGRAPH_TYPE_RESERVED) {
> > + current->curr_ret_stack -= FGRAPH_RET_INDEX + 1;
> > + current->curr_ret_depth--;
> > + }
> > + return -EBUSY;
> > +}
> > +
> > /* Retrieve a function return address to the trace stack on thread info.*/
> > static struct ftrace_ret_stack *
> > ftrace_pop_return_trace(struct ftrace_graph_ret *trace, unsigned long *ret,
> > - unsigned long frame_pointer)
> > + unsigned long frame_pointer, int *index)
> > {
> > struct ftrace_ret_stack *ret_stack;
> > - int index;
> >
> > - ret_stack = get_ret_stack(current, current->curr_ret_stack, &index);
> > + ret_stack = get_ret_stack(current, current->curr_ret_stack, index);
> >
> > if (unlikely(!ret_stack)) {
> > ftrace_graph_stop();
> > @@ -455,6 +478,7 @@ ftrace_pop_return_trace(struct ftrace_graph_ret *trace, unsigned long *ret,
> > }
> > #endif
> >
> > + *index += FGRAPH_RET_INDEX;
> > *ret = ret_stack->ret;
> > trace->func = ret_stack->func;
> > trace->calltime = ret_stack->calltime;
> > @@ -507,13 +531,12 @@ static unsigned long __ftrace_return_to_handler(struct fgraph_ret_regs *ret_regs
> > {
> > struct ftrace_ret_stack *ret_stack;
> > struct ftrace_graph_ret trace;
> > + unsigned long bitmap;
> > unsigned long ret;
> > - int offset;
> > int index;
> > - int idx;
> > int i;
> >
> > - ret_stack = ftrace_pop_return_trace(&trace, &ret, frame_pointer);
> > + ret_stack = ftrace_pop_return_trace(&trace, &ret, frame_pointer, &index);
> >
> > if (unlikely(!ret_stack)) {
> > ftrace_graph_stop();
> > @@ -527,16 +550,17 @@ static unsigned long __ftrace_return_to_handler(struct fgraph_ret_regs *ret_regs
> > trace.retval = fgraph_ret_regs_return_value(ret_regs);
> > #endif
> >
> > - offset = current->curr_ret_stack - 1;
> > - index = get_ret_stack_index(current, offset);
> > + bitmap = get_fgraph_index_bitmap(current, index);
> > + for (i = 0; i < FGRAPH_ARRAY_SIZE; i++) {
> > + struct fgraph_ops *gops = fgraph_array[i];
> >
> > - /* index has to be at least one! Optimize for it */
> > - i = 0;
> > - do {
> > - idx = get_fgraph_array(current, offset - i);
> > - fgraph_array[idx]->retfunc(&trace, fgraph_array[idx]);
> > - i++;
> > - } while (i < index);
> > + if (!(bitmap & BIT(i)))
> > + continue;
> > + if (gops == &fgraph_stub)
> > + continue;
> > +
> > + gops->retfunc(&trace, gops);
> > + }
> >
> > /*
> > * The ftrace_graph_return() may still access the current
> > @@ -544,7 +568,7 @@ static unsigned long __ftrace_return_to_handler(struct fgraph_ret_regs *ret_regs
> > * curr_ret_stack is after that.
> > */
> > barrier();
> > - current->curr_ret_stack -= index + FGRAPH_RET_INDEX;
> > + current->curr_ret_stack -= FGRAPH_RET_INDEX + 1;
> > current->curr_ret_depth--;
> > return ret;
> > }
> > @@ -622,7 +646,17 @@ unsigned long ftrace_graph_ret_addr(struct task_struct *task, int *idx,
> > ret_stack = get_ret_stack(current, i, &i);
> > if (!ret_stack)
> > break;
> > - if (ret_stack->retp == retp)
> > + /*
> > + * For the tail-call, there would be 2 or more ftrace_ret_stacks on
> > + * the ret_stack, which records "return_to_handler" as the return
> > + * address excpt for the last one.
> > + * But on the real stack, there should be 1 entry because tail-call
> > + * reuses the return address on the stack and jump to the next function.
> > + * Thus we will continue to find real return address.
> > + */
> > + if (ret_stack->retp == retp &&
> > + ret_stack->ret !=
> > + (unsigned long)dereference_kernel_function_descriptor(return_to_handler))
> > return ret_stack->ret;
> > }
> >
> > @@ -645,6 +679,9 @@ unsigned long ftrace_graph_ret_addr(struct task_struct *task, int *idx,
> > i = *idx;
> > do {
> > ret_stack = get_ret_stack(task, task_idx, &task_idx);
> > + if (ret_stack && ret_stack->ret ==
> > + (unsigned long)dereference_kernel_function_descriptor(return_to_handler))
> > + continue;
> > i--;
> > } while (i >= 0 && ret_stack);
> >
> > @@ -655,17 +692,25 @@ unsigned long ftrace_graph_ret_addr(struct task_struct *task, int *idx,
> > }
> > #endif /* HAVE_FUNCTION_GRAPH_RET_ADDR_PTR */
> >
> > -static struct ftrace_ops graph_ops = {
> > - .func = ftrace_graph_func,
> > - .flags = FTRACE_OPS_FL_INITIALIZED |
> > - FTRACE_OPS_FL_PID |
> > - FTRACE_OPS_GRAPH_STUB,
> > +void fgraph_init_ops(struct ftrace_ops *dst_ops,
> > + struct ftrace_ops *src_ops)
> > +{
> > + dst_ops->func = ftrace_graph_func;
> > + dst_ops->flags = FTRACE_OPS_FL_PID | FTRACE_OPS_GRAPH_STUB;
> > +
> > #ifdef FTRACE_GRAPH_TRAMP_ADDR
> > - .trampoline = FTRACE_GRAPH_TRAMP_ADDR,
> > + dst_ops->trampoline = FTRACE_GRAPH_TRAMP_ADDR;
> > /* trampoline_size is only needed for dynamically allocated tramps */
> > #endif
> > - ASSIGN_OPS_HASH(graph_ops, &global_ops.local_hash)
> > -};
> > +
> > +#ifdef CONFIG_DYNAMIC_FTRACE
> > + if (src_ops) {
> > + dst_ops->func_hash = &src_ops->local_hash;
> > + mutex_init(&dst_ops->local_hash.regex_lock);
> > + dst_ops->flags |= FTRACE_OPS_FL_INITIALIZED;
> > + }
> > +#endif
> > +}
> >
> > void ftrace_graph_sleep_time_control(bool enable)
> > {
> > @@ -869,11 +914,20 @@ static int start_graph_tracing(void)
> >
> > int register_ftrace_graph(struct fgraph_ops *gops)
> > {
> > + int command = 0;
> > int ret = 0;
> > int i;
> >
> > mutex_lock(&ftrace_lock);
> >
> > + if (!gops->ops.func) {
> > + gops->ops.flags |= FTRACE_OPS_GRAPH_STUB;
> > + gops->ops.func = ftrace_graph_func;
> > +#ifdef FTRACE_GRAPH_TRAMP_ADDR
> > + gops->ops.trampoline = FTRACE_GRAPH_TRAMP_ADDR;
> > +#endif
> > + }
> > +
> > if (!fgraph_array[0]) {
> > /* The array must always have real data on it */
> > for (i = 0; i < FGRAPH_ARRAY_SIZE; i++)
> > @@ -893,6 +947,7 @@ int register_ftrace_graph(struct fgraph_ops *gops)
> > fgraph_array[i] = gops;
> > if (i + 1 > fgraph_array_cnt)
> > fgraph_array_cnt = i + 1;
> > + gops->idx = i;
> >
> > ftrace_graph_active++;
> >
> > @@ -909,9 +964,10 @@ int register_ftrace_graph(struct fgraph_ops *gops)
> > */
> > ftrace_graph_return = return_run;
> > ftrace_graph_entry = entry_run;
> > -
> > - ret = ftrace_startup(&graph_ops, FTRACE_START_FUNC_RET);
> > + command = FTRACE_START_FUNC_RET;
> > }
> > +
> > + ret = ftrace_startup(&gops->ops, command);
> > out:
> > mutex_unlock(&ftrace_lock);
> > return ret;
> > @@ -919,6 +975,7 @@ int register_ftrace_graph(struct fgraph_ops *gops)
> >
> > void unregister_ftrace_graph(struct fgraph_ops *gops)
> > {
> > + int command = 0;
> > int i;
> >
> > mutex_lock(&ftrace_lock);
> > @@ -926,25 +983,29 @@ void unregister_ftrace_graph(struct fgraph_ops *gops)
> > if (unlikely(!ftrace_graph_active))
> > goto out;
> >
> > - for (i = 0; i < fgraph_array_cnt; i++)
> > - if (gops == fgraph_array[i])
> > - break;
> > - if (i >= fgraph_array_cnt)
> > + if (unlikely(gops->idx < 0 || gops->idx >= fgraph_array_cnt))
> > goto out;
> >
> > - fgraph_array[i] = &fgraph_stub;
> > - if (i + 1 == fgraph_array_cnt) {
> > - for (; i >= 0; i--)
> > - if (fgraph_array[i] != &fgraph_stub)
> > - break;
> > + WARN_ON_ONCE(fgraph_array[gops->idx] != gops);
> > +
> > + fgraph_array[gops->idx] = &fgraph_stub;
> > + if (gops->idx + 1 == fgraph_array_cnt) {
> > + i = gops->idx;
> > + while (i >= 0 && fgraph_array[i] == &fgraph_stub)
> > + i--;
> > fgraph_array_cnt = i + 1;
> > }
> >
> > ftrace_graph_active--;
> > +
> > + if (!ftrace_graph_active)
> > + command = FTRACE_STOP_FUNC_RET;
> > +
> > + ftrace_shutdown(&gops->ops, command);
> > +
> > if (!ftrace_graph_active) {
> > ftrace_graph_return = ftrace_stub_graph;
> > ftrace_graph_entry = ftrace_graph_entry_stub;
> > - ftrace_shutdown(&graph_ops, FTRACE_STOP_FUNC_RET);
> > unregister_pm_notifier(&ftrace_suspend_notifier);
> > unregister_trace_sched_switch(ftrace_graph_probe_sched_switch, NULL);
> > }
> > diff --git a/kernel/trace/ftrace.c b/kernel/trace/ftrace.c
> > index 83fbfb7b48f8..c4cc2a9d0047 100644
> > --- a/kernel/trace/ftrace.c
> > +++ b/kernel/trace/ftrace.c
> > @@ -3050,6 +3050,8 @@ int ftrace_startup(struct ftrace_ops *ops, int command)
> > if (unlikely(ftrace_disabled))
> > return -ENODEV;
> >
> > + ftrace_ops_init(ops);
> > +
> > ret = __register_ftrace_function(ops);
> > if (ret)
> > return ret;
> > @@ -7319,7 +7321,7 @@ __init void ftrace_init_global_array_ops(struct trace_array *tr)
> > tr->ops = &global_ops;
> > tr->ops->private = tr;
> > ftrace_init_trace_array(tr);
> > - init_array_fgraph_ops(tr);
> > + init_array_fgraph_ops(tr, tr->ops);
> > }
> >
> > void ftrace_init_array_ops(struct trace_array *tr, ftrace_func_t func)
> > @@ -8051,7 +8053,7 @@ static int register_ftrace_function_nolock(struct ftrace_ops *ops)
> > */
> > int register_ftrace_function(struct ftrace_ops *ops)
> > {
> > - int ret;
> > + int ret = -1;
> >
> > lock_direct_mutex();
> > ret = prepare_direct_functions_for_ipmodify(ops);
> > diff --git a/kernel/trace/trace.h b/kernel/trace/trace.h
> > index 16948c0ed00a..02edfdb68933 100644
> > --- a/kernel/trace/trace.h
> > +++ b/kernel/trace/trace.h
> > @@ -890,8 +890,8 @@ extern int __trace_graph_entry(struct trace_array *tr,
> > extern void __trace_graph_return(struct trace_array *tr,
> > struct ftrace_graph_ret *trace,
> > unsigned int trace_ctx);
> > -extern void init_array_fgraph_ops(struct trace_array *tr);
> > -extern int allocate_fgraph_ops(struct trace_array *tr);
> > +extern void init_array_fgraph_ops(struct trace_array *tr, struct ftrace_ops *ops);
> > +extern int allocate_fgraph_ops(struct trace_array *tr, struct ftrace_ops *ops);
> > extern void free_fgraph_ops(struct trace_array *tr);
> >
> > #ifdef CONFIG_DYNAMIC_FTRACE
> > @@ -974,6 +974,7 @@ static inline int ftrace_graph_notrace_addr(unsigned long addr)
> > preempt_enable_notrace();
> > return ret;
> > }
> > +
> > #else
> > static inline int ftrace_graph_addr(struct ftrace_graph_ent *trace)
> > {
> > @@ -999,18 +1000,19 @@ static inline bool ftrace_graph_ignore_func(struct ftrace_graph_ent *trace)
> > (fgraph_max_depth && trace->depth >= fgraph_max_depth);
> > }
> >
> > +void fgraph_init_ops(struct ftrace_ops *dst_ops,
> > + struct ftrace_ops *src_ops);
> > +
> > #else /* CONFIG_FUNCTION_GRAPH_TRACER */
> > static inline enum print_line_t
> > print_graph_function_flags(struct trace_iterator *iter, u32 flags)
> > {
> > return TRACE_TYPE_UNHANDLED;
> > }
> > -static inline void init_array_fgraph_ops(struct trace_array *tr) { }
> > -static inline int allocate_fgraph_ops(struct trace_array *tr)
> > -{
> > - return 0;
> > -}
> > static inline void free_fgraph_ops(struct trace_array *tr) { }
> > +/* ftrace_ops may not be defined */
> > +#define init_array_fgraph_ops(tr, ops) do { } while (0)
> > +#define allocate_fgraph_ops(tr, ops) ({ 0; })
> > #endif /* CONFIG_FUNCTION_GRAPH_TRACER */
> >
> > extern struct list_head ftrace_pids;
> > diff --git a/kernel/trace/trace_functions.c b/kernel/trace/trace_functions.c
> > index 8e8da0d0ee52..13bf2415245d 100644
> > --- a/kernel/trace/trace_functions.c
> > +++ b/kernel/trace/trace_functions.c
> > @@ -91,7 +91,7 @@ int ftrace_create_function_files(struct trace_array *tr,
> > if (!tr->ops)
> > return -EINVAL;
> >
> > - ret = allocate_fgraph_ops(tr);
> > + ret = allocate_fgraph_ops(tr, tr->ops);
> > if (ret) {
> > kfree(tr->ops);
> > return ret;
> > diff --git a/kernel/trace/trace_functions_graph.c b/kernel/trace/trace_functions_graph.c
> > index 9ccc904a7703..7f30652f0e97 100644
> > --- a/kernel/trace/trace_functions_graph.c
> > +++ b/kernel/trace/trace_functions_graph.c
> > @@ -288,7 +288,7 @@ static struct fgraph_ops funcgraph_ops = {
> > .retfunc = &trace_graph_return,
> > };
> >
> > -int allocate_fgraph_ops(struct trace_array *tr)
> > +int allocate_fgraph_ops(struct trace_array *tr, struct ftrace_ops *ops)
> > {
> > struct fgraph_ops *gops;
> >
> > @@ -301,6 +301,9 @@ int allocate_fgraph_ops(struct trace_array *tr)
> >
> > tr->gops = gops;
> > gops->private = tr;
> > +
> > + fgraph_init_ops(&gops->ops, ops);
> > +
> > return 0;
> > }
> >
> > @@ -309,10 +312,11 @@ void free_fgraph_ops(struct trace_array *tr)
> > kfree(tr->gops);
> > }
> >
> > -__init void init_array_fgraph_ops(struct trace_array *tr)
> > +__init void init_array_fgraph_ops(struct trace_array *tr, struct ftrace_ops *ops)
> > {
> > tr->gops = &funcgraph_ops;
> > funcgraph_ops.private = tr;
> > + fgraph_init_ops(&tr->gops->ops, ops);
> > }
> >
> > static int graph_trace_init(struct trace_array *tr)
> >
--
Masami Hiramatsu (Google) <mhiramat@xxxxxxxxxx>
