1 /*-
2 * Copyright (c) 2011,2013 Justin Hibbits
3 * Copyright (c) 2005, Joseph Koshy
4 * All rights reserved.
5 *
6 * Redistribution and use in source and binary forms, with or without
7 * modification, are permitted provided that the following conditions
8 * are met:
9 * 1. Redistributions of source code must retain the above copyright
10 * notice, this list of conditions and the following disclaimer.
11 * 2. Redistributions in binary form must reproduce the above copyright
12 * notice, this list of conditions and the following disclaimer in the
13 * documentation and/or other materials provided with the distribution.
14 *
15 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
16 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
17 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
18 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
19 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
20 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
21 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
22 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
23 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
24 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
25 * SUCH DAMAGE.
26 *
27 */
28
29 #include <sys/cdefs.h>
30 __FBSDID("$FreeBSD$");
31
32 #include <sys/param.h>
33 #include <sys/pmc.h>
34 #include <sys/pmckern.h>
35 #include <sys/sysent.h>
36 #include <sys/systm.h>
37
38 #include <machine/pmc_mdep.h>
39 #include <machine/spr.h>
40 #include <machine/pte.h>
41 #include <machine/sr.h>
42 #include <machine/cpu.h>
43 #include <machine/vmparam.h> /* For VM_MIN_KERNEL_ADDRESS/VM_MAX_KERNEL_ADDRESS */
44
45 #include "hwpmc_powerpc.h"
46
47 #define INKERNEL(x) (((vm_offset_t)(x)) <= VM_MAX_KERNEL_ADDRESS && \
48 ((vm_offset_t)(x)) >= VM_MIN_KERNEL_ADDRESS)
49 #define INUSER(x) (((vm_offset_t)(x)) <= VM_MAXUSER_ADDRESS && \
50 ((vm_offset_t)(x)) >= VM_MIN_ADDRESS)
51
52 struct powerpc_cpu **powerpc_pcpu;
53
54 int
pmc_save_kernel_callchain(uintptr_t * cc,int maxsamples,struct trapframe * tf)55 pmc_save_kernel_callchain(uintptr_t *cc, int maxsamples,
56 struct trapframe *tf)
57 {
58 int frames = 0;
59 uintptr_t *sp;
60
61 cc[frames++] = PMC_TRAPFRAME_TO_PC(tf);
62 sp = (uintptr_t *)PMC_TRAPFRAME_TO_FP(tf);
63
64 for (; frames < maxsamples; frames++) {
65 if (!INKERNEL(sp))
66 break;
67 #ifdef __powerpc64__
68 cc[frames++] = sp[2];
69 #else
70 cc[frames++] = sp[1];
71 #endif
72 sp = (uintptr_t *)*sp;
73 }
74 return (frames);
75 }
76
77 static int
powerpc_switch_in(struct pmc_cpu * pc,struct pmc_process * pp)78 powerpc_switch_in(struct pmc_cpu *pc, struct pmc_process *pp)
79 {
80
81 return (0);
82 }
83
84 static int
powerpc_switch_out(struct pmc_cpu * pc,struct pmc_process * pp)85 powerpc_switch_out(struct pmc_cpu *pc, struct pmc_process *pp)
86 {
87
88 return (0);
89 }
90
91 int
powerpc_describe(int cpu,int ri,struct pmc_info * pi,struct pmc ** ppmc)92 powerpc_describe(int cpu, int ri, struct pmc_info *pi, struct pmc **ppmc)
93 {
94 int error;
95 struct pmc_hw *phw;
96 char powerpc_name[PMC_NAME_MAX];
97
98 KASSERT(cpu >= 0 && cpu < pmc_cpu_max(),
99 ("[powerpc,%d], illegal CPU %d", __LINE__, cpu));
100
101 phw = &powerpc_pcpu[cpu]->pc_ppcpmcs[ri];
102 snprintf(powerpc_name, sizeof(powerpc_name), "POWERPC-%d", ri);
103 if ((error = copystr(powerpc_name, pi->pm_name, PMC_NAME_MAX,
104 NULL)) != 0)
105 return error;
106 pi->pm_class = powerpc_pcpu[cpu]->pc_class;
107 if (phw->phw_state & PMC_PHW_FLAG_IS_ENABLED) {
108 pi->pm_enabled = TRUE;
109 *ppmc = phw->phw_pmc;
110 } else {
111 pi->pm_enabled = FALSE;
112 *ppmc = NULL;
113 }
114
115 return (0);
116 }
117
118 int
powerpc_get_config(int cpu,int ri,struct pmc ** ppm)119 powerpc_get_config(int cpu, int ri, struct pmc **ppm)
120 {
121
122 *ppm = powerpc_pcpu[cpu]->pc_ppcpmcs[ri].phw_pmc;
123
124 return (0);
125 }
126
127 struct pmc_mdep *
pmc_md_initialize()128 pmc_md_initialize()
129 {
130 struct pmc_mdep *pmc_mdep;
131 int error;
132 uint16_t vers;
133
134 /*
135 * Allocate space for pointers to PMC HW descriptors and for
136 * the MDEP structure used by MI code.
137 */
138 powerpc_pcpu = malloc(sizeof(struct powerpc_cpu *) * pmc_cpu_max(), M_PMC,
139 M_WAITOK|M_ZERO);
140
141 /* Just one class */
142 pmc_mdep = pmc_mdep_alloc(1);
143
144 vers = mfpvr() >> 16;
145
146 pmc_mdep->pmd_switch_in = powerpc_switch_in;
147 pmc_mdep->pmd_switch_out = powerpc_switch_out;
148
149 switch (vers) {
150 case MPC7447A:
151 case MPC7448:
152 case MPC7450:
153 case MPC7455:
154 case MPC7457:
155 error = pmc_mpc7xxx_initialize(pmc_mdep);
156 break;
157 case IBM970:
158 case IBM970FX:
159 case IBM970MP:
160 error = pmc_ppc970_initialize(pmc_mdep);
161 break;
162 default:
163 error = -1;
164 break;
165 }
166
167 if (error != 0) {
168 pmc_mdep_free(pmc_mdep);
169 pmc_mdep = NULL;
170 }
171
172 return (pmc_mdep);
173 }
174
175 void
pmc_md_finalize(struct pmc_mdep * md)176 pmc_md_finalize(struct pmc_mdep *md)
177 {
178
179 free(powerpc_pcpu, M_PMC);
180 powerpc_pcpu = NULL;
181 }
182
183 int
pmc_save_user_callchain(uintptr_t * cc,int maxsamples,struct trapframe * tf)184 pmc_save_user_callchain(uintptr_t *cc, int maxsamples,
185 struct trapframe *tf)
186 {
187 uintptr_t *sp;
188 int frames = 0;
189
190 cc[frames++] = PMC_TRAPFRAME_TO_PC(tf);
191 sp = (uintptr_t *)PMC_TRAPFRAME_TO_FP(tf);
192
193 for (; frames < maxsamples; frames++) {
194 if (!INUSER(sp))
195 break;
196 #ifdef __powerpc64__
197 /* Check if 32-bit mode. */
198 if (!(tf->srr1 & PSL_SF)) {
199 cc[frames++] = fuword32((uint32_t *)sp + 1);
200 sp = (uintptr_t *)(uintptr_t)fuword32(sp);
201 } else {
202 cc[frames++] = fuword(sp + 2);
203 sp = (uintptr_t *)fuword(sp);
204 }
205 #else
206 cc[frames++] = fuword32((uint32_t *)sp + 1);
207 sp = (uintptr_t *)fuword32(sp);
208 #endif
209 }
210
211 return (frames);
212 }
213