xref: /rk3399_ARM-atf/lib/cpus/aarch64/c1_premium.S (revision 99b23d8aeeeef47fbeb2a63ce32f0a4c48928bff)
1/*
2 * Copyright (c) 2024-2025, Arm Limited. All rights reserved.
3 *
4 * SPDX-License-Identifier: BSD-3-Clause
5 */
6
7#include <arch.h>
8#include <asm_macros.S>
9#include <c1_premium.h>
10#include <common/bl_common.h>
11#include <cpu_macros.S>
12
13#include <plat_macros.S>
14
15/* Hardware handled coherency */
16#if HW_ASSISTED_COHERENCY == 0
17#error "Arm C1-Premium must be compiled with HW_ASSISTED_COHERENCY enabled"
18#endif
19
20/* 64-bit only core */
21#if CTX_INCLUDE_AARCH32_REGS == 1
22#error "Arm C1-Premium supports only AArch64. Compile with CTX_INCLUDE_AARCH32_REGS=0"
23#endif
24
25#if ERRATA_SME_POWER_DOWN == 0
26#error "Arm C1-Premium needs ERRATA_SME_POWER_DOWN=1 to powerdown correctly"
27#endif
28
29cpu_reset_prologue c1_premium
30
31	/* ---------------------------------------------------------------
32	 * CVE-2024-7881 is mitigated for C1-Premium using erratum 3651221
33	 * workaround by disabling the affected prefetcher setting
34	 * CPUACTLR6_EL1[41].
35	 * ---------------------------------------------------------------
36	 */
37workaround_reset_start c1_premium, CVE(2024, 7881), WORKAROUND_CVE_2024_7881
38	sysreg_bit_set C1_PREMIUM_CPUACTLR6_EL1, BIT(41)
39workaround_reset_end c1_premium, CVE(2024, 7881)
40
41check_erratum_ls c1_premium, CVE(2024, 7881), CPU_REV(0, 0)
42
43workaround_reset_start c1_premium, ERRATUM(3502731), ERRATA_C1PREMIUM_3502731
44	sysreg_bit_set C1_PREMIUM_IMP_CPUACTLR4_EL1, BIT(23)
45workaround_reset_end c1_premium, ERRATUM(3502731)
46
47check_erratum_ls c1_premium, ERRATUM(3502731), CPU_REV(0, 0)
48
49workaround_reset_start c1_premium, ERRATUM(3651221), ERRATA_C1PREMIUM_3651221
50	sysreg_bit_set C1_PREMIUM_CPUACTLR6_EL1, BIT(41)
51workaround_reset_end c1_premium, ERRATUM(3651221)
52
53check_erratum_ls c1_premium, ERRATUM(3651221), CPU_REV(0, 0)
54
55workaround_reset_start c1_premium, ERRATUM(3684152), ERRATA_C1PREMIUM_3684152
56	sysreg_bitfield_insert C1_PREMIUM_IMP_CPUACTLR_EL1, C1_PREMIUM_IMP_CPUACTLR_EL1_LOAD_BIT, \
57	C1_PREMIUM_IMP_CPUACTLR_EL1_LOAD_SHIFT, C1_PREMIUM_IMP_CPUACTLR_EL1_LOAD_WIDTH
58workaround_reset_end c1_premium, ERRATUM(3684152)
59
60check_erratum_ls c1_premium, ERRATUM(3684152), CPU_REV(0, 0)
61
62workaround_reset_start c1_premium, ERRATUM(3705939), ERRATA_C1PREMIUM_3705939
63	sysreg_bit_set C1_PREMIUM_IMP_CPUACTLR_EL1, BIT(48)
64workaround_reset_end c1_premium, ERRATUM(3705939)
65
66check_erratum_ls c1_premium, ERRATUM(3705939), CPU_REV(1, 0)
67
68workaround_reset_start c1_premium, ERRATUM(3815514), ERRATA_C1PREMIUM_3815514
69	sysreg_bit_set C1_PREMIUM_IMP_CPUACTLR5_EL1, BIT(13)
70workaround_reset_end c1_premium, ERRATUM(3815514)
71
72check_erratum_ls c1_premium, ERRATUM(3815514), CPU_REV(1, 0)
73
74workaround_reset_start c1_premium, ERRATUM(3865171), ERRATA_C1PREMIUM_3865171
75	sysreg_bit_set C1_PREMIUM_IMP_CPUACTLR2_EL1, BIT(22)
76workaround_reset_end c1_premium, ERRATUM(3865171)
77
78check_erratum_ls c1_premium, ERRATUM(3865171), CPU_REV(1, 0)
79
80workaround_reset_start c1_premium, ERRATUM(3926381), ERRATA_C1PREMIUM_3926381
81	/* Convert WFx to NOP */
82	ldr x0,=0x0
83	msr C1_PREMIUM_IMP_CPUPSELR_EL3, x0
84	ldr x0,=0xD503205f
85	msr C1_PREMIUM_IMP_CPUPOR_EL3, x0
86	ldr x0,=0xFFFFFFDF
87	msr C1_PREMIUM_IMP_CPUPMR_EL3, x0
88	ldr x0,=0x1000002043ff
89	msr C1_PREMIUM_IMP_CPUPCR_EL3, x0
90
91	/* Convert WFxT to NOP */
92	ldr x0,=0x1
93	msr C1_PREMIUM_IMP_CPUPSELR_EL3, x0
94	ldr x0,=0xD5031000
95	msr C1_PREMIUM_IMP_CPUPOR_EL3, x0
96	ldr x0,=0xFFFFFFC0
97	msr C1_PREMIUM_IMP_CPUPMR_EL3, x0
98	ldr x0,=0x1000002043ff
99	msr C1_PREMIUM_IMP_CPUPCR_EL3, x0
100	isb
101workaround_reset_end c1_premium, ERRATUM(3926381)
102
103check_erratum_range c1_premium, ERRATUM(3926381), CPU_REV(1, 0), CPU_REV(1, 0)
104
105cpu_reset_func_start c1_premium
106	/* Disable speculative loads */
107	msr	SSBS, xzr
108	enable_mpmm
109cpu_reset_func_end c1_premium
110
111func c1_premium_core_pwr_dwn
112	/* ---------------------------------------------------
113	 * Flip CPU power down bit in power control register.
114	 * It will be set on powerdown and cleared on wakeup.
115	 * ---------------------------------------------------
116	 */
117	sysreg_bit_toggle C1_PREMIUM_IMP_CPUPWRCTLR_EL1, \
118		C1_PREMIUM_IMP_CPUPWRCTLR_EL1_CORE_PWRDN_EN_BIT
119	isb
120	signal_pabandon_handled
121	ret
122endfunc c1_premium_core_pwr_dwn
123
124.section .rodata.c1_premium_regs, "aS"
125c1_premium_regs: /* The ASCII list of register names to be reported */
126	.asciz	"cpuectlr_el1", ""
127
128func c1_premium_cpu_reg_dump
129	adr 	x6, c1_premium_regs
130	mrs	x8, C1_PREMIUM_IMP_CPUECTLR_EL1
131	ret
132endfunc c1_premium_cpu_reg_dump
133
134declare_cpu_ops c1_premium, C1_PREMIUM_MIDR, \
135	c1_premium_reset_func, \
136	c1_premium_core_pwr_dwn
137