freebsd-dev/sys/dev/hwpmc/hwpmc_e500.c
Justin Hibbits a745246822 Implement hwpmc(4) for Freescale e500 core.
This supports e500v1, e500v2, and e500mc. Tested only on e500v2, but the
performance counters are identical across all, with e500mc having some
additional events.

Relnotes:	Yes
2015-04-18 21:39:17 +00:00

661 lines
19 KiB
C

/*-
* Copyright (c) 2015 Justin Hibbits
* Copyright (c) 2005, Joseph Koshy
* All rights reserved.
*
* Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that the following conditions
* are met:
* 1. Redistributions of source code must retain the above copyright
* notice, this list of conditions and the following disclaimer.
* 2. Redistributions in binary form must reproduce the above copyright
* notice, this list of conditions and the following disclaimer in the
* documentation and/or other materials provided with the distribution.
*
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
* ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
* ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
* FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
* DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
* OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
* HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
* OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
* SUCH DAMAGE.
*
*/
#include <sys/cdefs.h>
__FBSDID("$FreeBSD$");
#include <sys/param.h>
#include <sys/pmc.h>
#include <sys/pmckern.h>
#include <sys/systm.h>
#include <machine/pmc_mdep.h>
#include <machine/cpu.h>
#include <ddb/ddb.h>
#include "hwpmc_powerpc.h"
#define POWERPC_PMC_CAPS (PMC_CAP_INTERRUPT | PMC_CAP_USER | \
PMC_CAP_SYSTEM | PMC_CAP_EDGE | \
PMC_CAP_THRESHOLD | PMC_CAP_READ | \
PMC_CAP_WRITE | PMC_CAP_INVERT | \
PMC_CAP_QUALIFIER)
#define E500_PMC_HAS_OVERFLOWED(x) (e500_pmcn_read(x) & (0x1 << 31))
struct e500_event_code_map {
enum pmc_event pe_ev; /* enum value */
uint8_t pe_counter_mask; /* Which counter this can be counted in. */
uint8_t pe_code; /* numeric code */
uint8_t pe_cpu; /* e500 core (v1,v2,mc), mask */
};
#define E500_MAX_PMCS 4
#define PMC_PPC_MASK0 0
#define PMC_PPC_MASK1 1
#define PMC_PPC_MASK2 2
#define PMC_PPC_MASK3 3
#define PMC_PPC_MASK_ALL 0x0f
#define PMC_PPC_E500V1 1
#define PMC_PPC_E500V2 2
#define PMC_PPC_E500MC 4
#define PMC_PPC_E500_ANY 7
#define PMC_E500_EVENT(id, mask, number, core) \
[PMC_EV_E500_##id - PMC_EV_E500_FIRST] = \
{ .pe_ev = PMC_EV_E500_##id, .pe_counter_mask = mask, \
.pe_code = number, .pe_cpu = core }
#define PMC_E500MC_ONLY(id, number) \
PMC_E500_EVENT(id, PMC_PPC_MASK_ALL, number, PMC_PPC_E500MC)
#define PMC_E500_COMMON(id, number) \
PMC_E500_EVENT(id, PMC_PPC_MASK_ALL, number, PMC_PPC_E500_ANY)
static struct e500_event_code_map e500_event_codes[] = {
PMC_E500_COMMON(CYCLES, 1),
PMC_E500_COMMON(INSTR_COMPLETED, 2),
PMC_E500_COMMON(UOPS_COMPLETED, 3),
PMC_E500_COMMON(INSTR_FETCHED, 4),
PMC_E500_COMMON(UOPS_DECODED, 5),
PMC_E500_COMMON(PM_EVENT_TRANSITIONS, 6),
PMC_E500_COMMON(PM_EVENT_CYCLES, 7),
PMC_E500_COMMON(BRANCH_INSTRS_COMPLETED, 8),
PMC_E500_COMMON(LOAD_UOPS_COMPLETED, 9),
PMC_E500_COMMON(STORE_UOPS_COMPLETED, 10),
PMC_E500_COMMON(CQ_REDIRECTS, 11),
PMC_E500_COMMON(BRANCHES_FINISHED, 12),
PMC_E500_COMMON(TAKEN_BRANCHES_FINISHED, 13),
PMC_E500_COMMON(FINISHED_UNCOND_BRANCHES_MISS_BTB, 14),
PMC_E500_COMMON(BRANCH_MISPRED, 15),
PMC_E500_COMMON(BTB_BRANCH_MISPRED_FROM_DIRECTION, 16),
PMC_E500_COMMON(BTB_HITS_PSEUDO_HITS, 17),
PMC_E500_COMMON(CYCLES_DECODE_STALLED, 18),
PMC_E500_COMMON(CYCLES_ISSUE_STALLED, 19),
PMC_E500_COMMON(CYCLES_BRANCH_ISSUE_STALLED, 20),
PMC_E500_COMMON(CYCLES_SU1_SCHED_STALLED, 21),
PMC_E500_COMMON(CYCLES_SU2_SCHED_STALLED, 22),
PMC_E500_COMMON(CYCLES_MU_SCHED_STALLED, 23),
PMC_E500_COMMON(CYCLES_LRU_SCHED_STALLED, 24),
PMC_E500_COMMON(CYCLES_BU_SCHED_STALLED, 25),
PMC_E500_COMMON(TOTAL_TRANSLATED, 26),
PMC_E500_COMMON(LOADS_TRANSLATED, 27),
PMC_E500_COMMON(STORES_TRANSLATED, 28),
PMC_E500_COMMON(TOUCHES_TRANSLATED, 29),
PMC_E500_COMMON(CACHEOPS_TRANSLATED, 30),
PMC_E500_COMMON(CACHE_INHIBITED_ACCESS_TRANSLATED, 31),
PMC_E500_COMMON(GUARDED_LOADS_TRANSLATED, 32),
PMC_E500_COMMON(WRITE_THROUGH_STORES_TRANSLATED, 33),
PMC_E500_COMMON(MISALIGNED_LOAD_STORE_ACCESS_TRANSLATED, 34),
PMC_E500_COMMON(TOTAL_ALLOCATED_TO_DLFB, 35),
PMC_E500_COMMON(LOADS_TRANSLATED_ALLOCATED_TO_DLFB, 36),
PMC_E500_COMMON(STORES_COMPLETED_ALLOCATED_TO_DLFB, 37),
PMC_E500_COMMON(TOUCHES_TRANSLATED_ALLOCATED_TO_DLFB, 38),
PMC_E500_COMMON(STORES_COMPLETED, 39),
PMC_E500_COMMON(DATA_L1_CACHE_LOCKS, 40),
PMC_E500_COMMON(DATA_L1_CACHE_RELOADS, 41),
PMC_E500_COMMON(DATA_L1_CACHE_CASTOUTS, 42),
PMC_E500_COMMON(LOAD_MISS_DLFB_FULL, 43),
PMC_E500_COMMON(LOAD_MISS_LDQ_FULL, 44),
PMC_E500_COMMON(LOAD_GUARDED_MISS, 45),
PMC_E500_COMMON(STORE_TRANSLATE_WHEN_QUEUE_FULL, 46),
PMC_E500_COMMON(ADDRESS_COLLISION, 47),
PMC_E500_COMMON(DATA_MMU_MISS, 48),
PMC_E500_COMMON(DATA_MMU_BUSY, 49),
PMC_E500_COMMON(PART2_MISALIGNED_CACHE_ACCESS, 50),
PMC_E500_COMMON(LOAD_MISS_DLFB_FULL_CYCLES, 51),
PMC_E500_COMMON(LOAD_MISS_LDQ_FULL_CYCLES, 52),
PMC_E500_COMMON(LOAD_GUARDED_MISS_CYCLES, 53),
PMC_E500_COMMON(STORE_TRANSLATE_WHEN_QUEUE_FULL_CYCLES, 54),
PMC_E500_COMMON(ADDRESS_COLLISION_CYCLES, 55),
PMC_E500_COMMON(DATA_MMU_MISS_CYCLES, 56),
PMC_E500_COMMON(DATA_MMU_BUSY_CYCLES, 57),
PMC_E500_COMMON(PART2_MISALIGNED_CACHE_ACCESS_CYCLES, 58),
PMC_E500_COMMON(INSTR_L1_CACHE_LOCKS, 59),
PMC_E500_COMMON(INSTR_L1_CACHE_RELOADS, 60),
PMC_E500_COMMON(INSTR_L1_CACHE_FETCHES, 61),
PMC_E500_COMMON(INSTR_MMU_TLB4K_RELOADS, 62),
PMC_E500_COMMON(INSTR_MMU_VSP_RELOADS, 63),
PMC_E500_COMMON(DATA_MMU_TLB4K_RELOADS, 64),
PMC_E500_COMMON(DATA_MMU_VSP_RELOADS, 65),
PMC_E500_COMMON(L2MMU_MISSES, 66),
PMC_E500_COMMON(BIU_MASTER_REQUESTS, 67),
PMC_E500_COMMON(BIU_MASTER_INSTR_SIDE_REQUESTS, 68),
PMC_E500_COMMON(BIU_MASTER_DATA_SIDE_REQUESTS, 69),
PMC_E500_COMMON(BIU_MASTER_DATA_SIDE_CASTOUT_REQUESTS, 70),
PMC_E500_COMMON(BIU_MASTER_RETRIES, 71),
PMC_E500_COMMON(SNOOP_REQUESTS, 72),
PMC_E500_COMMON(SNOOP_HITS, 73),
PMC_E500_COMMON(SNOOP_PUSHES, 74),
PMC_E500_COMMON(SNOOP_RETRIES, 75),
PMC_E500_EVENT(DLFB_LOAD_MISS_CYCLES, PMC_PPC_MASK0|PMC_PPC_MASK1,
76, PMC_PPC_E500_ANY),
PMC_E500_EVENT(ILFB_FETCH_MISS_CYCLES, PMC_PPC_MASK0|PMC_PPC_MASK1,
77, PMC_PPC_E500_ANY),
PMC_E500_EVENT(EXT_INPU_INTR_LATENCY_CYCLES, PMC_PPC_MASK0|PMC_PPC_MASK1,
78, PMC_PPC_E500_ANY),
PMC_E500_EVENT(CRIT_INPUT_INTR_LATENCY_CYCLES, PMC_PPC_MASK0|PMC_PPC_MASK1,
79, PMC_PPC_E500_ANY),
PMC_E500_EVENT(EXT_INPUT_INTR_PENDING_LATENCY_CYCLES,
PMC_PPC_MASK0|PMC_PPC_MASK1, 80, PMC_PPC_E500_ANY),
PMC_E500_EVENT(CRIT_INPUT_INTR_PENDING_LATENCY_CYCLES,
PMC_PPC_MASK0|PMC_PPC_MASK1, 81, PMC_PPC_E500_ANY),
PMC_E500_COMMON(PMC0_OVERFLOW, 82),
PMC_E500_COMMON(PMC1_OVERFLOW, 83),
PMC_E500_COMMON(PMC2_OVERFLOW, 84),
PMC_E500_COMMON(PMC3_OVERFLOW, 85),
PMC_E500_COMMON(INTERRUPTS_TAKEN, 86),
PMC_E500_COMMON(EXT_INPUT_INTR_TAKEN, 87),
PMC_E500_COMMON(CRIT_INPUT_INTR_TAKEN, 88),
PMC_E500_COMMON(SYSCALL_TRAP_INTR, 89),
PMC_E500_EVENT(TLB_BIT_TRANSITIONS, PMC_PPC_MASK_ALL, 90,
PMC_PPC_E500V2 | PMC_PPC_E500MC),
PMC_E500MC_ONLY(L2_LINEFILL_BUFFER, 91),
PMC_E500MC_ONLY(LV2_VS, 92),
PMC_E500MC_ONLY(CASTOUTS_RELEASED, 93),
PMC_E500MC_ONLY(INTV_ALLOCATIONS, 94),
PMC_E500MC_ONLY(DLFB_RETRIES_TO_MBAR, 95),
PMC_E500MC_ONLY(STORE_RETRIES, 96),
PMC_E500MC_ONLY(STASH_L1_HITS, 97),
PMC_E500MC_ONLY(STASH_L2_HITS, 98),
PMC_E500MC_ONLY(STASH_BUSY_1, 99),
PMC_E500MC_ONLY(STASH_BUSY_2, 100),
PMC_E500MC_ONLY(STASH_BUSY_3, 101),
PMC_E500MC_ONLY(STASH_HITS, 102),
PMC_E500MC_ONLY(STASH_HIT_DLFB, 103),
PMC_E500MC_ONLY(STASH_REQUESTS, 106),
PMC_E500MC_ONLY(STASH_REQUESTS_L1, 107),
PMC_E500MC_ONLY(STASH_REQUESTS_L2, 108),
PMC_E500MC_ONLY(STALLS_NO_CAQ_OR_COB, 109),
PMC_E500MC_ONLY(L2_CACHE_ACCESSES, 110),
PMC_E500MC_ONLY(L2_HIT_CACHE_ACCESSES, 111),
PMC_E500MC_ONLY(L2_CACHE_DATA_ACCESSES, 112),
PMC_E500MC_ONLY(L2_CACHE_DATA_HITS, 113),
PMC_E500MC_ONLY(L2_CACHE_INSTR_ACCESSES, 114),
PMC_E500MC_ONLY(L2_CACHE_INSTR_HITS, 115),
PMC_E500MC_ONLY(L2_CACHE_ALLOCATIONS, 116),
PMC_E500MC_ONLY(L2_CACHE_DATA_ALLOCATIONS, 117),
PMC_E500MC_ONLY(L2_CACHE_DIRTY_DATA_ALLOCATIONS, 118),
PMC_E500MC_ONLY(L2_CACHE_INSTR_ALLOCATIONS, 119),
PMC_E500MC_ONLY(L2_CACHE_UPDATES, 120),
PMC_E500MC_ONLY(L2_CACHE_CLEAN_UPDATES, 121),
PMC_E500MC_ONLY(L2_CACHE_DIRTY_UPDATES, 122),
PMC_E500MC_ONLY(L2_CACHE_CLEAN_REDUNDANT_UPDATES, 123),
PMC_E500MC_ONLY(L2_CACHE_DIRTY_REDUNDANT_UPDATES, 124),
PMC_E500MC_ONLY(L2_CACHE_LOCKS, 125),
PMC_E500MC_ONLY(L2_CACHE_CASTOUTS, 126),
PMC_E500MC_ONLY(L2_CACHE_DATA_DIRTY_HITS, 127),
PMC_E500MC_ONLY(INSTR_LFB_WENT_HIGH_PRIORITY, 128),
PMC_E500MC_ONLY(SNOOP_THROTTLING_TURNED_ON, 129),
PMC_E500MC_ONLY(L2_CLEAN_LINE_INVALIDATIONS, 130),
PMC_E500MC_ONLY(L2_INCOHERENT_LINE_INVALIDATIONS, 131),
PMC_E500MC_ONLY(L2_COHERENT_LINE_INVALIDATIONS, 132),
PMC_E500MC_ONLY(COHERENT_LOOKUP_MISS_DUE_TO_VALID_BUT_INCOHERENT_MATCHES, 133),
PMC_E500MC_ONLY(IAC1S_DETECTED, 140),
PMC_E500MC_ONLY(IAC2S_DETECTED, 141),
PMC_E500MC_ONLY(DAC1S_DTECTED, 144),
PMC_E500MC_ONLY(DAC2S_DTECTED, 145),
PMC_E500MC_ONLY(DVT0_DETECTED, 148),
PMC_E500MC_ONLY(DVT1_DETECTED, 149),
PMC_E500MC_ONLY(DVT2_DETECTED, 150),
PMC_E500MC_ONLY(DVT3_DETECTED, 151),
PMC_E500MC_ONLY(DVT4_DETECTED, 152),
PMC_E500MC_ONLY(DVT5_DETECTED, 153),
PMC_E500MC_ONLY(DVT6_DETECTED, 154),
PMC_E500MC_ONLY(DVT7_DETECTED, 155),
PMC_E500MC_ONLY(CYCLES_COMPLETION_STALLED_NEXUS_FIFO_FULL, 156),
PMC_E500MC_ONLY(FPU_DOUBLE_PUMP, 160),
PMC_E500MC_ONLY(FPU_FINISH, 161),
PMC_E500MC_ONLY(FPU_DIVIDE_CYCLES, 162),
PMC_E500MC_ONLY(FPU_DENORM_INPUT_CYCLES, 163),
PMC_E500MC_ONLY(FPU_RESULT_STALL_CYCLES, 164),
PMC_E500MC_ONLY(FPU_FPSCR_FULL_STALL, 165),
PMC_E500MC_ONLY(FPU_PIPE_SYNC_STALLS, 166),
PMC_E500MC_ONLY(FPU_INPUT_DATA_STALLS, 167),
PMC_E500MC_ONLY(DECORATED_LOADS, 176),
PMC_E500MC_ONLY(DECORATED_STORES, 177),
PMC_E500MC_ONLY(LOAD_RETRIES, 178),
PMC_E500MC_ONLY(STWCX_SUCCESSES, 179),
PMC_E500MC_ONLY(STWCX_FAILURES, 180),
};
const size_t e500_event_codes_size =
sizeof(e500_event_codes) / sizeof(e500_event_codes[0]);
static pmc_value_t
e500_pmcn_read(unsigned int pmc)
{
switch (pmc) {
case 0:
return mfpmr(PMR_PMC0);
break;
case 1:
return mfpmr(PMR_PMC1);
break;
case 2:
return mfpmr(PMR_PMC2);
break;
case 3:
return mfpmr(PMR_PMC3);
break;
default:
panic("Invalid PMC number: %d\n", pmc);
}
}
static void
e500_pmcn_write(unsigned int pmc, uint32_t val)
{
switch (pmc) {
case 0:
mtpmr(PMR_PMC0, val);
break;
case 1:
mtpmr(PMR_PMC1, val);
break;
case 2:
mtpmr(PMR_PMC2, val);
break;
case 3:
mtpmr(PMR_PMC3, val);
break;
default:
panic("Invalid PMC number: %d\n", pmc);
}
}
static int
e500_read_pmc(int cpu, int ri, pmc_value_t *v)
{
struct pmc *pm;
pmc_value_t tmp;
KASSERT(cpu >= 0 && cpu < pmc_cpu_max(),
("[powerpc,%d] illegal CPU value %d", __LINE__, cpu));
KASSERT(ri >= 0 && ri < E500_MAX_PMCS,
("[powerpc,%d] illegal row index %d", __LINE__, ri));
pm = powerpc_pcpu[cpu]->pc_ppcpmcs[ri].phw_pmc;
KASSERT(pm,
("[core,%d] cpu %d ri %d pmc not configured", __LINE__, cpu,
ri));
tmp = e500_pmcn_read(ri);
PMCDBG(MDP,REA,2,"ppc-read id=%d -> %jd", ri, tmp);
if (PMC_IS_SAMPLING_MODE(PMC_TO_MODE(pm)))
*v = POWERPC_PERFCTR_VALUE_TO_RELOAD_COUNT(tmp);
else
*v = tmp;
return 0;
}
static int
e500_write_pmc(int cpu, int ri, pmc_value_t v)
{
struct pmc *pm;
KASSERT(cpu >= 0 && cpu < pmc_cpu_max(),
("[powerpc,%d] illegal CPU value %d", __LINE__, cpu));
KASSERT(ri >= 0 && ri < E500_MAX_PMCS,
("[powerpc,%d] illegal row-index %d", __LINE__, ri));
pm = powerpc_pcpu[cpu]->pc_ppcpmcs[ri].phw_pmc;
if (PMC_IS_SAMPLING_MODE(PMC_TO_MODE(pm)))
v = POWERPC_RELOAD_COUNT_TO_PERFCTR_VALUE(v);
PMCDBG(MDP,WRI,1,"powerpc-write cpu=%d ri=%d v=%jx", cpu, ri, v);
e500_pmcn_write(ri, v);
return 0;
}
static int
e500_config_pmc(int cpu, int ri, struct pmc *pm)
{
struct pmc_hw *phw;
PMCDBG(MDP,CFG,1, "cpu=%d ri=%d pm=%p", cpu, ri, pm);
KASSERT(cpu >= 0 && cpu < pmc_cpu_max(),
("[powerpc,%d] illegal CPU value %d", __LINE__, cpu));
KASSERT(ri >= 0 && ri < E500_MAX_PMCS,
("[powerpc,%d] illegal row-index %d", __LINE__, ri));
phw = &powerpc_pcpu[cpu]->pc_ppcpmcs[ri];
KASSERT(pm == NULL || phw->phw_pmc == NULL,
("[powerpc,%d] pm=%p phw->pm=%p hwpmc not unconfigured",
__LINE__, pm, phw->phw_pmc));
phw->phw_pmc = pm;
return 0;
}
static int
e500_start_pmc(int cpu, int ri)
{
uint32_t config;
struct pmc *pm;
struct pmc_hw *phw;
phw = &powerpc_pcpu[cpu]->pc_ppcpmcs[ri];
pm = phw->phw_pmc;
config = pm->pm_md.pm_powerpc.pm_powerpc_evsel;
if (PMC_IS_SAMPLING_MODE(PMC_TO_MODE(pm)))
config |= PMLCax_CE;
/* Enable the PMC. */
switch (ri) {
case 0:
mtpmr(PMR_PMLCa0, config);
break;
case 1:
mtpmr(PMR_PMLCa1, config);
break;
case 2:
mtpmr(PMR_PMLCa2, config);
break;
case 3:
mtpmr(PMR_PMLCa3, config);
break;
default:
break;
}
return 0;
}
static int
e500_stop_pmc(int cpu, int ri)
{
struct pmc *pm;
struct pmc_hw *phw;
register_t pmc_pmlc;
phw = &powerpc_pcpu[cpu]->pc_ppcpmcs[ri];
pm = phw->phw_pmc;
/*
* Disable the PMCs.
*/
switch (ri) {
case 0:
pmc_pmlc = mfpmr(PMR_PMLCa0);
pmc_pmlc |= PMLCax_FC;
mtpmr(PMR_PMLCa0, pmc_pmlc);
break;
case 1:
pmc_pmlc = mfpmr(PMR_PMLCa1);
pmc_pmlc |= PMLCax_FC;
mtpmr(PMR_PMLCa1, pmc_pmlc);
break;
case 2:
pmc_pmlc = mfpmr(PMR_PMLCa2);
pmc_pmlc |= PMLCax_FC;
mtpmr(PMR_PMLCa2, pmc_pmlc);
break;
case 3:
pmc_pmlc = mfpmr(PMR_PMLCa3);
pmc_pmlc |= PMLCax_FC;
mtpmr(PMR_PMLCa3, pmc_pmlc);
break;
default:
break;
}
return 0;
}
static int
e500_pcpu_init(struct pmc_mdep *md, int cpu)
{
int first_ri, i;
struct pmc_cpu *pc;
struct powerpc_cpu *pac;
struct pmc_hw *phw;
KASSERT(cpu >= 0 && cpu < pmc_cpu_max(),
("[powerpc,%d] wrong cpu number %d", __LINE__, cpu));
PMCDBG(MDP,INI,1,"powerpc-init cpu=%d", cpu);
/* Freeze all counters. */
mtpmr(PMR_PMGC0, PMGC_FAC | PMGC_PMIE | PMGC_FCECE);
powerpc_pcpu[cpu] = pac = malloc(sizeof(struct powerpc_cpu), M_PMC,
M_WAITOK|M_ZERO);
pac->pc_ppcpmcs = malloc(sizeof(struct pmc_hw) * E500_MAX_PMCS,
M_PMC, M_WAITOK|M_ZERO);
pac->pc_class = PMC_CLASS_E500;
pc = pmc_pcpu[cpu];
first_ri = md->pmd_classdep[PMC_MDEP_CLASS_INDEX_POWERPC].pcd_ri;
KASSERT(pc != NULL, ("[powerpc,%d] NULL per-cpu pointer", __LINE__));
for (i = 0, phw = pac->pc_ppcpmcs; i < E500_MAX_PMCS; i++, phw++) {
phw->phw_state = PMC_PHW_FLAG_IS_ENABLED |
PMC_PHW_CPU_TO_STATE(cpu) | PMC_PHW_INDEX_TO_STATE(i);
phw->phw_pmc = NULL;
pc->pc_hwpmcs[i + first_ri] = phw;
/* Initialize the PMC to stopped */
e500_stop_pmc(cpu, i);
}
/* Unfreeze global register. */
mtpmr(PMR_PMGC0, PMGC_PMIE | PMGC_FCECE);
return 0;
}
static int
e500_pcpu_fini(struct pmc_mdep *md, int cpu)
{
uint32_t pmgc0 = mfpmr(PMR_PMGC0);
pmgc0 |= PMGC_FAC;
mtpmr(PMR_PMGC0, pmgc0);
mtmsr(mfmsr() & ~PSL_PMM);
free(powerpc_pcpu[cpu]->pc_ppcpmcs, M_PMC);
free(powerpc_pcpu[cpu], M_PMC);
return 0;
}
static int
e500_allocate_pmc(int cpu, int ri, struct pmc *pm,
const struct pmc_op_pmcallocate *a)
{
enum pmc_event pe;
uint32_t caps, config, counter;
struct e500_event_code_map *ev;
uint16_t vers;
uint8_t pe_cpu_mask;
KASSERT(cpu >= 0 && cpu < pmc_cpu_max(),
("[powerpc,%d] illegal CPU value %d", __LINE__, cpu));
KASSERT(ri >= 0 && ri < E500_MAX_PMCS,
("[powerpc,%d] illegal row index %d", __LINE__, ri));
caps = a->pm_caps;
pe = a->pm_ev;
config = PMLCax_FCS | PMLCax_FCU |
PMLCax_FCM1 | PMLCax_FCM1;
if (pe < PMC_EV_E500_FIRST || pe > PMC_EV_E500_LAST)
return (EINVAL);
ev = &e500_event_codes[pe-PMC_EV_E500_FIRST];
if (ev->pe_code == 0)
return (EINVAL);
vers = mfpvr() >> 16;
switch (vers) {
case FSL_E500v1:
pe_cpu_mask = ev->pe_code & PMC_PPC_E500V1;
break;
case FSL_E500v2:
pe_cpu_mask = ev->pe_code & PMC_PPC_E500V2;
break;
case FSL_E500mc:
pe_cpu_mask = ev->pe_code & PMC_PPC_E500MC;
break;
}
if (pe_cpu_mask == 0)
return (EINVAL);
config |= PMLCax_EVENT(ev->pe_code);
counter = ev->pe_counter_mask;
if ((counter & (1 << ri)) == 0)
return (EINVAL);
if (caps & PMC_CAP_SYSTEM)
config &= ~PMLCax_FCS;
if (caps & PMC_CAP_USER)
config &= ~PMLCax_FCU;
if ((caps & (PMC_CAP_USER | PMC_CAP_SYSTEM)) == 0)
config &= ~(PMLCax_FCS|PMLCax_FCU);
pm->pm_md.pm_powerpc.pm_powerpc_evsel = config;
PMCDBG(MDP,ALL,2,"powerpc-allocate ri=%d -> config=0x%x", ri, config);
return 0;
}
static int
e500_release_pmc(int cpu, int ri, struct pmc *pmc)
{
struct pmc_hw *phw;
KASSERT(cpu >= 0 && cpu < pmc_cpu_max(),
("[powerpc,%d] illegal CPU value %d", __LINE__, cpu));
KASSERT(ri >= 0 && ri < E500_MAX_PMCS,
("[powerpc,%d] illegal row-index %d", __LINE__, ri));
phw = &powerpc_pcpu[cpu]->pc_ppcpmcs[ri];
KASSERT(phw->phw_pmc == NULL,
("[powerpc,%d] PHW pmc %p non-NULL", __LINE__, phw->phw_pmc));
return 0;
}
static int
e500_intr(int cpu, struct trapframe *tf)
{
int i, error, retval;
uint32_t config;
struct pmc *pm;
struct powerpc_cpu *pac;
KASSERT(cpu >= 0 && cpu < pmc_cpu_max(),
("[powerpc,%d] out of range CPU %d", __LINE__, cpu));
PMCDBG(MDP,INT,1, "cpu=%d tf=%p um=%d", cpu, (void *) tf,
TRAPF_USERMODE(tf));
retval = 0;
pac = powerpc_pcpu[cpu];
config = mfpmr(PMR_PMGC0) & ~PMGC_FAC;
/*
* look for all PMCs that have interrupted:
* - look for a running, sampling PMC which has overflowed
* and which has a valid 'struct pmc' association
*
* If found, we call a helper to process the interrupt.
*/
for (i = 0; i < E500_MAX_PMCS; i++) {
if ((pm = pac->pc_ppcpmcs[i].phw_pmc) == NULL ||
!PMC_IS_SAMPLING_MODE(PMC_TO_MODE(pm))) {
continue;
}
if (!E500_PMC_HAS_OVERFLOWED(i))
continue;
retval = 1; /* Found an interrupting PMC. */
if (pm->pm_state != PMC_STATE_RUNNING)
continue;
/* Stop the counter if logging fails. */
error = pmc_process_interrupt(cpu, PMC_HR, pm, tf,
TRAPF_USERMODE(tf));
if (error != 0)
e500_stop_pmc(cpu, i);
/* reload count. */
e500_write_pmc(cpu, i, pm->pm_sc.pm_reloadcount);
}
atomic_add_int(retval ? &pmc_stats.pm_intr_processed :
&pmc_stats.pm_intr_ignored, 1);
/* Re-enable PERF exceptions. */
if (retval)
mtpmr(PMR_PMGC0, config | PMGC_PMIE);
return (retval);
}
int
pmc_e500_initialize(struct pmc_mdep *pmc_mdep)
{
struct pmc_classdep *pcd;
pmc_mdep->pmd_cputype = PMC_CPU_PPC_E500;
pcd = &pmc_mdep->pmd_classdep[PMC_MDEP_CLASS_INDEX_POWERPC];
pcd->pcd_caps = POWERPC_PMC_CAPS;
pcd->pcd_class = PMC_CLASS_E500;
pcd->pcd_num = E500_MAX_PMCS;
pcd->pcd_ri = pmc_mdep->pmd_npmc;
pcd->pcd_width = 32;
pcd->pcd_allocate_pmc = e500_allocate_pmc;
pcd->pcd_config_pmc = e500_config_pmc;
pcd->pcd_pcpu_fini = e500_pcpu_fini;
pcd->pcd_pcpu_init = e500_pcpu_init;
pcd->pcd_describe = powerpc_describe;
pcd->pcd_get_config = powerpc_get_config;
pcd->pcd_read_pmc = e500_read_pmc;
pcd->pcd_release_pmc = e500_release_pmc;
pcd->pcd_start_pmc = e500_start_pmc;
pcd->pcd_stop_pmc = e500_stop_pmc;
pcd->pcd_write_pmc = e500_write_pmc;
pmc_mdep->pmd_npmc += E500_MAX_PMCS;
pmc_mdep->pmd_intr = e500_intr;
return (0);
}