Atsushi Nemoto | 1df0f0f | 2006-09-26 23:44:01 +0900 | [diff] [blame] | 1 | /* |
| 2 | * arch/mips/kernel/stacktrace.c |
| 3 | * |
| 4 | * Stack trace management functions |
| 5 | * |
| 6 | * Copyright (C) 2006 Atsushi Nemoto <anemo@mba.ocn.ne.jp> |
| 7 | */ |
| 8 | #include <linux/sched.h> |
| 9 | #include <linux/stacktrace.h> |
| 10 | #include <asm/stacktrace.h> |
| 11 | |
| 12 | /* |
| 13 | * Save stack-backtrace addresses into a stack_trace buffer: |
| 14 | */ |
| 15 | static void save_raw_context_stack(struct stack_trace *trace, |
Atsushi Nemoto | 2312669 | 2006-09-28 19:15:33 +0900 | [diff] [blame^] | 16 | unsigned long reg29) |
Atsushi Nemoto | 1df0f0f | 2006-09-26 23:44:01 +0900 | [diff] [blame] | 17 | { |
| 18 | unsigned long *sp = (unsigned long *)reg29; |
| 19 | unsigned long addr; |
| 20 | |
| 21 | while (!kstack_end(sp)) { |
| 22 | addr = *sp++; |
| 23 | if (__kernel_text_address(addr)) { |
Atsushi Nemoto | 2312669 | 2006-09-28 19:15:33 +0900 | [diff] [blame^] | 24 | if (trace->skip > 0) |
| 25 | trace->skip--; |
Atsushi Nemoto | 1df0f0f | 2006-09-26 23:44:01 +0900 | [diff] [blame] | 26 | else |
Atsushi Nemoto | 2312669 | 2006-09-28 19:15:33 +0900 | [diff] [blame^] | 27 | trace->entries[trace->nr_entries++] = addr; |
Atsushi Nemoto | 1df0f0f | 2006-09-26 23:44:01 +0900 | [diff] [blame] | 28 | if (trace->nr_entries >= trace->max_entries) |
| 29 | break; |
| 30 | } |
| 31 | } |
| 32 | } |
| 33 | |
| 34 | static struct pt_regs * save_context_stack(struct stack_trace *trace, |
Atsushi Nemoto | 2312669 | 2006-09-28 19:15:33 +0900 | [diff] [blame^] | 35 | struct task_struct *task, struct pt_regs *regs) |
Atsushi Nemoto | 1df0f0f | 2006-09-26 23:44:01 +0900 | [diff] [blame] | 36 | { |
| 37 | unsigned long sp = regs->regs[29]; |
| 38 | #ifdef CONFIG_KALLSYMS |
| 39 | unsigned long ra = regs->regs[31]; |
| 40 | unsigned long pc = regs->cp0_epc; |
Atsushi Nemoto | 2312669 | 2006-09-28 19:15:33 +0900 | [diff] [blame^] | 41 | unsigned long stack_page = |
| 42 | (unsigned long)task_stack_page(task); |
Atsushi Nemoto | 1df0f0f | 2006-09-26 23:44:01 +0900 | [diff] [blame] | 43 | extern void ret_from_irq(void); |
Atsushi Nemoto | 2312669 | 2006-09-28 19:15:33 +0900 | [diff] [blame^] | 44 | extern void ret_from_exception(void); |
Atsushi Nemoto | 1df0f0f | 2006-09-26 23:44:01 +0900 | [diff] [blame] | 45 | |
| 46 | if (raw_show_trace || !__kernel_text_address(pc)) { |
Atsushi Nemoto | 2312669 | 2006-09-28 19:15:33 +0900 | [diff] [blame^] | 47 | if (stack_page && sp >= stack_page && |
| 48 | sp <= stack_page + THREAD_SIZE - 32) |
| 49 | save_raw_context_stack(trace, sp); |
Atsushi Nemoto | 1df0f0f | 2006-09-26 23:44:01 +0900 | [diff] [blame] | 50 | return NULL; |
| 51 | } |
| 52 | do { |
Atsushi Nemoto | 2312669 | 2006-09-28 19:15:33 +0900 | [diff] [blame^] | 53 | if (trace->skip > 0) |
| 54 | trace->skip--; |
Atsushi Nemoto | 1df0f0f | 2006-09-26 23:44:01 +0900 | [diff] [blame] | 55 | else |
Atsushi Nemoto | 2312669 | 2006-09-28 19:15:33 +0900 | [diff] [blame^] | 56 | trace->entries[trace->nr_entries++] = pc; |
Atsushi Nemoto | 1df0f0f | 2006-09-26 23:44:01 +0900 | [diff] [blame] | 57 | if (trace->nr_entries >= trace->max_entries) |
| 58 | break; |
| 59 | /* |
| 60 | * If we reached the bottom of interrupt context, |
| 61 | * return saved pt_regs. |
| 62 | */ |
Atsushi Nemoto | 2312669 | 2006-09-28 19:15:33 +0900 | [diff] [blame^] | 63 | if (pc == (unsigned long)ret_from_irq || |
| 64 | pc == (unsigned long)ret_from_exception) { |
| 65 | if (stack_page && sp >= stack_page && |
| 66 | sp <= stack_page + THREAD_SIZE - 32) |
| 67 | return (struct pt_regs *)sp; |
| 68 | break; |
Atsushi Nemoto | 1df0f0f | 2006-09-26 23:44:01 +0900 | [diff] [blame] | 69 | } |
| 70 | pc = unwind_stack(task, &sp, pc, ra); |
| 71 | ra = 0; |
| 72 | } while (pc); |
| 73 | #else |
| 74 | save_raw_context_stack(sp); |
| 75 | #endif |
| 76 | |
| 77 | return NULL; |
| 78 | } |
| 79 | |
| 80 | /* |
| 81 | * Save stack-backtrace addresses into a stack_trace buffer. |
Atsushi Nemoto | 1df0f0f | 2006-09-26 23:44:01 +0900 | [diff] [blame] | 82 | */ |
Atsushi Nemoto | 2312669 | 2006-09-28 19:15:33 +0900 | [diff] [blame^] | 83 | void save_stack_trace(struct stack_trace *trace, struct task_struct *task) |
Atsushi Nemoto | 1df0f0f | 2006-09-26 23:44:01 +0900 | [diff] [blame] | 84 | { |
| 85 | struct pt_regs dummyregs; |
| 86 | struct pt_regs *regs = &dummyregs; |
| 87 | |
| 88 | WARN_ON(trace->nr_entries || !trace->max_entries); |
| 89 | |
| 90 | if (task && task != current) { |
| 91 | regs->regs[29] = task->thread.reg29; |
| 92 | regs->regs[31] = 0; |
| 93 | regs->cp0_epc = task->thread.reg31; |
| 94 | } else { |
| 95 | if (!task) |
| 96 | task = current; |
| 97 | prepare_frametrace(regs); |
| 98 | } |
| 99 | |
| 100 | while (1) { |
Atsushi Nemoto | 2312669 | 2006-09-28 19:15:33 +0900 | [diff] [blame^] | 101 | regs = save_context_stack(trace, task, regs); |
| 102 | if (!regs || trace->nr_entries >= trace->max_entries) |
Atsushi Nemoto | 1df0f0f | 2006-09-26 23:44:01 +0900 | [diff] [blame] | 103 | break; |
Atsushi Nemoto | 1df0f0f | 2006-09-26 23:44:01 +0900 | [diff] [blame] | 104 | } |
| 105 | } |