Merge branch 'devel' of ssh://master.kernel.org/home/rmk/linux-2.6-arm into devel
[linux-2.6] / arch / arm / oprofile / backtrace.c
1 /*
2  * Arm specific backtracing code for oprofile
3  *
4  * Copyright 2005 Openedhand Ltd.
5  *
6  * Author: Richard Purdie <rpurdie@openedhand.com>
7  *
8  * Based on i386 oprofile backtrace code by John Levon, David Smith
9  *
10  * This program is free software; you can redistribute it and/or modify
11  * it under the terms of the GNU General Public License version 2 as
12  * published by the Free Software Foundation.
13  *
14  */
15
16 #include <linux/oprofile.h>
17 #include <linux/sched.h>
18 #include <linux/mm.h>
19 #include <linux/uaccess.h>
20 #include <asm/ptrace.h>
21 #include <asm/stacktrace.h>
22
23 static int report_trace(struct stackframe *frame, void *d)
24 {
25         unsigned int *depth = d;
26
27         if (*depth) {
28                 oprofile_add_trace(frame->pc);
29                 (*depth)--;
30         }
31
32         return *depth == 0;
33 }
34
35 /*
36  * The registers we're interested in are at the end of the variable
37  * length saved register structure. The fp points at the end of this
38  * structure so the address of this struct is:
39  * (struct frame_tail *)(xxx->fp)-1
40  */
41 struct frame_tail {
42         struct frame_tail *fp;
43         unsigned long sp;
44         unsigned long lr;
45 } __attribute__((packed));
46
47 static struct frame_tail* user_backtrace(struct frame_tail *tail)
48 {
49         struct frame_tail buftail[2];
50
51         /* Also check accessibility of one struct frame_tail beyond */
52         if (!access_ok(VERIFY_READ, tail, sizeof(buftail)))
53                 return NULL;
54         if (__copy_from_user_inatomic(buftail, tail, sizeof(buftail)))
55                 return NULL;
56
57         oprofile_add_trace(buftail[0].lr);
58
59         /* frame pointers should strictly progress back up the stack
60          * (towards higher addresses) */
61         if (tail >= buftail[0].fp)
62                 return NULL;
63
64         return buftail[0].fp-1;
65 }
66
67 void arm_backtrace(struct pt_regs * const regs, unsigned int depth)
68 {
69         struct frame_tail *tail = ((struct frame_tail *) regs->ARM_fp) - 1;
70
71         if (!user_mode(regs)) {
72                 struct stackframe frame;
73                 frame.fp = regs->ARM_fp;
74                 frame.sp = regs->ARM_sp;
75                 frame.lr = regs->ARM_lr;
76                 frame.pc = regs->ARM_pc;
77                 walk_stackframe(&frame, report_trace, &depth);
78                 return;
79         }
80
81         while (depth-- && tail && !((unsigned long) tail & 3))
82                 tail = user_backtrace(tail);
83 }