xref: /rk3399_ARM-atf/lib/cpus/aarch64/cortex_a510.S (revision 762c34a85d8cf42ad03359656d9a254d15e44661)
1/*
2 * Copyright (c) 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_a510.h>
11#include <cpu_macros.S>
12#include <plat_macros.S>
13
14/* Hardware handled coherency */
15#if HW_ASSISTED_COHERENCY == 0
16#error "Cortex-A510 must be compiled with HW_ASSISTED_COHERENCY enabled"
17#endif
18
19/* 64-bit only core */
20#if CTX_INCLUDE_AARCH32_REGS == 1
21#error "Cortex-A510 supports only AArch64. Compile with CTX_INCLUDE_AARCH32_REGS=0"
22#endif
23
24	/* --------------------------------------------------
25	 * Errata Workaround for Cortex-A510 Errata #1922240.
26	 * This applies only to revision r0p0 (fixed in r0p1)
27	 * x0: variant[4:7] and revision[0:3] of current cpu.
28	 * Shall clobber: x0, x1, x17
29	 * --------------------------------------------------
30	 */
31func errata_cortex_a510_1922240_wa
32	/* Check workaround compatibility. */
33	mov	x17, x30
34	bl	check_errata_1922240
35	cbz	x0, 1f
36
37	/* Apply the workaround by setting IMP_CMPXACTLR_EL1[11:10] = 0b11. */
38	mrs	x0, CORTEX_A510_CMPXACTLR_EL1
39	mov	x1, #3
40	bfi	x0, x1, #10, #2
41	msr	CORTEX_A510_CMPXACTLR_EL1, x0
42
431:
44	ret	x17
45endfunc errata_cortex_a510_1922240_wa
46
47func check_errata_1922240
48	/* Applies to r0p0 only */
49	mov	x1, #0x00
50	b	cpu_rev_var_ls
51endfunc check_errata_1922240
52
53	/* --------------------------------------------------
54	 * Errata Workaround for Cortex-A510 Errata #2288014.
55	 * This applies only to revisions r0p0, r0p1, r0p2,
56	 * r0p3 and r1p0. (fixed in r1p1)
57	 * x0: variant[4:7] and revision[0:3] of current cpu.
58	 * Shall clobber: x0, x1, x17
59	 * --------------------------------------------------
60	 */
61func errata_cortex_a510_2288014_wa
62	/* Check workaround compatibility. */
63	mov	x17, x30
64	bl	check_errata_2288014
65	cbz	x0, 1f
66
67	/* Apply the workaround by setting IMP_CPUACTLR_EL1[18] = 0b1. */
68	mrs	x0, CORTEX_A510_CPUACTLR_EL1
69	mov	x1, #1
70	bfi	x0, x1, #18, #1
71	msr	CORTEX_A510_CPUACTLR_EL1, x0
72
731:
74	ret	x17
75endfunc errata_cortex_a510_2288014_wa
76
77func check_errata_2288014
78	/* Applies to r1p0 and below */
79	mov	x1, #0x10
80	b	cpu_rev_var_ls
81endfunc check_errata_2288014
82
83	/* --------------------------------------------------
84	 * Errata Workaround for Cortex-A510 Errata #2042739.
85	 * This applies only to revisions r0p0, r0p1 and r0p2.
86	 * (fixed in r0p3)
87	 * x0: variant[4:7] and revision[0:3] of current cpu.
88	 * Shall clobber: x0, x1, x17
89	 * --------------------------------------------------
90	 */
91func errata_cortex_a510_2042739_wa
92	/* Check workaround compatibility. */
93	mov	x17, x30
94	bl	check_errata_2042739
95	cbz	x0, 1f
96
97	/* Apply the workaround by disabling ReadPreferUnique. */
98	mrs	x0, CORTEX_A510_CPUECTLR_EL1
99	mov	x1, #CORTEX_A510_CPUECTLR_EL1_READPREFERUNIQUE_DISABLE
100	bfi	x0, x1, #CORTEX_A510_CPUECTLR_EL1_READPREFERUNIQUE_SHIFT, #1
101	msr	CORTEX_A510_CPUECTLR_EL1, x0
102
1031:
104	ret	x17
105endfunc errata_cortex_a510_2042739_wa
106
107func check_errata_2042739
108	/* Applies to revisions r0p0 - r0p2 */
109	mov	x1, #0x02
110	b	cpu_rev_var_ls
111endfunc check_errata_2042739
112
113	/* --------------------------------------------------
114	 * Errata Workaround for Cortex-A510 Errata #2041909.
115	 * This applies only to revision r0p2 and it is fixed in
116	 * r0p3. The issue is also present in r0p0 and r0p1 but
117	 * there is no workaround in those revisions.
118	 * x0: variant[4:7] and revision[0:3] of current cpu.
119	 * Shall clobber: x0, x1, x2, x17
120	 * --------------------------------------------------
121	 */
122func errata_cortex_a510_2041909_wa
123	/* Check workaround compatibility. */
124	mov	x17, x30
125	bl	check_errata_2041909
126	cbz	x0, 1f
127
128	/* Apply workaround */
129	mov	x0, xzr
130	msr	S3_6_C15_C4_0, x0
131	isb
132
133	mov	x0, #0x8500000
134	msr	S3_6_C15_C4_2, x0
135
136	mov	x0, #0x1F700000
137	movk	x0, #0x8, lsl #32
138	msr	S3_6_C15_C4_3, x0
139
140	mov	x0, #0x3F1
141	movk	x0, #0x110, lsl #16
142	msr	S3_6_C15_C4_1, x0
143	isb
144
1451:
146	ret	x17
147endfunc errata_cortex_a510_2041909_wa
148
149func check_errata_2041909
150	/* Applies only to revision r0p2 */
151	mov	x1, #0x02
152	mov	x2, #0x02
153	b	cpu_rev_var_range
154endfunc check_errata_2041909
155
156	/* --------------------------------------------------
157	 * Errata Workaround for Cortex-A510 Errata #2250311.
158	 * This applies only to revisions r0p0, r0p1, r0p2,
159	 * r0p3 and r1p0, and is fixed in r1p1.
160	 * This workaround is not a typical errata fix. MPMM
161	 * is disabled here, but this conflicts with the BL31
162	 * MPMM support. So in addition to simply disabling
163	 * the feature, a flag is set in the MPMM library
164	 * indicating that it should not be enabled even if
165	 * ENABLE_MPMM=1.
166	 * x0: variant[4:7] and revision[0:3] of current cpu.
167	 * Shall clobber: x0, x1, x17
168	 * --------------------------------------------------
169	 */
170func errata_cortex_a510_2250311_wa
171	/* Check workaround compatibility. */
172	mov	x17, x30
173	bl	check_errata_2250311
174	cbz	x0, 1f
175
176	/* Disable MPMM */
177	mrs	x0, CPUMPMMCR_EL3
178	bfm	x0, xzr, #0, #0 /* bfc instruction does not work in GCC */
179	msr	CPUMPMMCR_EL3, x0
180
181#if ENABLE_MPMM && IMAGE_BL31
182	/* If ENABLE_MPMM is set, tell the runtime lib to skip enabling it. */
183	bl mpmm_errata_disable
184#endif
185
1861:
187	ret x17
188endfunc errata_cortex_a510_2250311_wa
189
190func check_errata_2250311
191	/* Applies to r1p0 and lower */
192	mov	x1, #0x10
193	b	cpu_rev_var_ls
194endfunc check_errata_2250311
195
196	/* --------------------------------------------------
197	 * Errata Workaround for Cortex-A510 Errata #2218950.
198	 * This applies only to revisions r0p0, r0p1, r0p2,
199	 * r0p3 and r1p0, and is fixed in r1p1.
200	 * x0: variant[4:7] and revision[0:3] of current cpu.
201	 * Shall clobber: x0, x1, x17
202	 * --------------------------------------------------
203	 */
204func errata_cortex_a510_2218950_wa
205	/* Check workaround compatibility. */
206	mov	x17, x30
207	bl	check_errata_2218950
208	cbz	x0, 1f
209
210	/* Source register for BFI */
211	mov	x1, #1
212
213	/* Set bit 18 in CPUACTLR_EL1 */
214	mrs	x0, CORTEX_A510_CPUACTLR_EL1
215	bfi	x0, x1, #18, #1
216	msr	CORTEX_A510_CPUACTLR_EL1, x0
217
218	/* Set bit 25 in CMPXACTLR_EL1 */
219	mrs	x0, CORTEX_A510_CMPXACTLR_EL1
220	bfi	x0, x1, #25, #1
221	msr	CORTEX_A510_CMPXACTLR_EL1, x0
222
2231:
224	ret x17
225endfunc errata_cortex_a510_2218950_wa
226
227func check_errata_2218950
228	/* Applies to r1p0 and lower */
229	mov	x1, #0x10
230	b	cpu_rev_var_ls
231endfunc check_errata_2218950
232
233	/* --------------------------------------------------
234	 * Errata Workaround for Cortex-A510 Errata #2172148.
235	 * This applies only to revisions r0p0, r0p1, r0p2,
236	 * r0p3 and r1p0, and is fixed in r1p1.
237	 * x0: variant[4:7] and revision[0:3] of current cpu.
238	 * Shall clobber: x0, x1, x17
239	 * --------------------------------------------------
240	 */
241func errata_cortex_a510_2172148_wa
242	/* Check workaround compatibility. */
243	mov	x17, x30
244	bl	check_errata_2172148
245	cbz	x0, 1f
246
247	/*
248	 * Force L2 allocation of transient lines by setting
249	 * CPUECTLR_EL1.RSCTL=0b01 and CPUECTLR_EL1.NTCTL=0b01.
250	 */
251	mrs	x0, CORTEX_A510_CPUECTLR_EL1
252	mov	x1, #1
253	bfi	x0, x1, #CORTEX_A510_CPUECTLR_EL1_RSCTL_SHIFT, #2
254	bfi	x0, x1, #CORTEX_A510_CPUECTLR_EL1_NTCTL_SHIFT, #2
255	msr	CORTEX_A510_CPUECTLR_EL1, x0
256
2571:
258	ret x17
259endfunc errata_cortex_a510_2172148_wa
260
261func check_errata_2172148
262	/* Applies to r1p0 and lower */
263	mov	x1, #0x10
264	b	cpu_rev_var_ls
265endfunc check_errata_2172148
266
267	/* ----------------------------------------------------
268	 * HW will do the cache maintenance while powering down
269	 * ----------------------------------------------------
270	 */
271func cortex_a510_core_pwr_dwn
272	/* ---------------------------------------------------
273	 * Enable CPU power down bit in power control register
274	 * ---------------------------------------------------
275	 */
276	mrs	x0, CORTEX_A510_CPUPWRCTLR_EL1
277	orr	x0, x0, #CORTEX_A510_CPUPWRCTLR_EL1_CORE_PWRDN_BIT
278	msr	CORTEX_A510_CPUPWRCTLR_EL1, x0
279	isb
280	ret
281endfunc cortex_a510_core_pwr_dwn
282
283	/*
284	 * Errata printing function for Cortex-A510. Must follow AAPCS.
285	 */
286#if REPORT_ERRATA
287func cortex_a510_errata_report
288	stp	x8, x30, [sp, #-16]!
289
290	bl	cpu_get_rev_var
291	mov	x8, x0
292
293	/*
294	 * Report all errata. The revision-variant information is passed to
295	 * checking functions of each errata.
296	 */
297	report_errata ERRATA_A510_1922240, cortex_a510, 1922240
298	report_errata ERRATA_A510_2288014, cortex_a510, 2288014
299	report_errata ERRATA_A510_2042739, cortex_a510, 2042739
300	report_errata ERRATA_A510_2041909, cortex_a510, 2041909
301	report_errata ERRATA_A510_2250311, cortex_a510, 2250311
302	report_errata ERRATA_A510_2218950, cortex_a510, 2218950
303	report_errata ERRATA_A510_2172148, cortex_a510, 2172148
304	report_errata ERRATA_DSU_2313941, cortex_a510, dsu_2313941
305
306	ldp	x8, x30, [sp], #16
307	ret
308endfunc cortex_a510_errata_report
309#endif
310
311func cortex_a510_reset_func
312	mov	x19, x30
313
314	/* Disable speculative loads */
315	msr	SSBS, xzr
316
317	/* Get the CPU revision and stash it in x18. */
318	bl	cpu_get_rev_var
319	mov	x18, x0
320
321#if ERRATA_DSU_2313941
322	bl	errata_dsu_2313941_wa
323#endif
324
325#if ERRATA_A510_1922240
326	mov	x0, x18
327	bl	errata_cortex_a510_1922240_wa
328#endif
329
330#if ERRATA_A510_2288014
331	mov	x0, x18
332	bl	errata_cortex_a510_2288014_wa
333#endif
334
335#if ERRATA_A510_2042739
336	mov	x0, x18
337	bl	errata_cortex_a510_2042739_wa
338#endif
339
340#if ERRATA_A510_2041909
341	mov	x0, x18
342	bl	errata_cortex_a510_2041909_wa
343#endif
344
345#if ERRATA_A510_2250311
346	mov	x0, x18
347	bl	errata_cortex_a510_2250311_wa
348#endif
349
350#if ERRATA_A510_2218950
351	mov	x0, x18
352	bl	errata_cortex_a510_2218950_wa
353#endif
354
355#if ERRATA_A510_2172148
356	mov	x0, x18
357	bl	errata_cortex_a510_2172148_wa
358#endif
359
360	isb
361	ret	x19
362endfunc cortex_a510_reset_func
363
364	/* ---------------------------------------------
365	 * This function provides Cortex-A510 specific
366	 * register information for crash reporting.
367	 * It needs to return with x6 pointing to
368	 * a list of register names in ascii and
369	 * x8 - x15 having values of registers to be
370	 * reported.
371	 * ---------------------------------------------
372	 */
373.section .rodata.cortex_a510_regs, "aS"
374cortex_a510_regs:  /* The ascii list of register names to be reported */
375	.asciz	"cpuectlr_el1", ""
376
377func cortex_a510_cpu_reg_dump
378	adr	x6, cortex_a510_regs
379	mrs	x8, CORTEX_A510_CPUECTLR_EL1
380	ret
381endfunc cortex_a510_cpu_reg_dump
382
383declare_cpu_ops cortex_a510, CORTEX_A510_MIDR, \
384	cortex_a510_reset_func, \
385	cortex_a510_core_pwr_dwn
386