1 /*-
2 * Copyright (c) 2015 Ruslan Bukin <br@bsdpad.com>
3 * All rights reserved.
4 *
5 * This software was developed by the University of Cambridge Computer
6 * Laboratory with support from ARM Ltd.
7 *
8 * Redistribution and use in source and binary forms, with or without
9 * modification, are permitted provided that the following conditions
10 * are met:
11 * 1. Redistributions of source code must retain the above copyright
12 * notice, this list of conditions and the following disclaimer.
13 * 2. Redistributions in binary form must reproduce the above copyright
14 * notice, this list of conditions and the following disclaimer in the
15 * documentation and/or other materials provided with the distribution.
16 *
17 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
18 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
19 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
20 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
21 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
22 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
23 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
24 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
25 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
26 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
27 * SUCH DAMAGE.
28 */
29
30 #include <sys/param.h>
31 #include <sys/systm.h>
32 #include <sys/pmc.h>
33
34 #include <vm/vm.h>
35 #include <vm/pmap.h>
36
37 #include <machine/cpu.h>
38 #include <machine/md_var.h>
39 #include <machine/pmc_mdep.h>
40 #include <machine/stack.h>
41 #include <machine/vmparam.h>
42
43 struct pmc_mdep *
pmc_md_initialize(void)44 pmc_md_initialize(void)
45 {
46
47 return (pmc_arm64_initialize());
48 }
49
50 void
pmc_md_finalize(struct pmc_mdep * md)51 pmc_md_finalize(struct pmc_mdep *md)
52 {
53
54 pmc_arm64_finalize(md);
55 }
56
57 int
pmc_save_kernel_callchain(uintptr_t * cc,int maxsamples,struct trapframe * tf)58 pmc_save_kernel_callchain(uintptr_t *cc, int maxsamples, struct trapframe *tf)
59 {
60 struct unwind_state frame;
61 int count;
62
63 KASSERT(TRAPF_USERMODE(tf) == 0,("[arm64,%d] not a kernel backtrace",
64 __LINE__));
65
66 frame.pc = PMC_TRAPFRAME_TO_PC(tf);
67 *cc++ = frame.pc;
68
69 if (maxsamples <= 1)
70 return (1);
71
72 frame.fp = PMC_TRAPFRAME_TO_FP(tf);
73 if (!PMC_IN_KERNEL(frame.pc) || !PMC_IN_KERNEL_STACK(frame.fp))
74 return (1);
75
76 for (count = 1; count < maxsamples; count++) {
77 if (!unwind_frame(curthread, &frame))
78 break;
79 if (!PMC_IN_KERNEL(frame.pc))
80 break;
81 *cc++ = frame.pc;
82 }
83
84 return (count);
85 }
86
87 int
pmc_save_user_callchain(uintptr_t * cc,int maxsamples,struct trapframe * tf)88 pmc_save_user_callchain(uintptr_t *cc, int maxsamples,
89 struct trapframe *tf)
90 {
91 uintptr_t pc, r, oldfp, fp;
92 int count;
93
94 KASSERT(TRAPF_USERMODE(tf), ("[arm64,%d] Not a user trap frame tf=%p",
95 __LINE__, (void *) tf));
96
97 pc = PMC_TRAPFRAME_TO_PC(tf);
98 *cc++ = pc;
99
100 if (maxsamples <= 1)
101 return (1);
102
103 oldfp = fp = PMC_TRAPFRAME_TO_FP(tf);
104
105 if (!PMC_IN_USERSPACE(pc) ||
106 !PMC_IN_USERSPACE(fp))
107 return (1);
108
109 for (count = 1; count < maxsamples; count++) {
110 /* Use saved lr as pc. */
111 r = fp + sizeof(uintptr_t);
112 if (copyin((void *)r, &pc, sizeof(pc)) != 0)
113 break;
114 if (!PMC_IN_USERSPACE(pc))
115 break;
116
117 *cc++ = pc;
118
119 /* Switch to next frame up */
120 oldfp = fp;
121 r = fp;
122 if (copyin((void *)r, &fp, sizeof(fp)) != 0)
123 break;
124 if (fp < oldfp || !PMC_IN_USERSPACE(fp))
125 break;
126 }
127
128 return (count);
129 }
130