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 = (uint32_t)pe - PMC_EV_ARMV8_FIRST;
185 if (config > (PMC_EV_ARMV8_LAST - PMC_EV_ARMV8_FIRST))
187 pm->pm_md.pm_arm64.pm_arm64_evsel = config;
189 PMCDBG2(MDP, ALL, 2, "arm64-allocate ri=%d -> config=0x%x", ri, config);
196 arm64_read_pmc(int cpu, int ri, pmc_value_t *v)
203 KASSERT(cpu >= 0 && cpu < pmc_cpu_max(),
204 ("[arm64,%d] illegal CPU value %d", __LINE__, cpu));
205 KASSERT(ri >= 0 && ri < arm64_npmcs,
206 ("[arm64,%d] illegal row index %d", __LINE__, ri));
208 pm = arm64_pcpu[cpu]->pc_arm64pmcs[ri].phw_pmc;
211 * Ensure we don't get interrupted while updating the overflow count.
214 tmp = arm64_pmcn_read(ri);
216 if ((READ_SPECIALREG(pmovsclr_el0) & reg) != 0) {
217 /* Clear Overflow Flag */
218 WRITE_SPECIALREG(pmovsclr_el0, reg);
219 if (!PMC_IS_SAMPLING_MODE(PMC_TO_MODE(pm)))
220 pm->pm_pcpu_state[cpu].pps_overflowcnt++;
222 /* Reread counter in case we raced. */
223 tmp = arm64_pmcn_read(ri);
225 tmp += 0x100000000llu * pm->pm_pcpu_state[cpu].pps_overflowcnt;
228 PMCDBG2(MDP, REA, 2, "arm64-read id=%d -> %jd", ri, tmp);
229 if (PMC_IS_SAMPLING_MODE(PMC_TO_MODE(pm)))
230 *v = ARMV8_PERFCTR_VALUE_TO_RELOAD_COUNT(tmp);
238 arm64_write_pmc(int cpu, int ri, pmc_value_t v)
242 KASSERT(cpu >= 0 && cpu < pmc_cpu_max(),
243 ("[arm64,%d] illegal CPU value %d", __LINE__, cpu));
244 KASSERT(ri >= 0 && ri < arm64_npmcs,
245 ("[arm64,%d] illegal row-index %d", __LINE__, ri));
247 pm = arm64_pcpu[cpu]->pc_arm64pmcs[ri].phw_pmc;
249 if (PMC_IS_SAMPLING_MODE(PMC_TO_MODE(pm)))
250 v = ARMV8_RELOAD_COUNT_TO_PERFCTR_VALUE(v);
252 PMCDBG3(MDP, WRI, 1, "arm64-write cpu=%d ri=%d v=%jx", cpu, ri, v);
254 pm->pm_pcpu_state[cpu].pps_overflowcnt = v >> 32;
255 arm64_pmcn_write(ri, v);
261 arm64_config_pmc(int cpu, int ri, struct pmc *pm)
265 PMCDBG3(MDP, CFG, 1, "cpu=%d ri=%d pm=%p", cpu, ri, pm);
267 KASSERT(cpu >= 0 && cpu < pmc_cpu_max(),
268 ("[arm64,%d] illegal CPU value %d", __LINE__, cpu));
269 KASSERT(ri >= 0 && ri < arm64_npmcs,
270 ("[arm64,%d] illegal row-index %d", __LINE__, ri));
272 phw = &arm64_pcpu[cpu]->pc_arm64pmcs[ri];
274 KASSERT(pm == NULL || phw->phw_pmc == NULL,
275 ("[arm64,%d] pm=%p phw->pm=%p hwpmc not unconfigured",
276 __LINE__, pm, phw->phw_pmc));
284 arm64_start_pmc(int cpu, int ri)
290 phw = &arm64_pcpu[cpu]->pc_arm64pmcs[ri];
292 config = pm->pm_md.pm_arm64.pm_arm64_evsel;
295 * Configure the event selection.
297 WRITE_SPECIALREG(pmselr_el0, ri);
298 WRITE_SPECIALREG(pmxevtyper_el0, config);
305 arm64_interrupt_enable(ri);
306 arm64_counter_enable(ri);
312 arm64_stop_pmc(int cpu, int ri)
317 phw = &arm64_pcpu[cpu]->pc_arm64pmcs[ri];
323 arm64_counter_disable(ri);
324 arm64_interrupt_disable(ri);
330 arm64_release_pmc(int cpu, int ri, struct pmc *pmc)
334 KASSERT(cpu >= 0 && cpu < pmc_cpu_max(),
335 ("[arm64,%d] illegal CPU value %d", __LINE__, cpu));
336 KASSERT(ri >= 0 && ri < arm64_npmcs,
337 ("[arm64,%d] illegal row-index %d", __LINE__, ri));
339 phw = &arm64_pcpu[cpu]->pc_arm64pmcs[ri];
340 KASSERT(phw->phw_pmc == NULL,
341 ("[arm64,%d] PHW pmc %p non-NULL", __LINE__, phw->phw_pmc));
347 arm64_intr(struct trapframe *tf)
349 struct arm64_cpu *pc;
356 KASSERT(cpu >= 0 && cpu < pmc_cpu_max(),
357 ("[arm64,%d] CPU %d out of range", __LINE__, cpu));
360 pc = arm64_pcpu[cpu];
362 for (ri = 0; ri < arm64_npmcs; ri++) {
363 pm = arm64_pcpu[cpu]->pc_arm64pmcs[ri].phw_pmc;
366 /* Check if counter is overflowed */
368 if ((READ_SPECIALREG(pmovsclr_el0) & reg) == 0)
370 /* Clear Overflow Flag */
371 WRITE_SPECIALREG(pmovsclr_el0, reg);
375 retval = 1; /* Found an interrupting PMC. */
377 if (!PMC_IS_SAMPLING_MODE(PMC_TO_MODE(pm))) {
378 pm->pm_pcpu_state[cpu].pps_overflowcnt += 1;
382 if (pm->pm_state != PMC_STATE_RUNNING)
385 error = pmc_process_interrupt(PMC_HR, pm, tf);
387 arm64_stop_pmc(cpu, ri);
389 /* Reload sampling count */
390 arm64_write_pmc(cpu, ri, pm->pm_sc.pm_reloadcount);
397 arm64_describe(int cpu, int ri, struct pmc_info *pi, struct pmc **ppmc)
399 char arm64_name[PMC_NAME_MAX];
403 KASSERT(cpu >= 0 && cpu < pmc_cpu_max(),
404 ("[arm64,%d], illegal CPU %d", __LINE__, cpu));
405 KASSERT(ri >= 0 && ri < arm64_npmcs,
406 ("[arm64,%d] row-index %d out of range", __LINE__, ri));
408 phw = &arm64_pcpu[cpu]->pc_arm64pmcs[ri];
409 snprintf(arm64_name, sizeof(arm64_name), "ARMV8-%d", ri);
410 if ((error = copystr(arm64_name, pi->pm_name, PMC_NAME_MAX,
413 pi->pm_class = PMC_CLASS_ARMV8;
414 if (phw->phw_state & PMC_PHW_FLAG_IS_ENABLED) {
415 pi->pm_enabled = TRUE;
416 *ppmc = phw->phw_pmc;
418 pi->pm_enabled = FALSE;
426 arm64_get_config(int cpu, int ri, struct pmc **ppm)
429 *ppm = arm64_pcpu[cpu]->pc_arm64pmcs[ri].phw_pmc;
435 * XXX don't know what we should do here.
438 arm64_switch_in(struct pmc_cpu *pc, struct pmc_process *pp)
445 arm64_switch_out(struct pmc_cpu *pc, struct pmc_process *pp)
452 arm64_pcpu_init(struct pmc_mdep *md, int cpu)
454 struct arm64_cpu *pac;
461 KASSERT(cpu >= 0 && cpu < pmc_cpu_max(),
462 ("[arm64,%d] wrong cpu number %d", __LINE__, cpu));
463 PMCDBG1(MDP, INI, 1, "arm64-init cpu=%d", cpu);
465 arm64_pcpu[cpu] = pac = malloc(sizeof(struct arm64_cpu), M_PMC,
468 pac->pc_arm64pmcs = malloc(sizeof(struct pmc_hw) * arm64_npmcs,
469 M_PMC, M_WAITOK | M_ZERO);
471 first_ri = md->pmd_classdep[PMC_MDEP_CLASS_INDEX_ARMV8].pcd_ri;
472 KASSERT(pc != NULL, ("[arm64,%d] NULL per-cpu pointer", __LINE__));
474 for (i = 0, phw = pac->pc_arm64pmcs; i < arm64_npmcs; i++, phw++) {
475 phw->phw_state = PMC_PHW_FLAG_IS_ENABLED |
476 PMC_PHW_CPU_TO_STATE(cpu) | PMC_PHW_INDEX_TO_STATE(i);
478 pc->pc_hwpmcs[i + first_ri] = phw;
482 pmcr = arm64_pmcr_read();
484 arm64_pmcr_write(pmcr);
490 arm64_pcpu_fini(struct pmc_mdep *md, int cpu)
494 pmcr = arm64_pmcr_read();
496 arm64_pmcr_write(pmcr);
502 pmc_arm64_initialize()
504 struct pmc_mdep *pmc_mdep;
505 struct pmc_classdep *pcd;
509 reg = arm64_pmcr_read();
510 arm64_npmcs = (reg & PMCR_N_MASK) >> PMCR_N_SHIFT;
511 impcode = (reg & PMCR_IMP_MASK) >> PMCR_IMP_SHIFT;
512 idcode = (reg & PMCR_IDCODE_MASK) >> PMCR_IDCODE_SHIFT;
514 PMCDBG1(MDP, INI, 1, "arm64-init npmcs=%d", arm64_npmcs);
517 * Allocate space for pointers to PMC HW descriptors and for
518 * the MDEP structure used by MI code.
520 arm64_pcpu = malloc(sizeof(struct arm64_cpu *) * pmc_cpu_max(),
521 M_PMC, M_WAITOK | M_ZERO);
524 pmc_mdep = pmc_mdep_alloc(1);
529 case PMCR_IDCODE_CORTEX_A76:
530 case PMCR_IDCODE_NEOVERSE_N1:
531 pmc_mdep->pmd_cputype = PMC_CPU_ARMV8_CORTEX_A76;
533 case PMCR_IDCODE_CORTEX_A57:
534 case PMCR_IDCODE_CORTEX_A72:
535 pmc_mdep->pmd_cputype = PMC_CPU_ARMV8_CORTEX_A57;
538 case PMCR_IDCODE_CORTEX_A53:
539 pmc_mdep->pmd_cputype = PMC_CPU_ARMV8_CORTEX_A53;
544 pmc_mdep->pmd_cputype = PMC_CPU_ARMV8_CORTEX_A53;
548 pcd = &pmc_mdep->pmd_classdep[PMC_MDEP_CLASS_INDEX_ARMV8];
549 pcd->pcd_caps = ARMV8_PMC_CAPS;
550 pcd->pcd_class = PMC_CLASS_ARMV8;
551 pcd->pcd_num = arm64_npmcs;
552 pcd->pcd_ri = pmc_mdep->pmd_npmc;
555 pcd->pcd_allocate_pmc = arm64_allocate_pmc;
556 pcd->pcd_config_pmc = arm64_config_pmc;
557 pcd->pcd_pcpu_fini = arm64_pcpu_fini;
558 pcd->pcd_pcpu_init = arm64_pcpu_init;
559 pcd->pcd_describe = arm64_describe;
560 pcd->pcd_get_config = arm64_get_config;
561 pcd->pcd_read_pmc = arm64_read_pmc;
562 pcd->pcd_release_pmc = arm64_release_pmc;
563 pcd->pcd_start_pmc = arm64_start_pmc;
564 pcd->pcd_stop_pmc = arm64_stop_pmc;
565 pcd->pcd_write_pmc = arm64_write_pmc;
567 pmc_mdep->pmd_intr = arm64_intr;
568 pmc_mdep->pmd_switch_in = arm64_switch_in;
569 pmc_mdep->pmd_switch_out = arm64_switch_out;
571 pmc_mdep->pmd_npmc += arm64_npmcs;
577 pmc_arm64_finalize(struct pmc_mdep *md)