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 /* Adjust the config value if needed. */
185 config = (uint32_t)pe;
186 if ((a->pm_md.pm_md_flags & PM_MD_RAW_EVENT) == 0) {
187 config -= PMC_EV_ARMV8_FIRST;
188 if (config > (PMC_EV_ARMV8_LAST - PMC_EV_ARMV8_FIRST))
191 pm->pm_md.pm_arm64.pm_arm64_evsel = config;
192 PMCDBG2(MDP, ALL, 2, "arm64-allocate ri=%d -> config=0x%x", ri, config);
199 arm64_read_pmc(int cpu, int ri, pmc_value_t *v)
206 KASSERT(cpu >= 0 && cpu < pmc_cpu_max(),
207 ("[arm64,%d] illegal CPU value %d", __LINE__, cpu));
208 KASSERT(ri >= 0 && ri < arm64_npmcs,
209 ("[arm64,%d] illegal row index %d", __LINE__, ri));
211 pm = arm64_pcpu[cpu]->pc_arm64pmcs[ri].phw_pmc;
214 * Ensure we don't get interrupted while updating the overflow count.
217 tmp = arm64_pmcn_read(ri);
219 if ((READ_SPECIALREG(pmovsclr_el0) & reg) != 0) {
220 /* Clear Overflow Flag */
221 WRITE_SPECIALREG(pmovsclr_el0, reg);
222 if (!PMC_IS_SAMPLING_MODE(PMC_TO_MODE(pm)))
223 pm->pm_pcpu_state[cpu].pps_overflowcnt++;
225 /* Reread counter in case we raced. */
226 tmp = arm64_pmcn_read(ri);
228 tmp += 0x100000000llu * pm->pm_pcpu_state[cpu].pps_overflowcnt;
231 PMCDBG2(MDP, REA, 2, "arm64-read id=%d -> %jd", ri, tmp);
232 if (PMC_IS_SAMPLING_MODE(PMC_TO_MODE(pm)))
233 *v = ARMV8_PERFCTR_VALUE_TO_RELOAD_COUNT(tmp);
241 arm64_write_pmc(int cpu, int ri, pmc_value_t v)
245 KASSERT(cpu >= 0 && cpu < pmc_cpu_max(),
246 ("[arm64,%d] illegal CPU value %d", __LINE__, cpu));
247 KASSERT(ri >= 0 && ri < arm64_npmcs,
248 ("[arm64,%d] illegal row-index %d", __LINE__, ri));
250 pm = arm64_pcpu[cpu]->pc_arm64pmcs[ri].phw_pmc;
252 if (PMC_IS_SAMPLING_MODE(PMC_TO_MODE(pm)))
253 v = ARMV8_RELOAD_COUNT_TO_PERFCTR_VALUE(v);
255 PMCDBG3(MDP, WRI, 1, "arm64-write cpu=%d ri=%d v=%jx", cpu, ri, v);
257 pm->pm_pcpu_state[cpu].pps_overflowcnt = v >> 32;
258 arm64_pmcn_write(ri, v);
264 arm64_config_pmc(int cpu, int ri, struct pmc *pm)
268 PMCDBG3(MDP, CFG, 1, "cpu=%d ri=%d pm=%p", cpu, ri, pm);
270 KASSERT(cpu >= 0 && cpu < pmc_cpu_max(),
271 ("[arm64,%d] illegal CPU value %d", __LINE__, cpu));
272 KASSERT(ri >= 0 && ri < arm64_npmcs,
273 ("[arm64,%d] illegal row-index %d", __LINE__, ri));
275 phw = &arm64_pcpu[cpu]->pc_arm64pmcs[ri];
277 KASSERT(pm == NULL || phw->phw_pmc == NULL,
278 ("[arm64,%d] pm=%p phw->pm=%p hwpmc not unconfigured",
279 __LINE__, pm, phw->phw_pmc));
287 arm64_start_pmc(int cpu, int ri)
293 phw = &arm64_pcpu[cpu]->pc_arm64pmcs[ri];
295 config = pm->pm_md.pm_arm64.pm_arm64_evsel;
298 * Configure the event selection.
300 WRITE_SPECIALREG(pmselr_el0, ri);
301 WRITE_SPECIALREG(pmxevtyper_el0, config);
308 arm64_interrupt_enable(ri);
309 arm64_counter_enable(ri);
315 arm64_stop_pmc(int cpu, int ri)
320 phw = &arm64_pcpu[cpu]->pc_arm64pmcs[ri];
326 arm64_counter_disable(ri);
327 arm64_interrupt_disable(ri);
333 arm64_release_pmc(int cpu, int ri, struct pmc *pmc)
337 KASSERT(cpu >= 0 && cpu < pmc_cpu_max(),
338 ("[arm64,%d] illegal CPU value %d", __LINE__, cpu));
339 KASSERT(ri >= 0 && ri < arm64_npmcs,
340 ("[arm64,%d] illegal row-index %d", __LINE__, ri));
342 phw = &arm64_pcpu[cpu]->pc_arm64pmcs[ri];
343 KASSERT(phw->phw_pmc == NULL,
344 ("[arm64,%d] PHW pmc %p non-NULL", __LINE__, phw->phw_pmc));
350 arm64_intr(struct trapframe *tf)
352 struct arm64_cpu *pc;
359 KASSERT(cpu >= 0 && cpu < pmc_cpu_max(),
360 ("[arm64,%d] CPU %d out of range", __LINE__, cpu));
362 PMCDBG3(MDP,INT,1, "cpu=%d tf=%p um=%d", cpu, (void *)tf,
366 pc = arm64_pcpu[cpu];
368 for (ri = 0; ri < arm64_npmcs; ri++) {
369 pm = arm64_pcpu[cpu]->pc_arm64pmcs[ri].phw_pmc;
372 /* Check if counter is overflowed */
374 if ((READ_SPECIALREG(pmovsclr_el0) & reg) == 0)
376 /* Clear Overflow Flag */
377 WRITE_SPECIALREG(pmovsclr_el0, reg);
381 retval = 1; /* Found an interrupting PMC. */
383 if (!PMC_IS_SAMPLING_MODE(PMC_TO_MODE(pm))) {
384 pm->pm_pcpu_state[cpu].pps_overflowcnt += 1;
388 if (pm->pm_state != PMC_STATE_RUNNING)
391 error = pmc_process_interrupt(PMC_HR, pm, tf);
393 arm64_stop_pmc(cpu, ri);
395 /* Reload sampling count */
396 arm64_write_pmc(cpu, ri, pm->pm_sc.pm_reloadcount);
403 arm64_describe(int cpu, int ri, struct pmc_info *pi, struct pmc **ppmc)
405 char arm64_name[PMC_NAME_MAX];
409 KASSERT(cpu >= 0 && cpu < pmc_cpu_max(),
410 ("[arm64,%d], illegal CPU %d", __LINE__, cpu));
411 KASSERT(ri >= 0 && ri < arm64_npmcs,
412 ("[arm64,%d] row-index %d out of range", __LINE__, ri));
414 phw = &arm64_pcpu[cpu]->pc_arm64pmcs[ri];
415 snprintf(arm64_name, sizeof(arm64_name), "ARMV8-%d", ri);
416 if ((error = copystr(arm64_name, pi->pm_name, PMC_NAME_MAX,
419 pi->pm_class = PMC_CLASS_ARMV8;
420 if (phw->phw_state & PMC_PHW_FLAG_IS_ENABLED) {
421 pi->pm_enabled = TRUE;
422 *ppmc = phw->phw_pmc;
424 pi->pm_enabled = FALSE;
432 arm64_get_config(int cpu, int ri, struct pmc **ppm)
435 *ppm = arm64_pcpu[cpu]->pc_arm64pmcs[ri].phw_pmc;
441 * XXX don't know what we should do here.
444 arm64_switch_in(struct pmc_cpu *pc, struct pmc_process *pp)
451 arm64_switch_out(struct pmc_cpu *pc, struct pmc_process *pp)
458 arm64_pcpu_init(struct pmc_mdep *md, int cpu)
460 struct arm64_cpu *pac;
467 KASSERT(cpu >= 0 && cpu < pmc_cpu_max(),
468 ("[arm64,%d] wrong cpu number %d", __LINE__, cpu));
469 PMCDBG1(MDP, INI, 1, "arm64-init cpu=%d", cpu);
471 arm64_pcpu[cpu] = pac = malloc(sizeof(struct arm64_cpu), M_PMC,
474 pac->pc_arm64pmcs = malloc(sizeof(struct pmc_hw) * arm64_npmcs,
475 M_PMC, M_WAITOK | M_ZERO);
477 first_ri = md->pmd_classdep[PMC_MDEP_CLASS_INDEX_ARMV8].pcd_ri;
478 KASSERT(pc != NULL, ("[arm64,%d] NULL per-cpu pointer", __LINE__));
480 for (i = 0, phw = pac->pc_arm64pmcs; i < arm64_npmcs; i++, phw++) {
481 phw->phw_state = PMC_PHW_FLAG_IS_ENABLED |
482 PMC_PHW_CPU_TO_STATE(cpu) | PMC_PHW_INDEX_TO_STATE(i);
484 pc->pc_hwpmcs[i + first_ri] = phw;
488 pmcr = arm64_pmcr_read();
490 arm64_pmcr_write(pmcr);
496 arm64_pcpu_fini(struct pmc_mdep *md, int cpu)
500 pmcr = arm64_pmcr_read();
502 arm64_pmcr_write(pmcr);
508 pmc_arm64_initialize()
510 struct pmc_mdep *pmc_mdep;
511 struct pmc_classdep *pcd;
516 reg = arm64_pmcr_read();
517 arm64_npmcs = (reg & PMCR_N_MASK) >> PMCR_N_SHIFT;
518 impcode = (reg & PMCR_IMP_MASK) >> PMCR_IMP_SHIFT;
519 idcode = (reg & PMCR_IDCODE_MASK) >> PMCR_IDCODE_SHIFT;
521 PMCDBG1(MDP, INI, 1, "arm64-init npmcs=%d", arm64_npmcs);
524 * Write the CPU model to kern.hwpmc.cpuid.
526 * We zero the variant and revision fields.
528 * TODO: how to handle differences between cores due to big.LITTLE?
529 * For now, just use MIDR from CPU 0.
531 midr = (uint64_t)(pcpu_find(0)->pc_midr);
532 midr &= ~(CPU_VAR_MASK | CPU_REV_MASK);
533 snprintf(pmc_cpuid, sizeof(pmc_cpuid), "0x%016lx", midr);
536 * Allocate space for pointers to PMC HW descriptors and for
537 * the MDEP structure used by MI code.
539 arm64_pcpu = malloc(sizeof(struct arm64_cpu *) * pmc_cpu_max(),
540 M_PMC, M_WAITOK | M_ZERO);
543 pmc_mdep = pmc_mdep_alloc(1);
548 case PMCR_IDCODE_CORTEX_A76:
549 case PMCR_IDCODE_NEOVERSE_N1:
550 pmc_mdep->pmd_cputype = PMC_CPU_ARMV8_CORTEX_A76;
552 case PMCR_IDCODE_CORTEX_A57:
553 case PMCR_IDCODE_CORTEX_A72:
554 pmc_mdep->pmd_cputype = PMC_CPU_ARMV8_CORTEX_A57;
557 case PMCR_IDCODE_CORTEX_A53:
558 pmc_mdep->pmd_cputype = PMC_CPU_ARMV8_CORTEX_A53;
563 pmc_mdep->pmd_cputype = PMC_CPU_ARMV8_CORTEX_A53;
567 pcd = &pmc_mdep->pmd_classdep[PMC_MDEP_CLASS_INDEX_ARMV8];
568 pcd->pcd_caps = ARMV8_PMC_CAPS;
569 pcd->pcd_class = PMC_CLASS_ARMV8;
570 pcd->pcd_num = arm64_npmcs;
571 pcd->pcd_ri = pmc_mdep->pmd_npmc;
574 pcd->pcd_allocate_pmc = arm64_allocate_pmc;
575 pcd->pcd_config_pmc = arm64_config_pmc;
576 pcd->pcd_pcpu_fini = arm64_pcpu_fini;
577 pcd->pcd_pcpu_init = arm64_pcpu_init;
578 pcd->pcd_describe = arm64_describe;
579 pcd->pcd_get_config = arm64_get_config;
580 pcd->pcd_read_pmc = arm64_read_pmc;
581 pcd->pcd_release_pmc = arm64_release_pmc;
582 pcd->pcd_start_pmc = arm64_start_pmc;
583 pcd->pcd_stop_pmc = arm64_stop_pmc;
584 pcd->pcd_write_pmc = arm64_write_pmc;
586 pmc_mdep->pmd_intr = arm64_intr;
587 pmc_mdep->pmd_switch_in = arm64_switch_in;
588 pmc_mdep->pmd_switch_out = arm64_switch_out;
590 pmc_mdep->pmd_npmc += arm64_npmcs;
596 pmc_arm64_finalize(struct pmc_mdep *md)