mirror of
https://github.com/ARM-software/arm-trusted-firmware.git
synced 2025-04-21 03:54:34 +00:00
dbcc44a10e
This patch fixes wrong ID_AA64DFR0_EL1 register read instead of ID_AA64PFR0_EL1 to detect support for MPAM extension. It also implements get_mpam_version() function which returns MPAM version as: 0x00: None Armv8.0 or later; 0x01: v0.1 Armv8.4 or later; 0x10: v1.0 Armv8.2 or later; 0x11: v1.1 Armv8.4 or later; Change-Id: I31d776b1a1b60cb16e5e62296d70adb129d7b760 Reported-by: Matteo Zini <matteozini96@gmail.com> Signed-off-by: Alexei Fedorov <Alexei.Fedorov@arm.com>
46 lines
1 KiB
C
46 lines
1 KiB
C
/*
|
|
* Copyright (c) 2018-2020, ARM Limited and Contributors. All rights reserved.
|
|
*
|
|
* SPDX-License-Identifier: BSD-3-Clause
|
|
*/
|
|
|
|
#include <stdbool.h>
|
|
|
|
#include <arch.h>
|
|
#include <arch_features.h>
|
|
#include <arch_helpers.h>
|
|
#include <lib/extensions/mpam.h>
|
|
|
|
void mpam_enable(bool el2_unused)
|
|
{
|
|
/* Check if MPAM is implemented */
|
|
if (get_mpam_version() == 0U) {
|
|
return;
|
|
}
|
|
|
|
/*
|
|
* Enable MPAM, and disable trapping to EL3 when lower ELs access their
|
|
* own MPAM registers.
|
|
*/
|
|
write_mpam3_el3(MPAM3_EL3_MPAMEN_BIT);
|
|
|
|
/*
|
|
* If EL2 is implemented but unused, disable trapping to EL2 when lower
|
|
* ELs access their own MPAM registers.
|
|
* If EL2 is implemented and used, enable trapping to EL2.
|
|
*/
|
|
if (el2_unused) {
|
|
write_mpam2_el2(0ULL);
|
|
|
|
if ((read_mpamidr_el1() & MPAMIDR_HAS_HCR_BIT) != 0U) {
|
|
write_mpamhcr_el2(0ULL);
|
|
}
|
|
} else {
|
|
write_mpam2_el2(MPAM2_EL2_TRAPMPAM0EL1 |
|
|
MPAM2_EL2_TRAPMPAM1EL1);
|
|
|
|
if ((read_mpamidr_el1() & MPAMIDR_HAS_HCR_BIT) != 0U) {
|
|
write_mpamhcr_el2(MPAMHCR_EL2_TRAP_MPAMIDR_EL1);
|
|
}
|
|
}
|
|
}
|