| 1 |
/* |
| 2 |
* Copyright (c) 2023, Arm Limited. All rights reserved. |
| 3 |
* |
| 4 |
* SPDX-License-Identifier: BSD-3-Clause |
| 5 |
*/ |
| 6 |
|
| 7 |
#include <arch.h> |
| 8 |
#include <arch_features.h> |
| 9 |
#include <arch_helpers.h> |
| 10 |
#include <lib/extensions/pmuv3.h> |
| 11 |
|
| 12 |
static u_register_t mtpmu_disable_el3(u_register_t sdcr) |
| 13 |
{ |
| 14 |
if (!is_feat_mtpmu_supported()) { |
| 15 |
return sdcr; |
| 16 |
} |
| 17 |
|
| 18 |
/* |
| 19 |
* SDCR.MTPME = 0 |
| 20 |
* FEAT_MTPMU is disabled. The Effective value of PMEVTYPER<n>.MT is |
| 21 |
* zero. |
| 22 |
*/ |
| 23 |
sdcr &= ~SDCR_MTPME_BIT; |
| 24 |
|
| 25 |
return sdcr; |
| 26 |
} |
| 27 |
|
| 28 |
void pmuv3_init_el3(void) |
| 29 |
{ |
| 30 |
u_register_t sdcr = read_sdcr(); |
| 31 |
|
| 32 |
/* --------------------------------------------------------------------- |
| 33 |
* Initialise SDCR, setting all the fields rather than relying on hw. |
| 34 |
* |
| 35 |
* SDCR.SCCD: Set to one so that cycle counting by PMCCNTR is prohibited |
| 36 |
* in Secure state. This bit is RES0 in versions of the architecture |
| 37 |
* earlier than ARMv8.5 |
| 38 |
* |
| 39 |
* SDCR.SPME: Set to zero so that event counting is prohibited in Secure |
| 40 |
* state (and explicitly EL3 with later revisions). If ARMv8.2 Debug is |
| 41 |
* not implemented this bit does not have any effect on the counters |
| 42 |
* unless there is support for the implementation defined |
| 43 |
* authentication interface ExternalSecureNoninvasiveDebugEnabled(). |
| 44 |
* --------------------------------------------------------------------- |
| 45 |
*/ |
| 46 |
sdcr = (sdcr | SDCR_SCCD_BIT) & ~SDCR_SPME_BIT; |
| 47 |
sdcr = mtpmu_disable_el3(sdcr); |
| 48 |
write_sdcr(sdcr); |
| 49 |
|
| 50 |
/* --------------------------------------------------------------------- |
| 51 |
* Initialise PMCR, setting all fields rather than relying |
| 52 |
* on hw. Some fields are architecturally UNKNOWN on reset. |
| 53 |
* |
| 54 |
* PMCR.DP: Set to one to prohibit cycle counting whilst in Secure mode. |
| 55 |
* |
| 56 |
* PMCR.X: Set to zero to disable export of events. |
| 57 |
* |
| 58 |
* PMCR.C: Set to one to reset PMCCNTR. |
| 59 |
* |
| 60 |
* PMCR.P: Set to one to reset each event counter PMEVCNTR<n> to zero. |
| 61 |
* |
| 62 |
* PMCR.E: Set to zero to disable cycle and event counters. |
| 63 |
* --------------------------------------------------------------------- |
| 64 |
*/ |
| 65 |
|
| 66 |
write_pmcr(read_pmcr() | PMCR_DP_BIT | PMCR_C_BIT | PMCR_P_BIT | |
| 67 |
~(PMCR_X_BIT | PMCR_E_BIT)); |
| 68 |
} |