xref: /rk3399_ARM-atf/lib/cpus/aarch64/cortex_a78.S (revision 96a8ed14b74cca33a8caf567d0f0a2d3b2483a3b)
1/*
2 * Copyright (c) 2019-2022, 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 <common/bl_common.h>
10#include <cortex_a78.h>
11#include <cpu_macros.S>
12#include <plat_macros.S>
13#include "wa_cve_2022_23960_bhb_vector.S"
14
15/* Hardware handled coherency */
16#if HW_ASSISTED_COHERENCY == 0
17#error "cortex_a78 must be compiled with HW_ASSISTED_COHERENCY enabled"
18#endif
19
20#if WORKAROUND_CVE_2022_23960
21	wa_cve_2022_23960_bhb_vector_table CORTEX_A78_BHB_LOOP_COUNT, cortex_a78
22#endif /* WORKAROUND_CVE_2022_23960 */
23
24/* --------------------------------------------------
25 * Errata Workaround for A78 Erratum 1688305.
26 * This applies to revision r0p0 and r1p0 of A78.
27 * Inputs:
28 * x0: variant[4:7] and revision[0:3] of current cpu.
29 * Shall clobber: x0-x17
30 * --------------------------------------------------
31 */
32func errata_a78_1688305_wa
33	/* Compare x0 against revision r1p0 */
34	mov	x17, x30
35	bl	check_errata_1688305
36	cbz	x0, 1f
37	mrs     x1, CORTEX_A78_ACTLR2_EL1
38	orr	x1, x1, #CORTEX_A78_ACTLR2_EL1_BIT_1
39	msr     CORTEX_A78_ACTLR2_EL1, x1
40	isb
411:
42	ret	x17
43endfunc errata_a78_1688305_wa
44
45func check_errata_1688305
46	/* Applies to r0p0 and r1p0 */
47	mov	x1, #0x10
48	b	cpu_rev_var_ls
49endfunc check_errata_1688305
50
51/* --------------------------------------------------
52 * Errata Workaround for Cortex A78 Errata #1941498.
53 * This applies to revisions r0p0, r1p0, and r1p1.
54 * x0: variant[4:7] and revision[0:3] of current cpu.
55 * Shall clobber: x0-x17
56 * --------------------------------------------------
57 */
58func errata_a78_1941498_wa
59	/* Compare x0 against revision <= r1p1 */
60	mov	x17, x30
61	bl	check_errata_1941498
62	cbz	x0, 1f
63
64	/* Set bit 8 in ECTLR_EL1 */
65	mrs	x1, CORTEX_A78_CPUECTLR_EL1
66	orr	x1, x1, #CORTEX_A78_CPUECTLR_EL1_BIT_8
67	msr	CORTEX_A78_CPUECTLR_EL1, x1
68	isb
691:
70	ret	x17
71endfunc errata_a78_1941498_wa
72
73func check_errata_1941498
74	/* Check for revision <= r1p1, might need to be updated later. */
75	mov	x1, #0x11
76	b	cpu_rev_var_ls
77endfunc check_errata_1941498
78
79/* --------------------------------------------------
80 * Errata Workaround for A78 Erratum 1951500.
81 * This applies to revisions r1p0 and r1p1 of A78.
82 * The issue also exists in r0p0 but there is no fix
83 * in that revision.
84 * Inputs:
85 * x0: variant[4:7] and revision[0:3] of current cpu.
86 * Shall clobber: x0-x17
87 * --------------------------------------------------
88 */
89func errata_a78_1951500_wa
90	/* Compare x0 against revisions r1p0 - r1p1 */
91	mov	x17, x30
92	bl	check_errata_1951500
93	cbz	x0, 1f
94
95	msr	S3_6_c15_c8_0, xzr
96	ldr	x0, =0x10E3900002
97	msr	S3_6_c15_c8_2, x0
98	ldr	x0, =0x10FFF00083
99	msr	S3_6_c15_c8_3, x0
100	ldr	x0, =0x2001003FF
101	msr	S3_6_c15_c8_1, x0
102
103	mov	x0, #1
104	msr	S3_6_c15_c8_0, x0
105	ldr	x0, =0x10E3800082
106	msr	S3_6_c15_c8_2, x0
107	ldr	x0, =0x10FFF00083
108	msr	S3_6_c15_c8_3, x0
109	ldr	x0, =0x2001003FF
110	msr	S3_6_c15_c8_1, x0
111
112	mov	x0, #2
113	msr	S3_6_c15_c8_0, x0
114	ldr	x0, =0x10E3800200
115	msr	S3_6_c15_c8_2, x0
116	ldr	x0, =0x10FFF003E0
117	msr	S3_6_c15_c8_3, x0
118	ldr	x0, =0x2001003FF
119	msr	S3_6_c15_c8_1, x0
120
121	isb
1221:
123	ret	x17
124endfunc errata_a78_1951500_wa
125
126func check_errata_1951500
127	/* Applies to revisions r1p0 and r1p1. */
128	mov	x1, #CPU_REV(1, 0)
129	mov	x2, #CPU_REV(1, 1)
130	b	cpu_rev_var_range
131endfunc check_errata_1951500
132
133/* --------------------------------------------------
134 * Errata Workaround for Cortex A78 Errata #1821534.
135 * This applies to revisions r0p0 and r1p0.
136 * x0: variant[4:7] and revision[0:3] of current cpu.
137 * Shall clobber: x0-x17
138 * --------------------------------------------------
139 */
140func errata_a78_1821534_wa
141	/* Check revision. */
142	mov	x17, x30
143	bl	check_errata_1821534
144	cbz	x0, 1f
145
146	/* Set bit 2 in ACTLR2_EL1 */
147	mrs     x1, CORTEX_A78_ACTLR2_EL1
148	orr	x1, x1, #CORTEX_A78_ACTLR2_EL1_BIT_2
149	msr     CORTEX_A78_ACTLR2_EL1, x1
150	isb
1511:
152	ret	x17
153endfunc errata_a78_1821534_wa
154
155func check_errata_1821534
156	/* Applies to r0p0 and r1p0 */
157	mov	x1, #0x10
158	b	cpu_rev_var_ls
159endfunc check_errata_1821534
160
161/* --------------------------------------------------
162 * Errata Workaround for Cortex A78 Errata 1952683.
163 * This applies to revision r0p0.
164 * x0: variant[4:7] and revision[0:3] of current cpu.
165 * Shall clobber: x0-x17
166 * --------------------------------------------------
167 */
168func errata_a78_1952683_wa
169	/* Check revision. */
170	mov	x17, x30
171	bl	check_errata_1952683
172	cbz	x0, 1f
173
174	ldr	x0,=0x5
175	msr	S3_6_c15_c8_0,x0
176	ldr	x0,=0xEEE10A10
177	msr	S3_6_c15_c8_2,x0
178	ldr	x0,=0xFFEF0FFF
179	msr	S3_6_c15_c8_3,x0
180	ldr	x0,=0x0010F000
181	msr	S3_6_c15_c8_4,x0
182	ldr	x0,=0x0010F000
183	msr	S3_6_c15_c8_5,x0
184	ldr	x0,=0x40000080023ff
185	msr	S3_6_c15_c8_1,x0
186	ldr	x0,=0x6
187	msr	S3_6_c15_c8_0,x0
188	ldr	x0,=0xEE640F34
189	msr	S3_6_c15_c8_2,x0
190	ldr	x0,=0xFFEF0FFF
191	msr	S3_6_c15_c8_3,x0
192	ldr	x0,=0x40000080023ff
193	msr	S3_6_c15_c8_1,x0
194	isb
1951:
196	ret	x17
197endfunc errata_a78_1952683_wa
198
199func check_errata_1952683
200	/* Applies to r0p0 only */
201	mov	x1, #0x00
202	b	cpu_rev_var_ls
203endfunc check_errata_1952683
204
205/* --------------------------------------------------
206 * Errata Workaround for Cortex A78 Errata 2132060.
207 * This applies to revisions r0p0, r1p0, r1p1, and r1p2.
208 * It is still open.
209 * x0: variant[4:7] and revision[0:3] of current cpu.
210 * Shall clobber: x0-x1, x17
211 * --------------------------------------------------
212 */
213func errata_a78_2132060_wa
214	/* Check revision. */
215	mov	x17, x30
216	bl	check_errata_2132060
217	cbz	x0, 1f
218
219	/* Apply the workaround. */
220	mrs	x1, CORTEX_A78_CPUECTLR_EL1
221	mov	x0, #CORTEX_A78_CPUECTLR_EL1_PF_MODE_CNSRV
222	bfi	x1, x0, #CPUECTLR_EL1_PF_MODE_LSB, #CPUECTLR_EL1_PF_MODE_WIDTH
223	msr	CORTEX_A78_CPUECTLR_EL1, x1
2241:
225	ret	x17
226endfunc errata_a78_2132060_wa
227
228func check_errata_2132060
229	/* Applies to r0p0, r0p1, r1p1, and r1p2 */
230	mov	x1, #0x12
231	b	cpu_rev_var_ls
232endfunc check_errata_2132060
233
234/* --------------------------------------------------------------------
235 * Errata Workaround for A78 Erratum 2242635.
236 * This applies to revisions r1p0, r1p1, and r1p2 of the Cortex A78
237 * processor and is still open.
238 * The issue also exists in r0p0 but there is no fix in that revision.
239 * x0: variant[4:7] and revision[0:3] of current cpu.
240 * Shall clobber: x0-x17
241 * --------------------------------------------------------------------
242 */
243func errata_a78_2242635_wa
244	/* Compare x0 against revisions r1p0 - r1p2 */
245	mov	x17, x30
246	bl	check_errata_2242635
247	cbz	x0, 1f
248
249	ldr	x0, =0x5
250	msr	S3_6_c15_c8_0, x0 /* CPUPSELR_EL3 */
251	ldr	x0, =0x10F600E000
252	msr	S3_6_c15_c8_2, x0 /* CPUPOR_EL3 */
253	ldr	x0, =0x10FF80E000
254	msr	S3_6_c15_c8_3, x0 /* CPUPMR_EL3 */
255	ldr	x0, =0x80000000003FF
256	msr	S3_6_c15_c8_1, x0 /* CPUPCR_EL3 */
257
258	isb
2591:
260	ret	x17
261endfunc errata_a78_2242635_wa
262
263func check_errata_2242635
264	/* Applies to revisions r1p0 through r1p2. */
265	mov	x1, #CPU_REV(1, 0)
266	mov	x2, #CPU_REV(1, 2)
267	b	cpu_rev_var_range
268endfunc check_errata_2242635
269
270func check_errata_cve_2022_23960
271#if WORKAROUND_CVE_2022_23960
272	mov	x0, #ERRATA_APPLIES
273#else
274	mov	x0, #ERRATA_MISSING
275#endif
276	ret
277endfunc check_errata_cve_2022_23960
278
279	/* -------------------------------------------------
280	 * The CPU Ops reset function for Cortex-A78
281	 * -------------------------------------------------
282	 */
283func cortex_a78_reset_func
284	mov	x19, x30
285	bl	cpu_get_rev_var
286	mov	x18, x0
287
288#if ERRATA_A78_1688305
289	mov     x0, x18
290	bl	errata_a78_1688305_wa
291#endif
292
293#if ERRATA_A78_1941498
294	mov     x0, x18
295	bl	errata_a78_1941498_wa
296#endif
297
298#if ERRATA_A78_1951500
299	mov	x0, x18
300	bl	errata_a78_1951500_wa
301#endif
302
303#if ERRATA_A78_1821534
304	mov	x0, x18
305	bl	errata_a78_1821534_wa
306#endif
307
308#if ERRATA_A78_1952683
309	mov	x0, x18
310	bl	errata_a78_1952683_wa
311#endif
312
313#if ERRATA_A78_2132060
314	mov	x0, x18
315	bl	errata_a78_2132060_wa
316#endif
317
318#if ERRATA_A78_2242635
319	mov	x0, x18
320	bl	errata_a78_2242635_wa
321#endif
322
323#if ENABLE_AMU
324	/* Make sure accesses from EL0/EL1 and EL2 are not trapped to EL3 */
325	mrs	x0, actlr_el3
326	bic	x0, x0, #CORTEX_A78_ACTLR_TAM_BIT
327	msr	actlr_el3, x0
328
329	/* Make sure accesses from non-secure EL0/EL1 are not trapped to EL2 */
330	mrs	x0, actlr_el2
331	bic	x0, x0, #CORTEX_A78_ACTLR_TAM_BIT
332	msr	actlr_el2, x0
333
334	/* Enable group0 counters */
335	mov	x0, #CORTEX_A78_AMU_GROUP0_MASK
336	msr	CPUAMCNTENSET0_EL0, x0
337
338	/* Enable group1 counters */
339	mov	x0, #CORTEX_A78_AMU_GROUP1_MASK
340	msr	CPUAMCNTENSET1_EL0, x0
341#endif
342
343#if IMAGE_BL31 && WORKAROUND_CVE_2022_23960
344	/*
345	 * The Cortex-A78 generic vectors are overridden to apply errata
346	 * mitigation on exception entry from lower ELs.
347	 */
348	adr	x0, wa_cve_vbar_cortex_a78
349	msr	vbar_el3, x0
350#endif /* IMAGE_BL31 && WORKAROUND_CVE_2022_23960 */
351
352	isb
353	ret	x19
354endfunc cortex_a78_reset_func
355
356	/* ---------------------------------------------
357	 * HW will do the cache maintenance while powering down
358	 * ---------------------------------------------
359	 */
360func cortex_a78_core_pwr_dwn
361	/* ---------------------------------------------
362	 * Enable CPU power down bit in power control register
363	 * ---------------------------------------------
364	 */
365	mrs	x0, CORTEX_A78_CPUPWRCTLR_EL1
366	orr	x0, x0, #CORTEX_A78_CPUPWRCTLR_EL1_CORE_PWRDN_EN_BIT
367	msr	CORTEX_A78_CPUPWRCTLR_EL1, x0
368	isb
369	ret
370endfunc cortex_a78_core_pwr_dwn
371
372	/*
373	 * Errata printing function for cortex_a78. Must follow AAPCS.
374	 */
375#if REPORT_ERRATA
376func cortex_a78_errata_report
377	stp	x8, x30, [sp, #-16]!
378
379	bl	cpu_get_rev_var
380	mov	x8, x0
381
382	/*
383	 * Report all errata. The revision-variant information is passed to
384	 * checking functions of each errata.
385	 */
386	report_errata ERRATA_A78_1688305, cortex_a78, 1688305
387	report_errata ERRATA_A78_1941498, cortex_a78, 1941498
388	report_errata ERRATA_A78_1951500, cortex_a78, 1951500
389	report_errata ERRATA_A78_1821534, cortex_a78, 1821534
390	report_errata ERRATA_A78_1952683, cortex_a78, 1952683
391	report_errata ERRATA_A78_2132060, cortex_a78, 2132060
392	report_errata ERRATA_A78_2242635, cortex_a78, 2242635
393	report_errata WORKAROUND_CVE_2022_23960, cortex_a78, cve_2022_23960
394
395	ldp	x8, x30, [sp], #16
396	ret
397endfunc cortex_a78_errata_report
398#endif
399
400	/* ---------------------------------------------
401	 * This function provides cortex_a78 specific
402	 * register information for crash reporting.
403	 * It needs to return with x6 pointing to
404	 * a list of register names in ascii and
405	 * x8 - x15 having values of registers to be
406	 * reported.
407	 * ---------------------------------------------
408	 */
409.section .rodata.cortex_a78_regs, "aS"
410cortex_a78_regs:  /* The ascii list of register names to be reported */
411	.asciz	"cpuectlr_el1", ""
412
413func cortex_a78_cpu_reg_dump
414	adr	x6, cortex_a78_regs
415	mrs	x8, CORTEX_A78_CPUECTLR_EL1
416	ret
417endfunc cortex_a78_cpu_reg_dump
418
419declare_cpu_ops cortex_a78, CORTEX_A78_MIDR, \
420	cortex_a78_reset_func, \
421	cortex_a78_core_pwr_dwn
422