xref: /arm-trusted-firmware/lib/cpus/aarch64/cortex_a710.S (revision 91f16700b400a8c0651d24a598fc48ee2997a0d7)
1*91f16700Schasinglulu/*
2*91f16700Schasinglulu * Copyright (c) 2021-2023, Arm Limited. All rights reserved.
3*91f16700Schasinglulu *
4*91f16700Schasinglulu * SPDX-License-Identifier: BSD-3-Clause
5*91f16700Schasinglulu */
6*91f16700Schasinglulu
7*91f16700Schasinglulu#include <arch.h>
8*91f16700Schasinglulu#include <asm_macros.S>
9*91f16700Schasinglulu#include <common/bl_common.h>
10*91f16700Schasinglulu#include <cortex_a710.h>
11*91f16700Schasinglulu#include <cpu_macros.S>
12*91f16700Schasinglulu#include <plat_macros.S>
13*91f16700Schasinglulu#include "wa_cve_2022_23960_bhb_vector.S"
14*91f16700Schasinglulu
15*91f16700Schasinglulu/* Hardware handled coherency */
16*91f16700Schasinglulu#if HW_ASSISTED_COHERENCY == 0
17*91f16700Schasinglulu#error "Cortex A710 must be compiled with HW_ASSISTED_COHERENCY enabled"
18*91f16700Schasinglulu#endif
19*91f16700Schasinglulu
20*91f16700Schasinglulu/* 64-bit only core */
21*91f16700Schasinglulu#if CTX_INCLUDE_AARCH32_REGS == 1
22*91f16700Schasinglulu#error "Cortex A710 supports only AArch64. Compile with CTX_INCLUDE_AARCH32_REGS=0"
23*91f16700Schasinglulu#endif
24*91f16700Schasinglulu
25*91f16700Schasinglulu#if WORKAROUND_CVE_2022_23960
26*91f16700Schasinglulu	wa_cve_2022_23960_bhb_vector_table CORTEX_A710_BHB_LOOP_COUNT, cortex_a710
27*91f16700Schasinglulu#endif /* WORKAROUND_CVE_2022_23960 */
28*91f16700Schasinglulu
29*91f16700Schasingluluworkaround_reset_start cortex_a710, ERRATUM(1987031), ERRATA_A710_1987031
30*91f16700Schasinglulu	ldr x0,=0x6
31*91f16700Schasinglulu	msr S3_6_c15_c8_0,x0
32*91f16700Schasinglulu	ldr x0,=0xF3A08002
33*91f16700Schasinglulu	msr S3_6_c15_c8_2,x0
34*91f16700Schasinglulu	ldr x0,=0xFFF0F7FE
35*91f16700Schasinglulu	msr S3_6_c15_c8_3,x0
36*91f16700Schasinglulu	ldr x0,=0x40000001003ff
37*91f16700Schasinglulu	msr S3_6_c15_c8_1,x0
38*91f16700Schasinglulu	ldr x0,=0x7
39*91f16700Schasinglulu	msr S3_6_c15_c8_0,x0
40*91f16700Schasinglulu	ldr x0,=0xBF200000
41*91f16700Schasinglulu	msr S3_6_c15_c8_2,x0
42*91f16700Schasinglulu	ldr x0,=0xFFEF0000
43*91f16700Schasinglulu	msr S3_6_c15_c8_3,x0
44*91f16700Schasinglulu	ldr x0,=0x40000001003f3
45*91f16700Schasinglulu	msr S3_6_c15_c8_1,x0
46*91f16700Schasingluluworkaround_reset_end cortex_a710, ERRATUM(1987031)
47*91f16700Schasinglulu
48*91f16700Schasinglulucheck_erratum_ls cortex_a710, ERRATUM(1987031), CPU_REV(2, 0)
49*91f16700Schasinglulu
50*91f16700Schasingluluworkaround_runtime_start cortex_a710, ERRATUM(2008768), ERRATA_A710_2008768
51*91f16700Schasinglulu	/* Stash ERRSELR_EL1 in x2 */
52*91f16700Schasinglulu	mrs	x2, ERRSELR_EL1
53*91f16700Schasinglulu
54*91f16700Schasinglulu	/* Select error record 0 and clear ED bit */
55*91f16700Schasinglulu	msr	ERRSELR_EL1, xzr
56*91f16700Schasinglulu	mrs	x1, ERXCTLR_EL1
57*91f16700Schasinglulu	bfi	x1, xzr, #ERXCTLR_ED_SHIFT, #1
58*91f16700Schasinglulu	msr	ERXCTLR_EL1, x1
59*91f16700Schasinglulu
60*91f16700Schasinglulu	/* Select error record 1 and clear ED bit */
61*91f16700Schasinglulu	mov	x0, #1
62*91f16700Schasinglulu	msr	ERRSELR_EL1, x0
63*91f16700Schasinglulu	mrs	x1, ERXCTLR_EL1
64*91f16700Schasinglulu	bfi	x1, xzr, #ERXCTLR_ED_SHIFT, #1
65*91f16700Schasinglulu	msr	ERXCTLR_EL1, x1
66*91f16700Schasinglulu
67*91f16700Schasinglulu	/* Restore ERRSELR_EL1 from x2 */
68*91f16700Schasinglulu	msr	ERRSELR_EL1, x2
69*91f16700Schasingluluworkaround_runtime_end cortex_a710, ERRATUM(2008768), NO_ISB
70*91f16700Schasinglulu
71*91f16700Schasinglulucheck_erratum_ls cortex_a710, ERRATUM(2008768), CPU_REV(2, 0)
72*91f16700Schasinglulu
73*91f16700Schasingluluworkaround_reset_start cortex_a710, ERRATUM(2017096), ERRATA_A710_2017096
74*91f16700Schasinglulu	sysreg_bit_set	CORTEX_A710_CPUECTLR_EL1, CORTEX_A710_CPUECTLR_EL1_PFSTIDIS_BIT
75*91f16700Schasingluluworkaround_reset_end cortex_a710, ERRATUM(2017096)
76*91f16700Schasinglulu
77*91f16700Schasinglulucheck_erratum_ls cortex_a710, ERRATUM(2017096), CPU_REV(2, 0)
78*91f16700Schasinglulu
79*91f16700Schasingluluworkaround_reset_start cortex_a710, ERRATUM(2055002), ERRATA_A710_2055002
80*91f16700Schasinglulu	sysreg_bit_set	CORTEX_A710_CPUACTLR_EL1, CORTEX_A710_CPUACTLR_EL1_BIT_46
81*91f16700Schasingluluworkaround_reset_end cortex_a710, ERRATUM(2055002)
82*91f16700Schasinglulu
83*91f16700Schasinglulucheck_erratum_range cortex_a710, ERRATUM(2055002), CPU_REV(1, 0), CPU_REV(2, 0)
84*91f16700Schasinglulu
85*91f16700Schasingluluworkaround_reset_start cortex_a710, ERRATUM(2058056), ERRATA_A710_2058056
86*91f16700Schasinglulu	sysreg_bitfield_insert CORTEX_A710_CPUECTLR2_EL1, CORTEX_A710_CPUECTLR2_EL1_PF_MODE_CNSRV, \
87*91f16700Schasinglulu		CPUECTLR2_EL1_PF_MODE_LSB, CPUECTLR2_EL1_PF_MODE_WIDTH
88*91f16700Schasingluluworkaround_reset_end cortex_a710, ERRATUM(2058056)
89*91f16700Schasinglulu
90*91f16700Schasinglulucheck_erratum_ls cortex_a710, ERRATUM(2058056), CPU_REV(2, 1)
91*91f16700Schasinglulu
92*91f16700Schasingluluworkaround_reset_start cortex_a710, ERRATUM(2081180), ERRATA_A710_2081180
93*91f16700Schasinglulu	ldr	x0,=0x3
94*91f16700Schasinglulu	msr	S3_6_c15_c8_0,x0
95*91f16700Schasinglulu	ldr	x0,=0xF3A08002
96*91f16700Schasinglulu	msr	S3_6_c15_c8_2,x0
97*91f16700Schasinglulu	ldr	x0,=0xFFF0F7FE
98*91f16700Schasinglulu	msr	S3_6_c15_c8_3,x0
99*91f16700Schasinglulu	ldr	x0,=0x10002001003FF
100*91f16700Schasinglulu	msr	S3_6_c15_c8_1,x0
101*91f16700Schasinglulu	ldr	x0,=0x4
102*91f16700Schasinglulu	msr	S3_6_c15_c8_0,x0
103*91f16700Schasinglulu	ldr	x0,=0xBF200000
104*91f16700Schasinglulu	msr	S3_6_c15_c8_2,x0
105*91f16700Schasinglulu	ldr	x0,=0xFFEF0000
106*91f16700Schasinglulu	msr	S3_6_c15_c8_3,x0
107*91f16700Schasinglulu	ldr	x0,=0x10002001003F3
108*91f16700Schasinglulu	msr	S3_6_c15_c8_1,x0
109*91f16700Schasingluluworkaround_reset_end cortex_a710, ERRATUM(2081180)
110*91f16700Schasinglulu
111*91f16700Schasinglulucheck_erratum_ls cortex_a710, ERRATUM(2081180), CPU_REV(2, 0)
112*91f16700Schasinglulu
113*91f16700Schasingluluworkaround_reset_start cortex_a710, ERRATUM(2083908), ERRATA_A710_2083908
114*91f16700Schasinglulu	sysreg_bit_set	CORTEX_A710_CPUACTLR5_EL1, CORTEX_A710_CPUACTLR5_EL1_BIT_13
115*91f16700Schasingluluworkaround_reset_end cortex_a710, ERRATUM(2083908)
116*91f16700Schasinglulu
117*91f16700Schasinglulucheck_erratum_range cortex_a710, ERRATUM(2083908), CPU_REV(2, 0), CPU_REV(2, 0)
118*91f16700Schasinglulu
119*91f16700Schasingluluworkaround_reset_start cortex_a710, ERRATUM(2136059), ERRATA_A710_2136059
120*91f16700Schasinglulu	sysreg_bit_set	CORTEX_A710_CPUACTLR5_EL1, CORTEX_A710_CPUACTLR5_EL1_BIT_44
121*91f16700Schasingluluworkaround_reset_end cortex_a710, ERRATUM(2136059)
122*91f16700Schasinglulu
123*91f16700Schasinglulucheck_erratum_ls cortex_a710, ERRATUM(2136059), CPU_REV(2, 0)
124*91f16700Schasinglulu
125*91f16700Schasingluluworkaround_reset_start cortex_a710, ERRATUM(2147715), ERRATA_A710_2147715
126*91f16700Schasinglulu	sysreg_bit_set	CORTEX_A710_CPUACTLR_EL1, CORTEX_A710_CPUACTLR_EL1_BIT_22
127*91f16700Schasingluluworkaround_reset_end cortex_a710, ERRATUM(2147715)
128*91f16700Schasinglulu
129*91f16700Schasinglulucheck_erratum_range cortex_a710, ERRATUM(2147715), CPU_REV(2, 0), CPU_REV(2, 0)
130*91f16700Schasinglulu
131*91f16700Schasingluluworkaround_reset_start cortex_a710, ERRATUM(2216384), ERRATA_A710_2216384
132*91f16700Schasinglulu	sysreg_bit_set	CORTEX_A710_CPUACTLR5_EL1, CORTEX_A710_CPUACTLR5_EL1_BIT_17
133*91f16700Schasinglulu
134*91f16700Schasinglulu	ldr	x0,=0x5
135*91f16700Schasinglulu	msr	CORTEX_A710_CPUPSELR_EL3, x0
136*91f16700Schasinglulu	ldr	x0,=0x10F600E000
137*91f16700Schasinglulu	msr	CORTEX_A710_CPUPOR_EL3, x0
138*91f16700Schasinglulu	ldr	x0,=0x10FF80E000
139*91f16700Schasinglulu	msr	CORTEX_A710_CPUPMR_EL3, x0
140*91f16700Schasinglulu	ldr	x0,=0x80000000003FF
141*91f16700Schasinglulu	msr	CORTEX_A710_CPUPCR_EL3, x0
142*91f16700Schasingluluworkaround_reset_end cortex_a710, ERRATUM(2216384)
143*91f16700Schasinglulu
144*91f16700Schasinglulucheck_erratum_ls cortex_a710, ERRATUM(2216384), CPU_REV(2, 0)
145*91f16700Schasinglulu
146*91f16700Schasingluluworkaround_reset_start cortex_a710, ERRATUM(2267065), ERRATA_A710_2267065
147*91f16700Schasinglulu	sysreg_bit_set	CORTEX_A710_CPUACTLR_EL1, CORTEX_A710_CPUACTLR_EL1_BIT_22
148*91f16700Schasingluluworkaround_reset_end cortex_a710, ERRATUM(2267065)
149*91f16700Schasinglulu
150*91f16700Schasinglulucheck_erratum_ls cortex_a710, ERRATUM(2267065), CPU_REV(2, 0)
151*91f16700Schasinglulu
152*91f16700Schasingluluworkaround_reset_start cortex_a710, ERRATUM(2282622), ERRATA_A710_2282622
153*91f16700Schasinglulu	sysreg_bit_set	CORTEX_A710_CPUACTLR2_EL1, BIT(0)
154*91f16700Schasingluluworkaround_reset_end cortex_a710, ERRATUM(2282622)
155*91f16700Schasinglulu
156*91f16700Schasinglulucheck_erratum_ls cortex_a710, ERRATUM(2282622), CPU_REV(2, 1)
157*91f16700Schasinglulu
158*91f16700Schasingluluworkaround_runtime_start cortex_a710, ERRATUM(2291219), ERRATA_A710_2291219
159*91f16700Schasinglulu	/* Set bit 36 in ACTLR2_EL1 */
160*91f16700Schasinglulu	sysreg_bit_set CORTEX_A710_CPUACTLR2_EL1, CORTEX_A710_CPUACTLR2_EL1_BIT_36
161*91f16700Schasingluluworkaround_runtime_end cortex_a710, ERRATUM(2291219), NO_ISB
162*91f16700Schasinglulu
163*91f16700Schasinglulucheck_erratum_ls cortex_a710, ERRATUM(2291219), CPU_REV(2, 0)
164*91f16700Schasinglulu
165*91f16700Schasinglulu/*
166*91f16700Schasinglulu * ERRATA_DSU_2313941 is defined in dsu_helpers.S but applies to Cortex-A710 as
167*91f16700Schasinglulu * well. Create a symbollic link to existing errata workaround to get them
168*91f16700Schasinglulu * registered under the Errata Framework.
169*91f16700Schasinglulu */
170*91f16700Schasinglulu.equ check_erratum_cortex_a710_2313941, check_errata_dsu_2313941
171*91f16700Schasinglulu.equ erratum_cortex_a710_2313941_wa, errata_dsu_2313941_wa
172*91f16700Schasingluluadd_erratum_entry cortex_a710, ERRATUM(2313941), ERRATA_DSU_2313941, APPLY_AT_RESET
173*91f16700Schasinglulu
174*91f16700Schasingluluworkaround_reset_start cortex_a710, ERRATUM(2371105), ERRATA_A710_2371105
175*91f16700Schasinglulu	/* Set bit 40 in CPUACTLR2_EL1 */
176*91f16700Schasinglulu	sysreg_bit_set CORTEX_A710_CPUACTLR2_EL1, CORTEX_A710_CPUACTLR2_EL1_BIT_40
177*91f16700Schasingluluworkaround_reset_end cortex_a710, ERRATUM(2371105)
178*91f16700Schasinglulu
179*91f16700Schasinglulucheck_erratum_ls cortex_a710, ERRATUM(2371105), CPU_REV(2, 0)
180*91f16700Schasinglulu
181*91f16700Schasingluluworkaround_reset_start cortex_a710, ERRATUM(2742423), ERRATA_A710_2742423
182*91f16700Schasinglulu	/* Set CPUACTLR5_EL1[56:55] to 2'b01 */
183*91f16700Schasinglulu	sysreg_bit_set CORTEX_A710_CPUACTLR5_EL1, BIT(55)
184*91f16700Schasinglulu	sysreg_bit_clear CORTEX_A710_CPUACTLR5_EL1, BIT(56)
185*91f16700Schasingluluworkaround_reset_end cortex_a710, ERRATUM(2742423)
186*91f16700Schasinglulu
187*91f16700Schasinglulucheck_erratum_ls cortex_a710, ERRATUM(2742423), CPU_REV(2, 1)
188*91f16700Schasinglulu
189*91f16700Schasingluluworkaround_runtime_start cortex_a710, ERRATUM(2768515), ERRATA_A710_2768515
190*91f16700Schasinglulu	/* dsb before isb of power down sequence */
191*91f16700Schasinglulu	dsb	sy
192*91f16700Schasingluluworkaround_runtime_end cortex_a710, ERRATUM(2768515), NO_ISB
193*91f16700Schasinglulu
194*91f16700Schasinglulucheck_erratum_ls cortex_a710, ERRATUM(2768515), CPU_REV(2, 1)
195*91f16700Schasinglulu
196*91f16700Schasingluluworkaround_reset_start cortex_a710, CVE(2022, 23960), WORKAROUND_CVE_2022_23960
197*91f16700Schasinglulu#if IMAGE_BL31
198*91f16700Schasinglulu	/*
199*91f16700Schasinglulu	 * The Cortex-A710 generic vectors are overridden to apply errata
200*91f16700Schasinglulu	 * mitigation on exception entry from lower ELs.
201*91f16700Schasinglulu	 */
202*91f16700Schasinglulu	override_vector_table wa_cve_vbar_cortex_a710
203*91f16700Schasinglulu#endif /* IMAGE_BL31 */
204*91f16700Schasingluluworkaround_reset_end cortex_a710, CVE(2022, 23960)
205*91f16700Schasinglulu
206*91f16700Schasinglulucheck_erratum_chosen cortex_a710, CVE(2022, 23960), WORKAROUND_CVE_2022_23960
207*91f16700Schasinglulu
208*91f16700Schasinglulu	/* ----------------------------------------------------
209*91f16700Schasinglulu	 * HW will do the cache maintenance while powering down
210*91f16700Schasinglulu	 * ----------------------------------------------------
211*91f16700Schasinglulu	 */
212*91f16700Schasinglulufunc cortex_a710_core_pwr_dwn
213*91f16700Schasinglulu	apply_erratum cortex_a710, ERRATUM(2008768), ERRATA_A710_2008768
214*91f16700Schasinglulu	apply_erratum cortex_a710, ERRATUM(2291219), ERRATA_A710_2291219, NO_GET_CPU_REV
215*91f16700Schasinglulu
216*91f16700Schasinglulu	/* ---------------------------------------------------
217*91f16700Schasinglulu	 * Enable CPU power down bit in power control register
218*91f16700Schasinglulu	 * ---------------------------------------------------
219*91f16700Schasinglulu	 */
220*91f16700Schasinglulu	sysreg_bit_set CORTEX_A710_CPUPWRCTLR_EL1, CORTEX_A710_CPUPWRCTLR_EL1_CORE_PWRDN_BIT
221*91f16700Schasinglulu	apply_erratum cortex_a710, ERRATUM(2768515), ERRATA_A710_2768515, NO_GET_CPU_REV
222*91f16700Schasinglulu	isb
223*91f16700Schasinglulu	ret
224*91f16700Schasingluluendfunc cortex_a710_core_pwr_dwn
225*91f16700Schasinglulu
226*91f16700Schasingluluerrata_report_shim cortex_a710
227*91f16700Schasinglulu
228*91f16700Schasinglulucpu_reset_func_start cortex_a710
229*91f16700Schasinglulu	/* Disable speculative loads */
230*91f16700Schasinglulu	msr	SSBS, xzr
231*91f16700Schasinglulucpu_reset_func_end cortex_a710
232*91f16700Schasinglulu
233*91f16700Schasinglulu	/* ---------------------------------------------
234*91f16700Schasinglulu	 * This function provides Cortex-A710 specific
235*91f16700Schasinglulu	 * register information for crash reporting.
236*91f16700Schasinglulu	 * It needs to return with x6 pointing to
237*91f16700Schasinglulu	 * a list of register names in ascii and
238*91f16700Schasinglulu	 * x8 - x15 having values of registers to be
239*91f16700Schasinglulu	 * reported.
240*91f16700Schasinglulu	 * ---------------------------------------------
241*91f16700Schasinglulu	 */
242*91f16700Schasinglulu.section .rodata.cortex_a710_regs, "aS"
243*91f16700Schasinglulucortex_a710_regs:  /* The ascii list of register names to be reported */
244*91f16700Schasinglulu	.asciz	"cpuectlr_el1", ""
245*91f16700Schasinglulu
246*91f16700Schasinglulufunc cortex_a710_cpu_reg_dump
247*91f16700Schasinglulu	adr	x6, cortex_a710_regs
248*91f16700Schasinglulu	mrs	x8, CORTEX_A710_CPUECTLR_EL1
249*91f16700Schasinglulu	ret
250*91f16700Schasingluluendfunc cortex_a710_cpu_reg_dump
251*91f16700Schasinglulu
252*91f16700Schasingluludeclare_cpu_ops cortex_a710, CORTEX_A710_MIDR, \
253*91f16700Schasinglulu	cortex_a710_reset_func, \
254*91f16700Schasinglulu	cortex_a710_core_pwr_dwn
255