aboutsummaryrefslogtreecommitdiff
path: root/lib/extensions/mpam/mpam.c
blob: e628827bf6e05f54f3305bdd1c53c58f18c43582 (plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
/*
 * Copyright (c) 2018, ARM Limited and Contributors. All rights reserved.
 *
 * SPDX-License-Identifier: BSD-3-Clause
 */

#include <arch.h>
#include <arch_helpers.h>
#include <mpam.h>
#include <stdbool.h>

bool mpam_supported(void)
{
	uint64_t features = read_id_aa64dfr0_el1() >> ID_AA64PFR0_MPAM_SHIFT;

	return ((features & ID_AA64PFR0_MPAM_MASK) != 0U);
}

void mpam_enable(int el2_unused)
{
	if (!mpam_supported())
		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_unused != 0) {
		write_mpam2_el2(0);

		if ((read_mpamidr_el1() & MPAMIDR_HAS_HCR_BIT) != 0U)
			write_mpamhcr_el2(0);
	}
}