2 * Copyright (c) 2015 Ruslan Bukin <br@bsdpad.com>
5 * This software was developed by the University of Cambridge Computer
6 * Laboratory with support from ARM Ltd.
8 * Redistribution and use in source and binary forms, with or without
9 * modification, are permitted provided that the following conditions
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.
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
30 #include <sys/cdefs.h>
31 __FBSDID("$FreeBSD$");
33 #include <sys/param.h>
34 #include <sys/systm.h>
36 #include <sys/pmckern.h>
38 #include <machine/pmc_mdep.h>
39 #include <machine/cpu.h>
41 static int arm64_npmcs;
43 struct arm64_event_code_map {
49 * Per-processor information.
52 struct pmc_hw *pc_arm64pmcs;
55 static struct arm64_cpu **arm64_pcpu;
58 * Interrupt Enable Set Register
61 arm64_interrupt_enable(uint32_t pmc)
66 WRITE_SPECIALREG(pmintenset_el1, reg);
72 * Interrupt Clear Set Register
75 arm64_interrupt_disable(uint32_t pmc)
80 WRITE_SPECIALREG(pmintenclr_el1, reg);
86 * Counter Set Enable Register
89 arm64_counter_enable(unsigned int pmc)
94 WRITE_SPECIALREG(pmcntenset_el0, reg);
100 * Counter Clear Enable Register
103 arm64_counter_disable(unsigned int pmc)
108 WRITE_SPECIALREG(pmcntenclr_el0, reg);
114 * Performance Monitors Control Register
117 arm64_pmcr_read(void)
121 reg = READ_SPECIALREG(pmcr_el0);
127 arm64_pmcr_write(uint32_t reg)
130 WRITE_SPECIALREG(pmcr_el0, reg);
136 * Performance Count Register N
139 arm64_pmcn_read(unsigned int pmc)
142 KASSERT(pmc < arm64_npmcs, ("%s: illegal PMC number %d", __func__, pmc));
144 WRITE_SPECIALREG(pmselr_el0, pmc);
148 return (READ_SPECIALREG(pmxevcntr_el0));
152 arm64_pmcn_write(unsigned int pmc, uint32_t reg)
155 KASSERT(pmc < arm64_npmcs, ("%s: illegal PMC number %d", __func__, pmc));
157 WRITE_SPECIALREG(pmselr_el0, pmc);
158 WRITE_SPECIALREG(pmxevcntr_el0, reg);
164 arm64_allocate_pmc(int cpu, int ri, struct pmc *pm,
165 const struct pmc_op_pmcallocate *a)
167 uint32_t caps, config;
168 struct arm64_cpu *pac;
171 KASSERT(cpu >= 0 && cpu < pmc_cpu_max(),
172 ("[arm64,%d] illegal CPU value %d", __LINE__, cpu));
173 KASSERT(ri >= 0 && ri < arm64_npmcs,
174 ("[arm64,%d] illegal row index %d", __LINE__, ri));
176 pac = arm64_pcpu[cpu];
179 if (a->pm_class != PMC_CLASS_ARMV8) {
184 config = (pe & EVENT_ID_MASK);
185 pm->pm_md.pm_arm64.pm_arm64_evsel = config;
187 PMCDBG2(MDP, ALL, 2, "arm64-allocate ri=%d -> config=0x%x", ri, config);
194 arm64_read_pmc(int cpu, int ri, pmc_value_t *v)
201 KASSERT(cpu >= 0 && cpu < pmc_cpu_max(),
202 ("[arm64,%d] illegal CPU value %d", __LINE__, cpu));
203 KASSERT(ri >= 0 && ri < arm64_npmcs,
204 ("[arm64,%d] illegal row index %d", __LINE__, ri));
206 pm = arm64_pcpu[cpu]->pc_arm64pmcs[ri].phw_pmc;
209 * Ensure we don't get interrupted while updating the overflow count.
212 tmp = arm64_pmcn_read(ri);
214 if ((READ_SPECIALREG(pmovsclr_el0) & reg) != 0) {
215 /* Clear Overflow Flag */
216 WRITE_SPECIALREG(pmovsclr_el0, reg);
217 if (!PMC_IS_SAMPLING_MODE(PMC_TO_MODE(pm)))
218 pm->pm_pcpu_state[cpu].pps_overflowcnt++;
220 /* Reread counter in case we raced. */
221 tmp = arm64_pmcn_read(ri);
223 tmp += 0x100000000llu * pm->pm_pcpu_state[cpu].pps_overflowcnt;
226 PMCDBG2(MDP, REA, 2, "arm64-read id=%d -> %jd", ri, tmp);
227 if (PMC_IS_SAMPLING_MODE(PMC_TO_MODE(pm)))
228 *v = ARMV8_PERFCTR_VALUE_TO_RELOAD_COUNT(tmp);
236 arm64_write_pmc(int cpu, int ri, pmc_value_t v)
240 KASSERT(cpu >= 0 && cpu < pmc_cpu_max(),
241 ("[arm64,%d] illegal CPU value %d", __LINE__, cpu));
242 KASSERT(ri >= 0 && ri < arm64_npmcs,
243 ("[arm64,%d] illegal row-index %d", __LINE__, ri));
245 pm = arm64_pcpu[cpu]->pc_arm64pmcs[ri].phw_pmc;
247 if (PMC_IS_SAMPLING_MODE(PMC_TO_MODE(pm)))
248 v = ARMV8_RELOAD_COUNT_TO_PERFCTR_VALUE(v);
250 PMCDBG3(MDP, WRI, 1, "arm64-write cpu=%d ri=%d v=%jx", cpu, ri, v);
252 pm->pm_pcpu_state[cpu].pps_overflowcnt = v >> 32;
253 arm64_pmcn_write(ri, v);
259 arm64_config_pmc(int cpu, int ri, struct pmc *pm)
263 PMCDBG3(MDP, CFG, 1, "cpu=%d ri=%d pm=%p", cpu, ri, pm);
265 KASSERT(cpu >= 0 && cpu < pmc_cpu_max(),
266 ("[arm64,%d] illegal CPU value %d", __LINE__, cpu));
267 KASSERT(ri >= 0 && ri < arm64_npmcs,
268 ("[arm64,%d] illegal row-index %d", __LINE__, ri));
270 phw = &arm64_pcpu[cpu]->pc_arm64pmcs[ri];
272 KASSERT(pm == NULL || phw->phw_pmc == NULL,
273 ("[arm64,%d] pm=%p phw->pm=%p hwpmc not unconfigured",
274 __LINE__, pm, phw->phw_pmc));
282 arm64_start_pmc(int cpu, int ri)
288 phw = &arm64_pcpu[cpu]->pc_arm64pmcs[ri];
290 config = pm->pm_md.pm_arm64.pm_arm64_evsel;
293 * Configure the event selection.
295 WRITE_SPECIALREG(pmselr_el0, ri);
296 WRITE_SPECIALREG(pmxevtyper_el0, config);
303 arm64_interrupt_enable(ri);
304 arm64_counter_enable(ri);
310 arm64_stop_pmc(int cpu, int ri)
315 phw = &arm64_pcpu[cpu]->pc_arm64pmcs[ri];
321 arm64_counter_disable(ri);
322 arm64_interrupt_disable(ri);
328 arm64_release_pmc(int cpu, int ri, struct pmc *pmc)
332 KASSERT(cpu >= 0 && cpu < pmc_cpu_max(),
333 ("[arm64,%d] illegal CPU value %d", __LINE__, cpu));
334 KASSERT(ri >= 0 && ri < arm64_npmcs,
335 ("[arm64,%d] illegal row-index %d", __LINE__, ri));
337 phw = &arm64_pcpu[cpu]->pc_arm64pmcs[ri];
338 KASSERT(phw->phw_pmc == NULL,
339 ("[arm64,%d] PHW pmc %p non-NULL", __LINE__, phw->phw_pmc));
345 arm64_intr(struct trapframe *tf)
347 struct arm64_cpu *pc;
354 KASSERT(cpu >= 0 && cpu < pmc_cpu_max(),
355 ("[arm64,%d] CPU %d out of range", __LINE__, cpu));
358 pc = arm64_pcpu[cpu];
360 for (ri = 0; ri < arm64_npmcs; ri++) {
361 pm = arm64_pcpu[cpu]->pc_arm64pmcs[ri].phw_pmc;
364 /* Check if counter is overflowed */
366 if ((READ_SPECIALREG(pmovsclr_el0) & reg) == 0)
368 /* Clear Overflow Flag */
369 WRITE_SPECIALREG(pmovsclr_el0, reg);
373 retval = 1; /* Found an interrupting PMC. */
375 if (!PMC_IS_SAMPLING_MODE(PMC_TO_MODE(pm))) {
376 pm->pm_pcpu_state[cpu].pps_overflowcnt += 1;
380 if (pm->pm_state != PMC_STATE_RUNNING)
383 error = pmc_process_interrupt(PMC_HR, pm, tf);
385 arm64_stop_pmc(cpu, ri);
387 /* Reload sampling count */
388 arm64_write_pmc(cpu, ri, pm->pm_sc.pm_reloadcount);
395 arm64_describe(int cpu, int ri, struct pmc_info *pi, struct pmc **ppmc)
397 char arm64_name[PMC_NAME_MAX];
401 KASSERT(cpu >= 0 && cpu < pmc_cpu_max(),
402 ("[arm64,%d], illegal CPU %d", __LINE__, cpu));
403 KASSERT(ri >= 0 && ri < arm64_npmcs,
404 ("[arm64,%d] row-index %d out of range", __LINE__, ri));
406 phw = &arm64_pcpu[cpu]->pc_arm64pmcs[ri];
407 snprintf(arm64_name, sizeof(arm64_name), "ARMV8-%d", ri);
408 if ((error = copystr(arm64_name, pi->pm_name, PMC_NAME_MAX,
411 pi->pm_class = PMC_CLASS_ARMV8;
412 if (phw->phw_state & PMC_PHW_FLAG_IS_ENABLED) {
413 pi->pm_enabled = TRUE;
414 *ppmc = phw->phw_pmc;
416 pi->pm_enabled = FALSE;
424 arm64_get_config(int cpu, int ri, struct pmc **ppm)
427 *ppm = arm64_pcpu[cpu]->pc_arm64pmcs[ri].phw_pmc;
433 * XXX don't know what we should do here.
436 arm64_switch_in(struct pmc_cpu *pc, struct pmc_process *pp)
443 arm64_switch_out(struct pmc_cpu *pc, struct pmc_process *pp)
450 arm64_pcpu_init(struct pmc_mdep *md, int cpu)
452 struct arm64_cpu *pac;
459 KASSERT(cpu >= 0 && cpu < pmc_cpu_max(),
460 ("[arm64,%d] wrong cpu number %d", __LINE__, cpu));
461 PMCDBG1(MDP, INI, 1, "arm64-init cpu=%d", cpu);
463 arm64_pcpu[cpu] = pac = malloc(sizeof(struct arm64_cpu), M_PMC,
466 pac->pc_arm64pmcs = malloc(sizeof(struct pmc_hw) * arm64_npmcs,
467 M_PMC, M_WAITOK | M_ZERO);
469 first_ri = md->pmd_classdep[PMC_MDEP_CLASS_INDEX_ARMV8].pcd_ri;
470 KASSERT(pc != NULL, ("[arm64,%d] NULL per-cpu pointer", __LINE__));
472 for (i = 0, phw = pac->pc_arm64pmcs; i < arm64_npmcs; i++, phw++) {
473 phw->phw_state = PMC_PHW_FLAG_IS_ENABLED |
474 PMC_PHW_CPU_TO_STATE(cpu) | PMC_PHW_INDEX_TO_STATE(i);
476 pc->pc_hwpmcs[i + first_ri] = phw;
480 pmcr = arm64_pmcr_read();
482 arm64_pmcr_write(pmcr);
488 arm64_pcpu_fini(struct pmc_mdep *md, int cpu)
492 pmcr = arm64_pmcr_read();
494 arm64_pmcr_write(pmcr);
500 pmc_arm64_initialize()
502 struct pmc_mdep *pmc_mdep;
503 struct pmc_classdep *pcd;
507 reg = arm64_pmcr_read();
508 arm64_npmcs = (reg & PMCR_N_MASK) >> PMCR_N_SHIFT;
509 impcode = (reg & PMCR_IMP_MASK) >> PMCR_IMP_SHIFT;
510 idcode = (reg & PMCR_IDCODE_MASK) >> PMCR_IDCODE_SHIFT;
512 PMCDBG1(MDP, INI, 1, "arm64-init npmcs=%d", arm64_npmcs);
515 * Allocate space for pointers to PMC HW descriptors and for
516 * the MDEP structure used by MI code.
518 arm64_pcpu = malloc(sizeof(struct arm64_cpu *) * pmc_cpu_max(),
519 M_PMC, M_WAITOK | M_ZERO);
522 pmc_mdep = pmc_mdep_alloc(1);
527 case PMCR_IDCODE_CORTEX_A76:
528 case PMCR_IDCODE_NEOVERSE_N1:
529 pmc_mdep->pmd_cputype = PMC_CPU_ARMV8_CORTEX_A76;
531 case PMCR_IDCODE_CORTEX_A57:
532 case PMCR_IDCODE_CORTEX_A72:
533 pmc_mdep->pmd_cputype = PMC_CPU_ARMV8_CORTEX_A57;
536 case PMCR_IDCODE_CORTEX_A53:
537 pmc_mdep->pmd_cputype = PMC_CPU_ARMV8_CORTEX_A53;
542 pmc_mdep->pmd_cputype = PMC_CPU_ARMV8_CORTEX_A53;
546 pcd = &pmc_mdep->pmd_classdep[PMC_MDEP_CLASS_INDEX_ARMV8];
547 pcd->pcd_caps = ARMV8_PMC_CAPS;
548 pcd->pcd_class = PMC_CLASS_ARMV8;
549 pcd->pcd_num = arm64_npmcs;
550 pcd->pcd_ri = pmc_mdep->pmd_npmc;
553 pcd->pcd_allocate_pmc = arm64_allocate_pmc;
554 pcd->pcd_config_pmc = arm64_config_pmc;
555 pcd->pcd_pcpu_fini = arm64_pcpu_fini;
556 pcd->pcd_pcpu_init = arm64_pcpu_init;
557 pcd->pcd_describe = arm64_describe;
558 pcd->pcd_get_config = arm64_get_config;
559 pcd->pcd_read_pmc = arm64_read_pmc;
560 pcd->pcd_release_pmc = arm64_release_pmc;
561 pcd->pcd_start_pmc = arm64_start_pmc;
562 pcd->pcd_stop_pmc = arm64_stop_pmc;
563 pcd->pcd_write_pmc = arm64_write_pmc;
565 pmc_mdep->pmd_intr = arm64_intr;
566 pmc_mdep->pmd_switch_in = arm64_switch_in;
567 pmc_mdep->pmd_switch_out = arm64_switch_out;
569 pmc_mdep->pmd_npmc += arm64_npmcs;
575 pmc_arm64_finalize(struct pmc_mdep *md)