xref: /rk3399_ARM-atf/lib/cpus/aarch64/neoverse_n2.S (revision bd063a73a86b8845d06730fa7afde8f5061fef60)
1/*
2 * Copyright (c) 2020-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 <cpu_macros.S>
10#include <neoverse_n2.h>
11#include "wa_cve_2022_23960_bhb_vector.S"
12
13/* Hardware handled coherency */
14#if HW_ASSISTED_COHERENCY == 0
15#error "Neoverse N2 must be compiled with HW_ASSISTED_COHERENCY enabled"
16#endif
17
18/* 64-bit only core */
19#if CTX_INCLUDE_AARCH32_REGS == 1
20#error "Neoverse-N2 supports only AArch64. Compile with CTX_INCLUDE_AARCH32_REGS=0"
21#endif
22
23#if WORKAROUND_CVE_2022_23960
24	wa_cve_2022_23960_bhb_vector_table NEOVERSE_N2_BHB_LOOP_COUNT, neoverse_n2
25#endif /* WORKAROUND_CVE_2022_23960 */
26
27/* --------------------------------------------------
28 * Errata Workaround for Neoverse N2 Erratum 2002655.
29 * This applies to revision r0p0 of Neoverse N2. it is still open.
30 * Inputs:
31 * x0: variant[4:7] and revision[0:3] of current cpu.
32 * Shall clobber: x0-x17
33 * --------------------------------------------------
34 */
35func errata_n2_2002655_wa
36	/* Check revision. */
37	mov	x17, x30
38	bl	check_errata_2002655
39	cbz	x0, 1f
40
41	/* Apply instruction patching sequence */
42	ldr x0,=0x6
43	msr S3_6_c15_c8_0,x0
44	ldr x0,=0xF3A08002
45	msr S3_6_c15_c8_2,x0
46	ldr x0,=0xFFF0F7FE
47	msr S3_6_c15_c8_3,x0
48	ldr x0,=0x40000001003ff
49	msr S3_6_c15_c8_1,x0
50	ldr x0,=0x7
51	msr S3_6_c15_c8_0,x0
52	ldr x0,=0xBF200000
53	msr S3_6_c15_c8_2,x0
54	ldr x0,=0xFFEF0000
55	msr S3_6_c15_c8_3,x0
56	ldr x0,=0x40000001003f3
57	msr S3_6_c15_c8_1,x0
58	isb
591:
60	ret	x17
61endfunc errata_n2_2002655_wa
62
63func check_errata_2002655
64	/* Applies to r0p0 */
65	mov	x1, #0x00
66	b	cpu_rev_var_ls
67endfunc check_errata_2002655
68
69/* ---------------------------------------------------------------
70 * Errata Workaround for Neoverse N2 Erratum 2067956.
71 * This applies to revision r0p0 of Neoverse N2 and is still open.
72 * Inputs:
73 * x0: variant[4:7] and revision[0:3] of current cpu.
74 * Shall clobber: x0-x17
75 * ---------------------------------------------------------------
76 */
77func errata_n2_2067956_wa
78	/* Compare x0 against revision r0p0 */
79	mov	x17, x30
80	bl	check_errata_2067956
81	cbz	x0, 1f
82	mrs	x1, NEOVERSE_N2_CPUACTLR_EL1
83	orr	x1, x1, NEOVERSE_N2_CPUACTLR_EL1_BIT_46
84	msr	NEOVERSE_N2_CPUACTLR_EL1, x1
851:
86	ret	x17
87endfunc errata_n2_2067956_wa
88
89func check_errata_2067956
90	/* Applies to r0p0 */
91	mov	x1, #0x00
92	b	cpu_rev_var_ls
93endfunc check_errata_2067956
94
95/* ---------------------------------------------------------------
96 * Errata Workaround for Neoverse N2 Erratum 2025414.
97 * This applies to revision r0p0 of Neoverse N2 and is still open.
98 * Inputs:
99 * x0: variant[4:7] and revision[0:3] of current cpu.
100 * Shall clobber: x0-x17
101 * ---------------------------------------------------------------
102 */
103func errata_n2_2025414_wa
104	/* Compare x0 against revision r0p0 */
105	mov     x17, x30
106	bl      check_errata_2025414
107	cbz     x0, 1f
108	mrs     x1, NEOVERSE_N2_CPUECTLR_EL1
109	orr     x1, x1, NEOVERSE_N2_CPUECTLR_EL1_PFSTIDIS_BIT
110	msr     NEOVERSE_N2_CPUECTLR_EL1, x1
111
1121:
113	ret     x17
114endfunc errata_n2_2025414_wa
115
116func check_errata_2025414
117	/* Applies to r0p0 */
118	mov     x1, #0x00
119	b       cpu_rev_var_ls
120endfunc check_errata_2025414
121
122/* ---------------------------------------------------------------
123 * Errata Workaround for Neoverse N2 Erratum 2189731.
124 * This applies to revision r0p0 of Neoverse N2 and is still open.
125 * Inputs:
126 * x0: variant[4:7] and revision[0:3] of current cpu.
127 * Shall clobber: x0-x17
128 * ---------------------------------------------------------------
129 */
130func errata_n2_2189731_wa
131	/* Compare x0 against revision r0p0 */
132	mov     x17, x30
133	bl      check_errata_2189731
134	cbz     x0, 1f
135	mrs     x1, NEOVERSE_N2_CPUACTLR5_EL1
136	orr     x1, x1, NEOVERSE_N2_CPUACTLR5_EL1_BIT_44
137	msr     NEOVERSE_N2_CPUACTLR5_EL1, x1
138
1391:
140	ret     x17
141endfunc errata_n2_2189731_wa
142
143func check_errata_2189731
144	/* Applies to r0p0 */
145	mov     x1, #0x00
146	b       cpu_rev_var_ls
147endfunc check_errata_2189731
148
149/* --------------------------------------------------
150 * Errata Workaround for Neoverse N2 Erratum 2138956.
151 * This applies to revision r0p0 of Neoverse N2. it is still open.
152 * Inputs:
153 * x0: variant[4:7] and revision[0:3] of current cpu.
154 * Shall clobber: x0-x17
155 * --------------------------------------------------
156 */
157func errata_n2_2138956_wa
158	/* Check revision. */
159	mov	x17, x30
160	bl	check_errata_2138956
161	cbz	x0, 1f
162
163	/* Apply instruction patching sequence */
164	ldr	x0,=0x3
165	msr	S3_6_c15_c8_0,x0
166	ldr	x0,=0xF3A08002
167	msr	S3_6_c15_c8_2,x0
168	ldr	x0,=0xFFF0F7FE
169	msr	S3_6_c15_c8_3,x0
170	ldr	x0,=0x10002001003FF
171	msr	S3_6_c15_c8_1,x0
172	ldr	x0,=0x4
173	msr	S3_6_c15_c8_0,x0
174	ldr	x0,=0xBF200000
175	msr	S3_6_c15_c8_2,x0
176	ldr	x0,=0xFFEF0000
177	msr	S3_6_c15_c8_3,x0
178	ldr	x0,=0x10002001003F3
179	msr	S3_6_c15_c8_1,x0
180	isb
1811:
182	ret	x17
183endfunc errata_n2_2138956_wa
184
185func check_errata_2138956
186	/* Applies to r0p0 */
187	mov	x1, #0x00
188	b	cpu_rev_var_ls
189endfunc check_errata_2138956
190
191/* --------------------------------------------------
192 * Errata Workaround for Neoverse N2 Erratum 2242415.
193 * This applies to revision r0p0 of Neoverse N2. it is still open.
194 * Inputs:
195 * x0: variant[4:7] and revision[0:3] of current cpu.
196 * Shall clobber: x0-x1, x17
197 * --------------------------------------------------
198 */
199func errata_n2_2242415_wa
200	/* Check revision. */
201	mov	x17, x30
202	bl	check_errata_2242415
203	cbz	x0, 1f
204
205	/* Apply instruction patching sequence */
206	mrs	x1, NEOVERSE_N2_CPUACTLR_EL1
207	orr	x1, x1, NEOVERSE_N2_CPUACTLR_EL1_BIT_22
208	msr	NEOVERSE_N2_CPUACTLR_EL1, x1
2091:
210	ret	x17
211endfunc errata_n2_2242415_wa
212
213func check_errata_2242415
214	/* Applies to r0p0 */
215	mov	x1, #0x00
216	b	cpu_rev_var_ls
217endfunc check_errata_2242415
218
219/* --------------------------------------------------
220 * Errata Workaround for Neoverse N2 Erratum 2138953.
221 * This applies to revision r0p0 of Neoverse N2. it is still open.
222 * Inputs:
223 * x0: variant[4:7] and revision[0:3] of current cpu.
224 * Shall clobber: x0-x1, x17
225 * --------------------------------------------------
226 */
227func errata_n2_2138953_wa
228	/* Check revision. */
229	mov	x17, x30
230	bl	check_errata_2138953
231	cbz	x0, 1f
232
233	/* Apply instruction patching sequence */
234	mrs	x1, NEOVERSE_N2_CPUECTLR2_EL1
235	mov	x0, #NEOVERSE_N2_CPUECTLR2_EL1_PF_MODE_CNSRV
236	bfi	x1, x0, #CPUECTLR2_EL1_PF_MODE_LSB, #CPUECTLR2_EL1_PF_MODE_WIDTH
237	msr	NEOVERSE_N2_CPUECTLR2_EL1, x1
2381:
239	ret	x17
240endfunc errata_n2_2138953_wa
241
242func check_errata_2138953
243	/* Applies to r0p0 */
244	mov	x1, #0x00
245	b	cpu_rev_var_ls
246endfunc check_errata_2138953
247
248/* --------------------------------------------------
249 * Errata Workaround for Neoverse N2 Erratum 2138958.
250 * This applies to revision r0p0 of Neoverse N2. it is still open.
251 * Inputs:
252 * x0: variant[4:7] and revision[0:3] of current cpu.
253 * Shall clobber: x0-x1, x17
254 * --------------------------------------------------
255 */
256func errata_n2_2138958_wa
257	/* Check revision. */
258	mov	x17, x30
259	bl	check_errata_2138958
260	cbz	x0, 1f
261
262	/* Apply instruction patching sequence */
263	mrs	x1, NEOVERSE_N2_CPUACTLR5_EL1
264	orr	x1, x1, NEOVERSE_N2_CPUACTLR5_EL1_BIT_13
265	msr	NEOVERSE_N2_CPUACTLR5_EL1, x1
2661:
267	ret	x17
268endfunc errata_n2_2138958_wa
269
270func check_errata_2138958
271	/* Applies to r0p0 */
272	mov	x1, #0x00
273	b	cpu_rev_var_ls
274endfunc check_errata_2138958
275
276/* --------------------------------------------------
277 * Errata Workaround for Neoverse N2 Erratum 2242400.
278 * This applies to revision r0p0 of Neoverse N2. it is still open.
279 * Inputs:
280 * x0: variant[4:7] and revision[0:3] of current cpu.
281 * Shall clobber: x0-x1, x17
282 * --------------------------------------------------
283 */
284func errata_n2_2242400_wa
285	/* Check revision. */
286	mov	x17, x30
287	bl	check_errata_2242400
288	cbz	x0, 1f
289
290	/* Apply instruction patching sequence */
291	mrs	x1, NEOVERSE_N2_CPUACTLR5_EL1
292	orr	x1, x1, NEOVERSE_N2_CPUACTLR5_EL1_BIT_17
293	msr	NEOVERSE_N2_CPUACTLR5_EL1, x1
294	ldr	x0, =0x2
295	msr	S3_6_c15_c8_0, x0
296	ldr	x0, =0x10F600E000
297	msr	S3_6_c15_c8_2, x0
298	ldr	x0, =0x10FF80E000
299	msr	S3_6_c15_c8_3, x0
300	ldr	x0, =0x80000000003FF
301	msr	S3_6_c15_c8_1, x0
302	isb
3031:
304	ret	x17
305endfunc errata_n2_2242400_wa
306
307func check_errata_2242400
308	/* Applies to r0p0 */
309	mov	x1, #0x00
310	b	cpu_rev_var_ls
311endfunc check_errata_2242400
312
313/* --------------------------------------------------
314 * Errata Workaround for Neoverse N2 Erratum 2280757.
315 * This applies to revision r0p0 of Neoverse N2. it is still open.
316 * Inputs:
317 * x0: variant[4:7] and revision[0:3] of current cpu.
318 * Shall clobber: x0-x1, x17
319 * --------------------------------------------------
320 */
321func errata_n2_2280757_wa
322	/* Check revision. */
323	mov	x17, x30
324	bl	check_errata_2280757
325	cbz	x0, 1f
326
327	/* Apply instruction patching sequence */
328	mrs	x1, NEOVERSE_N2_CPUACTLR_EL1
329	orr	x1, x1, NEOVERSE_N2_CPUACTLR_EL1_BIT_22
330	msr	NEOVERSE_N2_CPUACTLR_EL1, x1
3311:
332	ret	x17
333endfunc errata_n2_2280757_wa
334
335func check_errata_2280757
336	/* Applies to r0p0 */
337	mov	x1, #0x00
338	b	cpu_rev_var_ls
339endfunc check_errata_2280757
340
341
342/* --------------------------------------------------
343 * Errata Workaround for Neoverse N2 Erratum 2376738.
344 * This applies to revision r0p0 of Neoverse N2,
345 * fixed in r0p1.
346 * Inputs:
347 * x0: variant[4:7] and revision[0:3] of current CPU.
348 * Shall clobber: x0-x1, x17
349 * --------------------------------------------------
350 */
351func errata_n2_2376738_wa
352	mov	x17, x30
353	bl	check_errata_2376738
354	cbz	x0, 1f
355
356	/* Set CPUACTLR2_EL1[0] to 1 to force PLDW/PFRM
357	 * ST to behave like PLD/PFRM LD and not cause
358	 * invalidations to other PE caches.
359	 */
360	mrs	x1, NEOVERSE_N2_CPUACTLR2_EL1
361	orr	x1, x1,	NEOVERSE_N2_CPUACTLR2_EL1_BIT_0
362	msr	NEOVERSE_N2_CPUACTLR2_EL1, x1
3631:
364	ret x17
365endfunc errata_n2_2376738_wa
366
367func check_errata_2376738
368	/* Applies to r0p0, fixed in r0p1 */
369	mov	x1, 0x00
370	b	cpu_rev_var_ls
371endfunc check_errata_2376738
372
373/* --------------------------------------------------
374 * Errata Workaround for Neoverse N2 Erratum 2388450.
375 * This applies to revision r0p0 of Neoverse N2,
376 * fixed in r0p1.
377 * Inputs:
378 * x0: variant[4:7] and revision[0:3] of current cpu.
379 * Shall clobber: x0-x1, x17
380 * --------------------------------------------------
381 */
382func errata_n2_2388450_wa
383	/* Check revision. */
384	mov	x17, x30
385	bl	check_errata_2388450
386	cbz	x0, 1f
387
388	/*Set bit 40 in ACTLR2_EL1 */
389	mrs	x1, NEOVERSE_N2_CPUACTLR2_EL1
390	orr	x1, x1, #NEOVERSE_N2_CPUACTLR2_EL1_BIT_40
391	msr	NEOVERSE_N2_CPUACTLR2_EL1, x1
392	isb
3931:
394	ret	x17
395endfunc errata_n2_2388450_wa
396
397func check_errata_2388450
398	/* Applies to r0p0, fixed in r0p1 */
399	mov	x1, #0x00
400	b	cpu_rev_var_ls
401endfunc check_errata_2388450
402
403func check_errata_cve_2022_23960
404#if WORKAROUND_CVE_2022_23960
405	mov	x0, #ERRATA_APPLIES
406#else
407	mov	x0, #ERRATA_MISSING
408#endif
409	ret
410endfunc check_errata_cve_2022_23960
411
412	/* -------------------------------------------
413	 * The CPU Ops reset function for Neoverse N2.
414	 * -------------------------------------------
415	 */
416func neoverse_n2_reset_func
417	mov	x19, x30
418
419	/* Check if the PE implements SSBS */
420	mrs	x0, id_aa64pfr1_el1
421	tst	x0, #(ID_AA64PFR1_EL1_SSBS_MASK << ID_AA64PFR1_EL1_SSBS_SHIFT)
422	b.eq	1f
423
424	/* Disable speculative loads */
425	msr	SSBS, xzr
4261:
427	/* Force all cacheable atomic instructions to be near */
428	mrs	x0, NEOVERSE_N2_CPUACTLR2_EL1
429	orr	x0, x0, #NEOVERSE_N2_CPUACTLR2_EL1_BIT_2
430	msr	NEOVERSE_N2_CPUACTLR2_EL1, x0
431
432#if ERRATA_DSU_2313941
433	bl	errata_dsu_2313941_wa
434#endif
435
436#if ERRATA_N2_2067956
437	mov	x0, x18
438	bl	errata_n2_2067956_wa
439#endif
440
441#if ERRATA_N2_2025414
442	mov	x0, x18
443	bl	errata_n2_2025414_wa
444#endif
445
446#if ERRATA_N2_2189731
447	mov	x0, x18
448	bl	errata_n2_2189731_wa
449#endif
450
451
452#if ERRATA_N2_2138956
453	mov	x0, x18
454	bl	errata_n2_2138956_wa
455#endif
456
457#if ERRATA_N2_2138953
458	mov	x0, x18
459	bl	errata_n2_2138953_wa
460#endif
461
462#if ERRATA_N2_2242415
463	mov	x0, x18
464	bl	errata_n2_2242415_wa
465#endif
466
467#if ERRATA_N2_2138958
468	mov	x0, x18
469	bl	errata_n2_2138958_wa
470#endif
471
472#if ERRATA_N2_2242400
473	mov	x0, x18
474	bl	errata_n2_2242400_wa
475#endif
476
477#if ERRATA_N2_2280757
478	mov	x0, x18
479	bl	errata_n2_2280757_wa
480#endif
481
482#if ERRATA_N2_2376738
483	mov	x0, x18
484	bl	errata_n2_2376738_wa
485#endif
486
487#if ERRATA_N2_2388450
488	mov	x0, x18
489	bl	errata_n2_2388450_wa
490#endif
491
492#if ENABLE_AMU
493	/* Make sure accesses from EL0/EL1 and EL2 are not trapped to EL3 */
494	mrs	x0, cptr_el3
495	orr	x0, x0, #TAM_BIT
496	msr	cptr_el3, x0
497
498	/* Make sure accesses from EL0/EL1 are not trapped to EL2 */
499	mrs	x0, cptr_el2
500	orr	x0, x0, #TAM_BIT
501	msr	cptr_el2, x0
502
503	/* No need to enable the counters as this would be done at el3 exit */
504#endif
505
506#if NEOVERSE_Nx_EXTERNAL_LLC
507	/* Some systems may have External LLC, core needs to be made aware */
508	mrs	x0, NEOVERSE_N2_CPUECTLR_EL1
509	orr	x0, x0, NEOVERSE_N2_CPUECTLR_EL1_EXTLLC_BIT
510	msr	NEOVERSE_N2_CPUECTLR_EL1, x0
511#endif
512
513	bl	cpu_get_rev_var
514	mov	x18, x0
515
516#if ERRATA_N2_2002655
517	mov	x0, x18
518	bl	errata_n2_2002655_wa
519#endif
520
521#if IMAGE_BL31 && WORKAROUND_CVE_2022_23960
522	/*
523	 * The Neoverse-N2 generic vectors are overridden to apply errata
524         * mitigation on exception entry from lower ELs.
525	 */
526	adr	x0, wa_cve_vbar_neoverse_n2
527	msr	vbar_el3, x0
528#endif /* IMAGE_BL31 && WORKAROUND_CVE_2022_23960 */
529
530	isb
531	ret	x19
532endfunc neoverse_n2_reset_func
533
534func neoverse_n2_core_pwr_dwn
535	/* ---------------------------------------------------
536	 * Enable CPU power down bit in power control register
537	 * No need to do cache maintenance here.
538	 * ---------------------------------------------------
539	 */
540	mrs	x0, NEOVERSE_N2_CPUPWRCTLR_EL1
541	orr	x0, x0, #NEOVERSE_N2_CORE_PWRDN_EN_BIT
542	msr	NEOVERSE_N2_CPUPWRCTLR_EL1, x0
543	isb
544	ret
545endfunc neoverse_n2_core_pwr_dwn
546
547#if REPORT_ERRATA
548/*
549 * Errata printing function for Neoverse N2 cores. Must follow AAPCS.
550 */
551func neoverse_n2_errata_report
552	stp	x8, x30, [sp, #-16]!
553
554	bl	cpu_get_rev_var
555	mov	x8, x0
556
557	/*
558	 * Report all errata. The revision-variant information is passed to
559	 * checking functions of each errata.
560	 */
561	report_errata ERRATA_N2_2002655, neoverse_n2, 2002655
562	report_errata ERRATA_N2_2067956, neoverse_n2, 2067956
563	report_errata ERRATA_N2_2025414, neoverse_n2, 2025414
564	report_errata ERRATA_N2_2189731, neoverse_n2, 2189731
565	report_errata ERRATA_N2_2138956, neoverse_n2, 2138956
566	report_errata ERRATA_N2_2138953, neoverse_n2, 2138953
567	report_errata ERRATA_N2_2242415, neoverse_n2, 2242415
568	report_errata ERRATA_N2_2138958, neoverse_n2, 2138958
569	report_errata ERRATA_N2_2242400, neoverse_n2, 2242400
570	report_errata ERRATA_N2_2280757, neoverse_n2, 2280757
571	report_errata ERRATA_N2_2376738, neoverse_n2, 2376738
572	report_errata ERRATA_N2_2388450, neoverse_n2, 2388450
573	report_errata WORKAROUND_CVE_2022_23960, neoverse_n2, cve_2022_23960
574	report_errata ERRATA_DSU_2313941, neoverse_n2, dsu_2313941
575
576	ldp	x8, x30, [sp], #16
577	ret
578endfunc neoverse_n2_errata_report
579#endif
580
581	/* ---------------------------------------------
582	 * This function provides Neoverse N2 specific
583	 * register information for crash reporting.
584	 * It needs to return with x6 pointing to
585	 * a list of register names in ASCII and
586	 * x8 - x15 having values of registers to be
587	 * reported.
588	 * ---------------------------------------------
589	 */
590.section .rodata.neoverse_n2_regs, "aS"
591neoverse_n2_regs:  /* The ASCII list of register names to be reported */
592	.asciz	"cpupwrctlr_el1", ""
593
594func neoverse_n2_cpu_reg_dump
595	adr	x6, neoverse_n2_regs
596	mrs	x8, NEOVERSE_N2_CPUPWRCTLR_EL1
597	ret
598endfunc neoverse_n2_cpu_reg_dump
599
600declare_cpu_ops neoverse_n2, NEOVERSE_N2_MIDR, \
601	neoverse_n2_reset_func, \
602	neoverse_n2_core_pwr_dwn
603