xref: /rk3399_ARM-atf/lib/cpus/aarch64/neoverse_n1.S (revision fd7b287cbe9147ca9e07dd9f30c49c58bbdd92a8)
1/*
2 * Copyright (c) 2017-2019, ARM Limited and Contributors. All rights reserved.
3 *
4 * SPDX-License-Identifier: BSD-3-Clause
5 */
6
7#include <arch.h>
8#include <asm_macros.S>
9#include <neoverse_n1.h>
10#include <cpuamu.h>
11#include <cpu_macros.S>
12
13/* --------------------------------------------------
14 * Errata Workaround for Neoverse N1 Errata
15 * This applies to revision r0p0 and r1p0 of Neoverse N1.
16 * Inputs:
17 * x0: variant[4:7] and revision[0:3] of current cpu.
18 * Shall clobber: x0-x17
19 * --------------------------------------------------
20 */
21func errata_n1_1043202_wa
22	/* Compare x0 against revision r1p0 */
23	mov	x17, x30
24	bl	check_errata_1043202
25	cbz	x0, 1f
26
27	/* Apply instruction patching sequence */
28	ldr	x0, =0x0
29	msr	CPUPSELR_EL3, x0
30	ldr	x0, =0xF3BF8F2F
31	msr	CPUPOR_EL3, x0
32	ldr	x0, =0xFFFFFFFF
33	msr	CPUPMR_EL3, x0
34	ldr	x0, =0x800200071
35	msr	CPUPCR_EL3, x0
36	isb
371:
38	ret	x17
39endfunc errata_n1_1043202_wa
40
41func check_errata_1043202
42	/* Applies to r0p0 and r1p0 */
43	mov	x1, #0x10
44	b	cpu_rev_var_ls
45endfunc check_errata_1043202
46
47func neoverse_n1_reset_func
48	mov	x19, x30
49
50	/* Disables speculative loads */
51	msr	SSBS, xzr
52
53	/* Forces all cacheable atomic instructions to be near */
54	mrs	x0, NEOVERSE_N1_CPUACTLR2_EL1
55	orr	x0, x0, #NEOVERSE_N1_CPUACTLR2_EL1_BIT_2
56	msr	NEOVERSE_N1_CPUACTLR2_EL1, x0
57	isb
58
59	bl	cpu_get_rev_var
60	mov	x18, x0
61
62#if ERRATA_N1_1043202
63	mov	x0, x18
64	bl	errata_n1_1043202_wa
65#endif
66
67#if ENABLE_AMU
68	/* Make sure accesses from EL0/EL1 and EL2 are not trapped to EL3 */
69	mrs	x0, actlr_el3
70	orr	x0, x0, #NEOVERSE_N1_ACTLR_AMEN_BIT
71	msr	actlr_el3, x0
72	isb
73
74	/* Make sure accesses from EL0/EL1 are not trapped to EL2 */
75	mrs	x0, actlr_el2
76	orr	x0, x0, #NEOVERSE_N1_ACTLR_AMEN_BIT
77	msr	actlr_el2, x0
78	isb
79
80	/* Enable group0 counters */
81	mov	x0, #NEOVERSE_N1_AMU_GROUP0_MASK
82	msr	CPUAMCNTENSET_EL0, x0
83	isb
84#endif
85	ret	x19
86endfunc neoverse_n1_reset_func
87
88	/* ---------------------------------------------
89	 * HW will do the cache maintenance while powering down
90	 * ---------------------------------------------
91	 */
92func neoverse_n1_core_pwr_dwn
93	/* ---------------------------------------------
94	 * Enable CPU power down bit in power control register
95	 * ---------------------------------------------
96	 */
97	mrs	x0, NEOVERSE_N1_CPUPWRCTLR_EL1
98	orr	x0, x0, #NEOVERSE_N1_CORE_PWRDN_EN_MASK
99	msr	NEOVERSE_N1_CPUPWRCTLR_EL1, x0
100	isb
101	ret
102endfunc neoverse_n1_core_pwr_dwn
103
104#if REPORT_ERRATA
105/*
106 * Errata printing function for Neoverse N1. Must follow AAPCS.
107 */
108func neoverse_n1_errata_report
109	stp	x8, x30, [sp, #-16]!
110
111	bl	cpu_get_rev_var
112	mov	x8, x0
113
114	/*
115	 * Report all errata. The revision-variant information is passed to
116	 * checking functions of each errata.
117	 */
118	report_errata ERRATA_N1_1043202, neoverse_n1, 1043202
119
120	ldp	x8, x30, [sp], #16
121	ret
122endfunc neoverse_n1_errata_report
123#endif
124
125	/* ---------------------------------------------
126	 * This function provides neoverse_n1 specific
127	 * register information for crash reporting.
128	 * It needs to return with x6 pointing to
129	 * a list of register names in ascii and
130	 * x8 - x15 having values of registers to be
131	 * reported.
132	 * ---------------------------------------------
133	 */
134.section .rodata.neoverse_n1_regs, "aS"
135neoverse_n1_regs:  /* The ascii list of register names to be reported */
136	.asciz	"cpuectlr_el1", ""
137
138func neoverse_n1_cpu_reg_dump
139	adr	x6, neoverse_n1_regs
140	mrs	x8, NEOVERSE_N1_CPUECTLR_EL1
141	ret
142endfunc neoverse_n1_cpu_reg_dump
143
144declare_cpu_ops neoverse_n1, NEOVERSE_N1_MIDR, \
145	neoverse_n1_reset_func, \
146	neoverse_n1_core_pwr_dwn
147