| David S. Miller | 10e2672 | 2006-11-16 13:38:57 -0800 | [diff] [blame] | 1 | #include <linux/sched.h> | 
 | 2 | #include <linux/stacktrace.h> | 
 | 3 | #include <linux/thread_info.h> | 
| David S. Miller | 667f0ce | 2010-04-21 03:08:11 -0700 | [diff] [blame] | 4 | #include <linux/ftrace.h> | 
| Stephen Rothwell | a05fe03 | 2008-07-08 22:15:40 +1000 | [diff] [blame] | 5 | #include <linux/module.h> | 
| David S. Miller | 10e2672 | 2006-11-16 13:38:57 -0800 | [diff] [blame] | 6 | #include <asm/ptrace.h> | 
| David S. Miller | 85a7935 | 2008-03-24 20:06:24 -0700 | [diff] [blame] | 7 | #include <asm/stacktrace.h> | 
| David S. Miller | 10e2672 | 2006-11-16 13:38:57 -0800 | [diff] [blame] | 8 |  | 
| David S. Miller | 4f70f7a | 2008-08-12 18:33:56 -0700 | [diff] [blame] | 9 | #include "kstack.h" | 
 | 10 |  | 
| David S. Miller | 6a5726d | 2008-11-28 01:19:41 -0800 | [diff] [blame] | 11 | static void __save_stack_trace(struct thread_info *tp, | 
 | 12 | 			       struct stack_trace *trace, | 
 | 13 | 			       bool skip_sched) | 
