xref: /rk3399_ARM-atf/lib/cpus/aarch64/denver.S (revision 833539623314b9b4b30d5abf072c53667b14856e)
13a8c55f6SVarun Wadekar/*
2b0301467SVarun Wadekar * Copyright (c) 2015-2018, ARM Limited and Contributors. All rights reserved.
33a8c55f6SVarun Wadekar *
482cb2c1aSdp-arm * SPDX-License-Identifier: BSD-3-Clause
53a8c55f6SVarun Wadekar */
63a8c55f6SVarun Wadekar
73a8c55f6SVarun Wadekar#include <arch.h>
83a8c55f6SVarun Wadekar#include <asm_macros.S>
93a8c55f6SVarun Wadekar#include <assert_macros.S>
10b0301467SVarun Wadekar#include <context.h>
113a8c55f6SVarun Wadekar#include <denver.h>
123a8c55f6SVarun Wadekar#include <cpu_macros.S>
133a8c55f6SVarun Wadekar#include <plat_macros.S>
143a8c55f6SVarun Wadekar
15b0301467SVarun Wadekar	/* -------------------------------------------------
16b0301467SVarun Wadekar	 * CVE-2017-5715 mitigation
17b0301467SVarun Wadekar	 *
18b0301467SVarun Wadekar	 * Flush the indirect branch predictor and RSB on
19b0301467SVarun Wadekar	 * entry to EL3 by issuing a newly added instruction
20b0301467SVarun Wadekar	 * for Denver CPUs.
21b0301467SVarun Wadekar	 *
22b0301467SVarun Wadekar	 * To achieve this without performing any branch
23b0301467SVarun Wadekar	 * instruction, a per-cpu vbar is installed which
24b0301467SVarun Wadekar	 * executes the workaround and then branches off to
25b0301467SVarun Wadekar	 * the corresponding vector entry in the main vector
26b0301467SVarun Wadekar	 * table.
27b0301467SVarun Wadekar	 * -------------------------------------------------
28b0301467SVarun Wadekar	 */
29b0301467SVarun Wadekar	.globl	workaround_bpflush_runtime_exceptions
30b0301467SVarun Wadekar
31b0301467SVarun Wadekarvector_base workaround_bpflush_runtime_exceptions
32b0301467SVarun Wadekar
33b0301467SVarun Wadekar	.macro	apply_workaround
34b0301467SVarun Wadekar	stp	x0, x1, [sp, #CTX_GPREGS_OFFSET + CTX_GPREG_X0]
35b0301467SVarun Wadekar
36b0301467SVarun Wadekar	/* -------------------------------------------------
37b0301467SVarun Wadekar	 * A new write-only system register where a write of
38b0301467SVarun Wadekar	 * 1 to bit 0 will cause the indirect branch predictor
39b0301467SVarun Wadekar	 * and RSB to be flushed.
40b0301467SVarun Wadekar	 *
41b0301467SVarun Wadekar	 * A write of 0 to bit 0 will be ignored. A write of
42b0301467SVarun Wadekar	 * 1 to any other bit will cause an MCA.
43b0301467SVarun Wadekar	 * -------------------------------------------------
44b0301467SVarun Wadekar	 */
45b0301467SVarun Wadekar	mov	x0, #1
46b0301467SVarun Wadekar	msr	s3_0_c15_c0_6, x0
47b0301467SVarun Wadekar	isb
48b0301467SVarun Wadekar
49b0301467SVarun Wadekar	ldp	x0, x1, [sp, #CTX_GPREGS_OFFSET + CTX_GPREG_X0]
50b0301467SVarun Wadekar	.endm
51b0301467SVarun Wadekar
52b0301467SVarun Wadekar	/* ---------------------------------------------------------------------
53b0301467SVarun Wadekar	 * Current EL with SP_EL0 : 0x0 - 0x200
54b0301467SVarun Wadekar	 * ---------------------------------------------------------------------
55b0301467SVarun Wadekar	 */
56b0301467SVarun Wadekarvector_entry workaround_bpflush_sync_exception_sp_el0
57b0301467SVarun Wadekar	b	sync_exception_sp_el0
58a9203edaSRoberto Vargasend_vector_entry workaround_bpflush_sync_exception_sp_el0
59b0301467SVarun Wadekar
60b0301467SVarun Wadekarvector_entry workaround_bpflush_irq_sp_el0
61b0301467SVarun Wadekar	b	irq_sp_el0
62a9203edaSRoberto Vargasend_vector_entry workaround_bpflush_irq_sp_el0
63b0301467SVarun Wadekar
64b0301467SVarun Wadekarvector_entry workaround_bpflush_fiq_sp_el0
65b0301467SVarun Wadekar	b	fiq_sp_el0
66a9203edaSRoberto Vargasend_vector_entry workaround_bpflush_fiq_sp_el0
67b0301467SVarun Wadekar
68b0301467SVarun Wadekarvector_entry workaround_bpflush_serror_sp_el0
69b0301467SVarun Wadekar	b	serror_sp_el0
70a9203edaSRoberto Vargasend_vector_entry workaround_bpflush_serror_sp_el0
71b0301467SVarun Wadekar
72b0301467SVarun Wadekar	/* ---------------------------------------------------------------------
73b0301467SVarun Wadekar	 * Current EL with SP_ELx: 0x200 - 0x400
74b0301467SVarun Wadekar	 * ---------------------------------------------------------------------
75b0301467SVarun Wadekar	 */
76b0301467SVarun Wadekarvector_entry workaround_bpflush_sync_exception_sp_elx
77b0301467SVarun Wadekar	b	sync_exception_sp_elx
78a9203edaSRoberto Vargasend_vector_entry workaround_bpflush_sync_exception_sp_elx
79b0301467SVarun Wadekar
80b0301467SVarun Wadekarvector_entry workaround_bpflush_irq_sp_elx
81b0301467SVarun Wadekar	b	irq_sp_elx
82a9203edaSRoberto Vargasend_vector_entry workaround_bpflush_irq_sp_elx
83b0301467SVarun Wadekar
84b0301467SVarun Wadekarvector_entry workaround_bpflush_fiq_sp_elx
85b0301467SVarun Wadekar	b	fiq_sp_elx
86a9203edaSRoberto Vargasend_vector_entry workaround_bpflush_fiq_sp_elx
87b0301467SVarun Wadekar
88b0301467SVarun Wadekarvector_entry workaround_bpflush_serror_sp_elx
89b0301467SVarun Wadekar	b	serror_sp_elx
90a9203edaSRoberto Vargasend_vector_entry workaround_bpflush_serror_sp_elx
91b0301467SVarun Wadekar
92b0301467SVarun Wadekar	/* ---------------------------------------------------------------------
93b0301467SVarun Wadekar	 * Lower EL using AArch64 : 0x400 - 0x600
94b0301467SVarun Wadekar	 * ---------------------------------------------------------------------
95b0301467SVarun Wadekar	 */
96b0301467SVarun Wadekarvector_entry workaround_bpflush_sync_exception_aarch64
97b0301467SVarun Wadekar	apply_workaround
98b0301467SVarun Wadekar	b	sync_exception_aarch64
99a9203edaSRoberto Vargasend_vector_entry workaround_bpflush_sync_exception_aarch64
100b0301467SVarun Wadekar
101b0301467SVarun Wadekarvector_entry workaround_bpflush_irq_aarch64
102b0301467SVarun Wadekar	apply_workaround
103b0301467SVarun Wadekar	b	irq_aarch64
104a9203edaSRoberto Vargasend_vector_entry workaround_bpflush_irq_aarch64
105b0301467SVarun Wadekar
106b0301467SVarun Wadekarvector_entry workaround_bpflush_fiq_aarch64
107b0301467SVarun Wadekar	apply_workaround
108b0301467SVarun Wadekar	b	fiq_aarch64
109a9203edaSRoberto Vargasend_vector_entry workaround_bpflush_fiq_aarch64
110b0301467SVarun Wadekar
111b0301467SVarun Wadekarvector_entry workaround_bpflush_serror_aarch64
112b0301467SVarun Wadekar	apply_workaround
113b0301467SVarun Wadekar	b	serror_aarch64
114a9203edaSRoberto Vargasend_vector_entry workaround_bpflush_serror_aarch64
115b0301467SVarun Wadekar
116b0301467SVarun Wadekar	/* ---------------------------------------------------------------------
117b0301467SVarun Wadekar	 * Lower EL using AArch32 : 0x600 - 0x800
118b0301467SVarun Wadekar	 * ---------------------------------------------------------------------
119b0301467SVarun Wadekar	 */
120b0301467SVarun Wadekarvector_entry workaround_bpflush_sync_exception_aarch32
121b0301467SVarun Wadekar	apply_workaround
122b0301467SVarun Wadekar	b	sync_exception_aarch32
123a9203edaSRoberto Vargasend_vector_entry workaround_bpflush_sync_exception_aarch32
124b0301467SVarun Wadekar
125b0301467SVarun Wadekarvector_entry workaround_bpflush_irq_aarch32
126b0301467SVarun Wadekar	apply_workaround
127b0301467SVarun Wadekar	b	irq_aarch32
128a9203edaSRoberto Vargasend_vector_entry workaround_bpflush_irq_aarch32
129b0301467SVarun Wadekar
130b0301467SVarun Wadekarvector_entry workaround_bpflush_fiq_aarch32
131b0301467SVarun Wadekar	apply_workaround
132b0301467SVarun Wadekar	b	fiq_aarch32
133a9203edaSRoberto Vargasend_vector_entry workaround_bpflush_fiq_aarch32
134b0301467SVarun Wadekar
135b0301467SVarun Wadekarvector_entry workaround_bpflush_serror_aarch32
136b0301467SVarun Wadekar	apply_workaround
137b0301467SVarun Wadekar	b	serror_aarch32
138a9203edaSRoberto Vargasend_vector_entry workaround_bpflush_serror_aarch32
139b0301467SVarun Wadekar
1409f1c5dd1SVarun Wadekar	.global	denver_disable_dco
1419f1c5dd1SVarun Wadekar
1423a8c55f6SVarun Wadekar	/* ---------------------------------------------
1433a8c55f6SVarun Wadekar	 * Disable debug interfaces
1443a8c55f6SVarun Wadekar	 * ---------------------------------------------
1453a8c55f6SVarun Wadekar	 */
1463a8c55f6SVarun Wadekarfunc denver_disable_ext_debug
1473a8c55f6SVarun Wadekar	mov	x0, #1
1483a8c55f6SVarun Wadekar	msr	osdlr_el1, x0
1493a8c55f6SVarun Wadekar	isb
1503a8c55f6SVarun Wadekar	dsb	sy
1513a8c55f6SVarun Wadekar	ret
1523a8c55f6SVarun Wadekarendfunc denver_disable_ext_debug
1533a8c55f6SVarun Wadekar
1543a8c55f6SVarun Wadekar	/* ----------------------------------------------------
1553a8c55f6SVarun Wadekar	 * Enable dynamic code optimizer (DCO)
1563a8c55f6SVarun Wadekar	 * ----------------------------------------------------
1573a8c55f6SVarun Wadekar	 */
1583a8c55f6SVarun Wadekarfunc denver_enable_dco
1593a8c55f6SVarun Wadekar	mrs	x0, mpidr_el1
1603a8c55f6SVarun Wadekar	and	x0, x0, #0xF
1613a8c55f6SVarun Wadekar	mov	x1, #1
1623a8c55f6SVarun Wadekar	lsl	x1, x1, x0
1633a8c55f6SVarun Wadekar	msr	s3_0_c15_c0_2, x1
1643a8c55f6SVarun Wadekar	ret
1653a8c55f6SVarun Wadekarendfunc denver_enable_dco
1663a8c55f6SVarun Wadekar
1673a8c55f6SVarun Wadekar	/* ----------------------------------------------------
1683a8c55f6SVarun Wadekar	 * Disable dynamic code optimizer (DCO)
1693a8c55f6SVarun Wadekar	 * ----------------------------------------------------
1703a8c55f6SVarun Wadekar	 */
1713a8c55f6SVarun Wadekarfunc denver_disable_dco
1723a8c55f6SVarun Wadekar
1733a8c55f6SVarun Wadekar	/* turn off background work */
1743a8c55f6SVarun Wadekar	mrs	x0, mpidr_el1
1753a8c55f6SVarun Wadekar	and	x0, x0, #0xF
1763a8c55f6SVarun Wadekar	mov	x1, #1
1773a8c55f6SVarun Wadekar	lsl	x1, x1, x0
1783a8c55f6SVarun Wadekar	lsl	x2, x1, #16
1793a8c55f6SVarun Wadekar	msr	s3_0_c15_c0_2, x2
1803a8c55f6SVarun Wadekar	isb
1813a8c55f6SVarun Wadekar
1823a8c55f6SVarun Wadekar	/* wait till the background work turns off */
1833a8c55f6SVarun Wadekar1:	mrs	x2, s3_0_c15_c0_2
1843a8c55f6SVarun Wadekar	lsr	x2, x2, #32
1853a8c55f6SVarun Wadekar	and	w2, w2, 0xFFFF
1863a8c55f6SVarun Wadekar	and	x2, x2, x1
1873a8c55f6SVarun Wadekar	cbnz	x2, 1b
1883a8c55f6SVarun Wadekar
1893a8c55f6SVarun Wadekar	ret
1903a8c55f6SVarun Wadekarendfunc denver_disable_dco
1913a8c55f6SVarun Wadekar
192*83353962SVarun Wadekarfunc check_errata_cve_2017_5715
193*83353962SVarun Wadekar	mov	x0, #ERRATA_MISSING
194*83353962SVarun Wadekar#if WORKAROUND_CVE_2017_5715
195*83353962SVarun Wadekar	/*
196*83353962SVarun Wadekar	 * Check if the CPU supports the special instruction
197*83353962SVarun Wadekar	 * required to flush the indirect branch predictor and
198*83353962SVarun Wadekar	 * RSB. Support for this operation can be determined by
199*83353962SVarun Wadekar	 * comparing bits 19:16 of ID_AFR0_EL1 with 0b0001.
200*83353962SVarun Wadekar	 */
201*83353962SVarun Wadekar	mrs	x1, id_afr0_el1
202*83353962SVarun Wadekar	mov	x2, #0x10000
203*83353962SVarun Wadekar	and	x1, x1, x2
204*83353962SVarun Wadekar	cbz	x1, 1f
205*83353962SVarun Wadekar	mov	x0, #ERRATA_APPLIES
206*83353962SVarun Wadekar1:
207*83353962SVarun Wadekar#endif
208*83353962SVarun Wadekar	ret
209*83353962SVarun Wadekarendfunc check_errata_cve_2017_5715
210*83353962SVarun Wadekar
2113a8c55f6SVarun Wadekar	/* -------------------------------------------------
2123a8c55f6SVarun Wadekar	 * The CPU Ops reset function for Denver.
2133a8c55f6SVarun Wadekar	 * -------------------------------------------------
2143a8c55f6SVarun Wadekar	 */
2153a8c55f6SVarun Wadekarfunc denver_reset_func
2163a8c55f6SVarun Wadekar
2173a8c55f6SVarun Wadekar	mov	x19, x30
2183a8c55f6SVarun Wadekar
219b0301467SVarun Wadekar#if IMAGE_BL31 && WORKAROUND_CVE_2017_5715
220b0301467SVarun Wadekar	/*
221b0301467SVarun Wadekar	 * Check if the CPU supports the special instruction
222b0301467SVarun Wadekar	 * required to flush the indirect branch predictor and
223b0301467SVarun Wadekar	 * RSB. Support for this operation can be determined by
224b0301467SVarun Wadekar	 * comparing bits 19:16 of ID_AFR0_EL1 with 0b0001.
225b0301467SVarun Wadekar	 */
226b0301467SVarun Wadekar	mrs	x0, id_afr0_el1
227b0301467SVarun Wadekar	mov	x1, #0x10000
228b0301467SVarun Wadekar	and	x0, x0, x1
229b0301467SVarun Wadekar	cmp	x0, #0
230b0301467SVarun Wadekar	adr	x1, workaround_bpflush_runtime_exceptions
231b0301467SVarun Wadekar	mrs	x2, vbar_el3
232b0301467SVarun Wadekar	csel	x0, x1, x2, ne
233b0301467SVarun Wadekar	msr	vbar_el3, x0
234b0301467SVarun Wadekar#endif
235b0301467SVarun Wadekar
2363a8c55f6SVarun Wadekar	/* ----------------------------------------------------
2373a8c55f6SVarun Wadekar	 * Enable dynamic code optimizer (DCO)
2383a8c55f6SVarun Wadekar	 * ----------------------------------------------------
2393a8c55f6SVarun Wadekar	 */
2403a8c55f6SVarun Wadekar	bl	denver_enable_dco
2413a8c55f6SVarun Wadekar
2423a8c55f6SVarun Wadekar	ret	x19
2433a8c55f6SVarun Wadekarendfunc denver_reset_func
2443a8c55f6SVarun Wadekar
2453a8c55f6SVarun Wadekar	/* ----------------------------------------------------
2463a8c55f6SVarun Wadekar	 * The CPU Ops core power down function for Denver.
2473a8c55f6SVarun Wadekar	 * ----------------------------------------------------
2483a8c55f6SVarun Wadekar	 */
2493a8c55f6SVarun Wadekarfunc denver_core_pwr_dwn
2503a8c55f6SVarun Wadekar
2513a8c55f6SVarun Wadekar	mov	x19, x30
2523a8c55f6SVarun Wadekar
2533a8c55f6SVarun Wadekar	/* ---------------------------------------------
2543a8c55f6SVarun Wadekar	 * Force the debug interfaces to be quiescent
2553a8c55f6SVarun Wadekar	 * ---------------------------------------------
2563a8c55f6SVarun Wadekar	 */
2573a8c55f6SVarun Wadekar	bl	denver_disable_ext_debug
2583a8c55f6SVarun Wadekar
2593a8c55f6SVarun Wadekar	ret	x19
2603a8c55f6SVarun Wadekarendfunc denver_core_pwr_dwn
2613a8c55f6SVarun Wadekar
2623a8c55f6SVarun Wadekar	/* -------------------------------------------------------
2633a8c55f6SVarun Wadekar	 * The CPU Ops cluster power down function for Denver.
2643a8c55f6SVarun Wadekar	 * -------------------------------------------------------
2653a8c55f6SVarun Wadekar	 */
2663a8c55f6SVarun Wadekarfunc denver_cluster_pwr_dwn
2673a8c55f6SVarun Wadekar	ret
2683a8c55f6SVarun Wadekarendfunc denver_cluster_pwr_dwn
2693a8c55f6SVarun Wadekar
270*83353962SVarun Wadekar#if REPORT_ERRATA
271*83353962SVarun Wadekar	/*
272*83353962SVarun Wadekar	 * Errata printing function for Denver. Must follow AAPCS.
273*83353962SVarun Wadekar	 */
274*83353962SVarun Wadekarfunc denver_errata_report
275*83353962SVarun Wadekar	stp	x8, x30, [sp, #-16]!
276*83353962SVarun Wadekar
277*83353962SVarun Wadekar	bl	cpu_get_rev_var
278*83353962SVarun Wadekar	mov	x8, x0
279*83353962SVarun Wadekar
280*83353962SVarun Wadekar	/*
281*83353962SVarun Wadekar	 * Report all errata. The revision-variant information is passed to
282*83353962SVarun Wadekar	 * checking functions of each errata.
283*83353962SVarun Wadekar	 */
284*83353962SVarun Wadekar	report_errata WORKAROUND_CVE_2017_5715, denver, cve_2017_5715
285*83353962SVarun Wadekar
286*83353962SVarun Wadekar	ldp	x8, x30, [sp], #16
287*83353962SVarun Wadekar	ret
288*83353962SVarun Wadekarendfunc denver_errata_report
289*83353962SVarun Wadekar#endif
290*83353962SVarun Wadekar
2913a8c55f6SVarun Wadekar	/* ---------------------------------------------
2923a8c55f6SVarun Wadekar	 * This function provides Denver specific
2933a8c55f6SVarun Wadekar	 * register information for crash reporting.
2943a8c55f6SVarun Wadekar	 * It needs to return with x6 pointing to
2953a8c55f6SVarun Wadekar	 * a list of register names in ascii and
2963a8c55f6SVarun Wadekar	 * x8 - x15 having values of registers to be
2973a8c55f6SVarun Wadekar	 * reported.
2983a8c55f6SVarun Wadekar	 * ---------------------------------------------
2993a8c55f6SVarun Wadekar	 */
3003a8c55f6SVarun Wadekar.section .rodata.denver_regs, "aS"
3013a8c55f6SVarun Wadekardenver_regs:  /* The ascii list of register names to be reported */
3023a8c55f6SVarun Wadekar	.asciz	"actlr_el1", ""
3033a8c55f6SVarun Wadekar
3043a8c55f6SVarun Wadekarfunc denver_cpu_reg_dump
3053a8c55f6SVarun Wadekar	adr	x6, denver_regs
3063a8c55f6SVarun Wadekar	mrs	x8, ACTLR_EL1
3073a8c55f6SVarun Wadekar	ret
3083a8c55f6SVarun Wadekarendfunc denver_cpu_reg_dump
3093a8c55f6SVarun Wadekar
310*83353962SVarun Wadekardeclare_cpu_ops_wa denver, DENVER_MIDR_PN0, \
311e956e228SVarun Wadekar	denver_reset_func, \
312*83353962SVarun Wadekar	check_errata_cve_2017_5715, \
313*83353962SVarun Wadekar	CPU_NO_EXTRA2_FUNC, \
314e956e228SVarun Wadekar	denver_core_pwr_dwn, \
315e956e228SVarun Wadekar	denver_cluster_pwr_dwn
316e956e228SVarun Wadekar
317*83353962SVarun Wadekardeclare_cpu_ops_wa denver, DENVER_MIDR_PN1, \
318e956e228SVarun Wadekar	denver_reset_func, \
319*83353962SVarun Wadekar	check_errata_cve_2017_5715, \
320*83353962SVarun Wadekar	CPU_NO_EXTRA2_FUNC, \
321e956e228SVarun Wadekar	denver_core_pwr_dwn, \
322e956e228SVarun Wadekar	denver_cluster_pwr_dwn
323e956e228SVarun Wadekar
324*83353962SVarun Wadekardeclare_cpu_ops_wa denver, DENVER_MIDR_PN2, \
325e956e228SVarun Wadekar	denver_reset_func, \
326*83353962SVarun Wadekar	check_errata_cve_2017_5715, \
327*83353962SVarun Wadekar	CPU_NO_EXTRA2_FUNC, \
328e956e228SVarun Wadekar	denver_core_pwr_dwn, \
329e956e228SVarun Wadekar	denver_cluster_pwr_dwn
330e956e228SVarun Wadekar
331*83353962SVarun Wadekardeclare_cpu_ops_wa denver, DENVER_MIDR_PN3, \
332e956e228SVarun Wadekar	denver_reset_func, \
333*83353962SVarun Wadekar	check_errata_cve_2017_5715, \
334*83353962SVarun Wadekar	CPU_NO_EXTRA2_FUNC, \
335e956e228SVarun Wadekar	denver_core_pwr_dwn, \
336e956e228SVarun Wadekar	denver_cluster_pwr_dwn
337e956e228SVarun Wadekar
338*83353962SVarun Wadekardeclare_cpu_ops_wa denver, DENVER_MIDR_PN4, \
3395dd9dbb5SJeenu Viswambharan	denver_reset_func, \
340*83353962SVarun Wadekar	check_errata_cve_2017_5715, \
341*83353962SVarun Wadekar	CPU_NO_EXTRA2_FUNC, \
3425dd9dbb5SJeenu Viswambharan	denver_core_pwr_dwn, \
3435dd9dbb5SJeenu Viswambharan	denver_cluster_pwr_dwn
344