| David S. Miller | 10e2672 | 2006-11-16 13:38:57 -0800 | [diff] [blame] | 14 | { | 
| David S. Miller | 6f63e78 | 2008-08-13 17:17:52 -0700 | [diff] [blame] | 15 | 	unsigned long ksp, fp; | 
| David S. Miller | 667f0ce | 2010-04-21 03:08:11 -0700 | [diff] [blame] | 16 | #ifdef CONFIG_FUNCTION_GRAPH_TRACER | 
 | 17 | 	struct task_struct *t; | 
 | 18 | 	int graph = 0; | 
 | 19 | #endif | 
| David S. Miller | 10e2672 | 2006-11-16 13:38:57 -0800 | [diff] [blame] | 20 |  | 
| David S. Miller | 6a5726d | 2008-11-28 01:19:41 -0800 | [diff] [blame] | 21 | 	if (tp == current_thread_info()) { | 
 | 22 | 		stack_trace_flush(); | 
 | 23 | 		__asm__ __volatile__("mov %%fp, %0" : "=r" (ksp)); | 
 | 24 | 	} else { | 
 | 25 | 		ksp = tp->ksp; | 
 | 26 | 	} | 
| David S. Miller | 10e2672 | 2006-11-16 13:38:57 -0800 | [diff] [blame] | 27 |  | 
 | 28 | 	fp = ksp + STACK_BIAS; | 
| David S. Miller | 667f0ce | 2010-04-21 03:08:11 -0700 | [diff] [blame] | 29 | #ifdef CONFIG_FUNCTION_GRAPH_TRACER | 
 | 30 | 	t = tp->task; | 
 | 31 | #endif | 
| David S. Miller | 10e2672 | 2006-11-16 13:38:57 -0800 | [diff] [blame] | 32 | 	do { | 
| David S. Miller | 14d2c68 | 2008-05-21 18:15:53 -0700 | [diff] [blame] | 33 | 		struct sparc_stackf *sf; | 
| David S. Miller | 77c664f | 2008-04-24 03:28:52 -0700 | [diff] [blame] | 34 | 		struct pt_regs *regs; | 
 | 35 | 		unsigned long pc; | 
| David S. Miller | 10e2672 | 2006-11-16 13:38:57 -0800 | [diff] [blame] | 36 |  | 
| David S. Miller | 4f70f7a | 2008-08-12 18:33:56 -0700 | [diff] [blame] | 37 | 		if (!kstack_valid(tp, fp)) | 
| David S. Miller | 10e2672 | 2006-11-16 13:38:57 -0800 | [diff] [blame] | 38 | 			break; | 
 | 39 |  | 
| David S. Miller | 14d2c68 | 2008-05-21 18:15:53 -0700 | [diff] [blame] | 40 | 		sf = (struct sparc_stackf *) fp; | 
 | 41 | 		regs = (struct pt_regs *) (sf + 1); | 
| David S. Miller | 77c664f | 2008-04-24 03:28:52 -0700 | [diff] [blame] | 42 |  | 
| David S. Miller | 4f70f7a | 2008-08-12 18:33:56 -0700 | [diff] [blame] | 43 | 		if (kstack_is_trap_frame(tp, regs)) { | 
| David S. Miller | 14d2c68 | 2008-05-21 18:15:53 -0700 | [diff] [blame] | 44 | 			if (!(regs->tstate & TSTATE_PRIV)) | 
 | 45 | 				break; | 
| David S. Miller | 77c664f | 2008-04-24 03:28:52 -0700 | [diff] [blame] | 46 | 			pc = regs->tpc; | 
 | 47 | 			fp = regs->u_regs[UREG_I6] + STACK_BIAS; | 
 | 48 | 		} else { | 
| David S. Miller | 14d2c68 | 2008-05-21 18:15:53 -0700 | [diff] [blame] | 49 | 			pc = sf->callers_pc; | 
 | 50 | 			fp = (unsigned long)sf->fp + STACK_BIAS; | 
| David S. Miller | 77c664f | 2008-04-24 03:28:52 -0700 | [diff] [blame] | 51 | 		} | 
 | 52 |  | 
| David S. Miller | 10e2672 | 2006-11-16 13:38:57 -0800 | [diff] [blame] | 53 | 		if (trace->skip > 0) | 
 | 54 | 			trace->skip--; | 
| David S. Miller | 667f0ce | 2010-04-21 03:08:11 -0700 | [diff] [blame] | 55 | 		else if (!skip_sched || !in_sched_functions(pc)) { | 
| David S. Miller | 77c664f | 2008-04-24 03:28:52 -0700 | [diff] [blame] | 56 | 			trace->entries[trace->nr_entries++] = pc; | 
| David S. Miller | 667f0ce | 2010-04-21 03:08:11 -0700 | [diff] [blame] | 57 | #ifdef CONFIG_FUNCTION_GRAPH_TRACER | 
 | 58 | 			if ((pc + 8UL) == (unsigned long) &return_to_handler) { | 
 | 59 | 				int index = t->curr_ret_stack; | 
 | 60 | 				if (t->ret_stack && index >= graph) { | 
 | 61 | 					pc = t->ret_stack[index - graph].ret; | 
 | 62 | 					if (trace->nr_entries < | 
 | 63 | 					    trace->max_entries) | 
 | 64 | 						trace->entries[trace->nr_entries++] = pc; | 
 | 65 | 					graph++; | 
 | 66 | 				} | 
 | 67 | 			} | 
 | 68 | #endif | 
 | 69 | 		} | 
| David S. Miller | 10e2672 | 2006-11-16 13:38:57 -0800 | [diff] [blame] | 70 | 	} while (trace->nr_entries < trace->max_entries); | 
 | 71 | } | 
| David S. Miller | 6a5726d | 2008-11-28 01:19:41 -0800 | [diff] [blame] | 72 |  | 
 | 73 | void save_stack_trace(struct stack_trace *trace) | 
 | 74 | { | 
 | 75 | 	__save_stack_trace(current_thread_info(), trace, false); | 
 | 76 | } | 
| Ingo Molnar | 7b4c950 | 2008-07-03 09:17:55 +0200 | [diff] [blame] | 77 | EXPORT_SYMBOL_GPL(save_stack_trace); | 
| David S. Miller | 6a5726d | 2008-11-28 01:19:41 -0800 | [diff] [blame] | 78 |  | 
 | 79 | void save_stack_trace_tsk(struct task_struct *tsk, struct stack_trace *trace) | 
 | 80 | { | 
 | 81 | 	struct thread_info *tp = task_thread_info(tsk); | 
 | 82 |  | 
 | 83 | 	__save_stack_trace(tp, trace, true); | 
 | 84 | } | 
 | 85 | EXPORT_SYMBOL_GPL(save_stack_trace_tsk); |