xref: /aosp_15_r20/external/arm-trusted-firmware/include/arch/aarch64/arch_helpers.h (revision 54fd6939e177f8ff529b10183254802c76df6d08)
1*54fd6939SJiyong Park /*
2*54fd6939SJiyong Park  * Copyright (c) 2013-2021, Arm Limited and Contributors. All rights reserved.
3*54fd6939SJiyong Park  *
4*54fd6939SJiyong Park  * SPDX-License-Identifier: BSD-3-Clause
5*54fd6939SJiyong Park  */
6*54fd6939SJiyong Park 
7*54fd6939SJiyong Park #ifndef ARCH_HELPERS_H
8*54fd6939SJiyong Park #define ARCH_HELPERS_H
9*54fd6939SJiyong Park 
10*54fd6939SJiyong Park #include <cdefs.h>
11*54fd6939SJiyong Park #include <stdbool.h>
12*54fd6939SJiyong Park #include <stdint.h>
13*54fd6939SJiyong Park #include <string.h>
14*54fd6939SJiyong Park 
15*54fd6939SJiyong Park #include <arch.h>
16*54fd6939SJiyong Park 
17*54fd6939SJiyong Park /**********************************************************************
18*54fd6939SJiyong Park  * Macros which create inline functions to read or write CPU system
19*54fd6939SJiyong Park  * registers
20*54fd6939SJiyong Park  *********************************************************************/
21*54fd6939SJiyong Park 
22*54fd6939SJiyong Park #define _DEFINE_SYSREG_READ_FUNC(_name, _reg_name)		\
23*54fd6939SJiyong Park static inline u_register_t read_ ## _name(void)			\
24*54fd6939SJiyong Park {								\
25*54fd6939SJiyong Park 	u_register_t v;						\
26*54fd6939SJiyong Park 	__asm__ volatile ("mrs %0, " #_reg_name : "=r" (v));	\
27*54fd6939SJiyong Park 	return v;						\
28*54fd6939SJiyong Park }
29*54fd6939SJiyong Park 
30*54fd6939SJiyong Park #define _DEFINE_SYSREG_WRITE_FUNC(_name, _reg_name)			\
31*54fd6939SJiyong Park static inline void write_ ## _name(u_register_t v)			\
32*54fd6939SJiyong Park {									\
33*54fd6939SJiyong Park 	__asm__ volatile ("msr " #_reg_name ", %0" : : "r" (v));	\
34*54fd6939SJiyong Park }
35*54fd6939SJiyong Park 
36*54fd6939SJiyong Park #define SYSREG_WRITE_CONST(reg_name, v)				\
37*54fd6939SJiyong Park 	__asm__ volatile ("msr " #reg_name ", %0" : : "i" (v))
38*54fd6939SJiyong Park 
39*54fd6939SJiyong Park /* Define read function for system register */
40*54fd6939SJiyong Park #define DEFINE_SYSREG_READ_FUNC(_name) 			\
41*54fd6939SJiyong Park 	_DEFINE_SYSREG_READ_FUNC(_name, _name)
42*54fd6939SJiyong Park 
43*54fd6939SJiyong Park /* Define read & write function for system register */
44*54fd6939SJiyong Park #define DEFINE_SYSREG_RW_FUNCS(_name)			\
45*54fd6939SJiyong Park 	_DEFINE_SYSREG_READ_FUNC(_name, _name)		\
46*54fd6939SJiyong Park 	_DEFINE_SYSREG_WRITE_FUNC(_name, _name)
47*54fd6939SJiyong Park 
48*54fd6939SJiyong Park /* Define read & write function for renamed system register */
49*54fd6939SJiyong Park #define DEFINE_RENAME_SYSREG_RW_FUNCS(_name, _reg_name)	\
50*54fd6939SJiyong Park 	_DEFINE_SYSREG_READ_FUNC(_name, _reg_name)	\
51*54fd6939SJiyong Park 	_DEFINE_SYSREG_WRITE_FUNC(_name, _reg_name)
52*54fd6939SJiyong Park 
53*54fd6939SJiyong Park /* Define read function for renamed system register */
54*54fd6939SJiyong Park #define DEFINE_RENAME_SYSREG_READ_FUNC(_name, _reg_name)	\
55*54fd6939SJiyong Park 	_DEFINE_SYSREG_READ_FUNC(_name, _reg_name)
56*54fd6939SJiyong Park 
57*54fd6939SJiyong Park /* Define write function for renamed system register */
58*54fd6939SJiyong Park #define DEFINE_RENAME_SYSREG_WRITE_FUNC(_name, _reg_name)	\
59*54fd6939SJiyong Park 	_DEFINE_SYSREG_WRITE_FUNC(_name, _reg_name)
60*54fd6939SJiyong Park 
61*54fd6939SJiyong Park /**********************************************************************
62*54fd6939SJiyong Park  * Macros to create inline functions for system instructions
63*54fd6939SJiyong Park  *********************************************************************/
64*54fd6939SJiyong Park 
65*54fd6939SJiyong Park /* Define function for simple system instruction */
66*54fd6939SJiyong Park #define DEFINE_SYSOP_FUNC(_op)				\
67*54fd6939SJiyong Park static inline void _op(void)				\
68*54fd6939SJiyong Park {							\
69*54fd6939SJiyong Park 	__asm__ (#_op);					\
70*54fd6939SJiyong Park }
71*54fd6939SJiyong Park 
72*54fd6939SJiyong Park /* Define function for system instruction with register parameter */
73*54fd6939SJiyong Park #define DEFINE_SYSOP_PARAM_FUNC(_op)			\
74*54fd6939SJiyong Park static inline void _op(uint64_t v)			\
75*54fd6939SJiyong Park {							\
76*54fd6939SJiyong Park 	 __asm__ (#_op "  %0" : : "r" (v));		\
77*54fd6939SJiyong Park }
78*54fd6939SJiyong Park 
79*54fd6939SJiyong Park /* Define function for system instruction with type specifier */
80*54fd6939SJiyong Park #define DEFINE_SYSOP_TYPE_FUNC(_op, _type)		\
81*54fd6939SJiyong Park static inline void _op ## _type(void)			\
82*54fd6939SJiyong Park {							\
83*54fd6939SJiyong Park 	__asm__ (#_op " " #_type : : : "memory");			\
84*54fd6939SJiyong Park }
85*54fd6939SJiyong Park 
86*54fd6939SJiyong Park /* Define function for system instruction with register parameter */
87*54fd6939SJiyong Park #define DEFINE_SYSOP_TYPE_PARAM_FUNC(_op, _type)	\
88*54fd6939SJiyong Park static inline void _op ## _type(uint64_t v)		\
89*54fd6939SJiyong Park {							\
90*54fd6939SJiyong Park 	 __asm__ (#_op " " #_type ", %0" : : "r" (v));	\
91*54fd6939SJiyong Park }
92*54fd6939SJiyong Park 
93*54fd6939SJiyong Park /*******************************************************************************
94*54fd6939SJiyong Park  * TLB maintenance accessor prototypes
95*54fd6939SJiyong Park  ******************************************************************************/
96*54fd6939SJiyong Park 
97*54fd6939SJiyong Park #if ERRATA_A57_813419 || ERRATA_A76_1286807
98*54fd6939SJiyong Park /*
99*54fd6939SJiyong Park  * Define function for TLBI instruction with type specifier that implements
100*54fd6939SJiyong Park  * the workaround for errata 813419 of Cortex-A57 or errata 1286807 of
101*54fd6939SJiyong Park  * Cortex-A76.
102*54fd6939SJiyong Park  */
103*54fd6939SJiyong Park #define DEFINE_TLBIOP_ERRATA_TYPE_FUNC(_type)\
104*54fd6939SJiyong Park static inline void tlbi ## _type(void)			\
105*54fd6939SJiyong Park {							\
106*54fd6939SJiyong Park 	__asm__("tlbi " #_type "\n"			\
107*54fd6939SJiyong Park 		"dsb ish\n"				\
108*54fd6939SJiyong Park 		"tlbi " #_type);			\
109*54fd6939SJiyong Park }
110*54fd6939SJiyong Park 
111*54fd6939SJiyong Park /*
112*54fd6939SJiyong Park  * Define function for TLBI instruction with register parameter that implements
113*54fd6939SJiyong Park  * the workaround for errata 813419 of Cortex-A57 or errata 1286807 of
114*54fd6939SJiyong Park  * Cortex-A76.
115*54fd6939SJiyong Park  */
116*54fd6939SJiyong Park #define DEFINE_TLBIOP_ERRATA_TYPE_PARAM_FUNC(_type)	\
117*54fd6939SJiyong Park static inline void tlbi ## _type(uint64_t v)			\
118*54fd6939SJiyong Park {								\
119*54fd6939SJiyong Park 	__asm__("tlbi " #_type ", %0\n"				\
120*54fd6939SJiyong Park 		"dsb ish\n"					\
121*54fd6939SJiyong Park 		"tlbi " #_type ", %0" : : "r" (v));		\
122*54fd6939SJiyong Park }
123*54fd6939SJiyong Park #endif /* ERRATA_A57_813419 */
124*54fd6939SJiyong Park 
125*54fd6939SJiyong Park #if ERRATA_A53_819472 || ERRATA_A53_824069 || ERRATA_A53_827319
126*54fd6939SJiyong Park /*
127*54fd6939SJiyong Park  * Define function for DC instruction with register parameter that enables
128*54fd6939SJiyong Park  * the workaround for errata 819472, 824069 and 827319 of Cortex-A53.
129*54fd6939SJiyong Park  */
130*54fd6939SJiyong Park #define DEFINE_DCOP_ERRATA_A53_TYPE_PARAM_FUNC(_name, _type)	\
131*54fd6939SJiyong Park static inline void dc ## _name(uint64_t v)			\
132*54fd6939SJiyong Park {								\
133*54fd6939SJiyong Park 	__asm__("dc " #_type ", %0" : : "r" (v));		\
134*54fd6939SJiyong Park }
135*54fd6939SJiyong Park #endif /* ERRATA_A53_819472 || ERRATA_A53_824069 || ERRATA_A53_827319 */
136*54fd6939SJiyong Park 
137*54fd6939SJiyong Park #if ERRATA_A57_813419
138*54fd6939SJiyong Park DEFINE_SYSOP_TYPE_FUNC(tlbi, alle1)
139*54fd6939SJiyong Park DEFINE_SYSOP_TYPE_FUNC(tlbi, alle1is)
140*54fd6939SJiyong Park DEFINE_SYSOP_TYPE_FUNC(tlbi, alle2)
141*54fd6939SJiyong Park DEFINE_SYSOP_TYPE_FUNC(tlbi, alle2is)
142*54fd6939SJiyong Park DEFINE_TLBIOP_ERRATA_TYPE_FUNC(alle3)
143*54fd6939SJiyong Park DEFINE_TLBIOP_ERRATA_TYPE_FUNC(alle3is)
144*54fd6939SJiyong Park DEFINE_SYSOP_TYPE_FUNC(tlbi, vmalle1)
145*54fd6939SJiyong Park #elif ERRATA_A76_1286807
146*54fd6939SJiyong Park DEFINE_TLBIOP_ERRATA_TYPE_FUNC(alle1)
147*54fd6939SJiyong Park DEFINE_TLBIOP_ERRATA_TYPE_FUNC(alle1is)
148*54fd6939SJiyong Park DEFINE_TLBIOP_ERRATA_TYPE_FUNC(alle2)
149*54fd6939SJiyong Park DEFINE_TLBIOP_ERRATA_TYPE_FUNC(alle2is)
150*54fd6939SJiyong Park DEFINE_TLBIOP_ERRATA_TYPE_FUNC(alle3)
151*54fd6939SJiyong Park DEFINE_TLBIOP_ERRATA_TYPE_FUNC(alle3is)
152*54fd6939SJiyong Park DEFINE_TLBIOP_ERRATA_TYPE_FUNC(vmalle1)
153*54fd6939SJiyong Park #else
154*54fd6939SJiyong Park DEFINE_SYSOP_TYPE_FUNC(tlbi, alle1)
155*54fd6939SJiyong Park DEFINE_SYSOP_TYPE_FUNC(tlbi, alle1is)
156*54fd6939SJiyong Park DEFINE_SYSOP_TYPE_FUNC(tlbi, alle2)
157*54fd6939SJiyong Park DEFINE_SYSOP_TYPE_FUNC(tlbi, alle2is)
158*54fd6939SJiyong Park DEFINE_SYSOP_TYPE_FUNC(tlbi, alle3)
159*54fd6939SJiyong Park DEFINE_SYSOP_TYPE_FUNC(tlbi, alle3is)
160*54fd6939SJiyong Park DEFINE_SYSOP_TYPE_FUNC(tlbi, vmalle1)
161*54fd6939SJiyong Park #endif
162*54fd6939SJiyong Park 
163*54fd6939SJiyong Park #if ERRATA_A57_813419
164*54fd6939SJiyong Park DEFINE_SYSOP_TYPE_PARAM_FUNC(tlbi, vaae1is)
165*54fd6939SJiyong Park DEFINE_SYSOP_TYPE_PARAM_FUNC(tlbi, vaale1is)
166*54fd6939SJiyong Park DEFINE_SYSOP_TYPE_PARAM_FUNC(tlbi, vae2is)
167*54fd6939SJiyong Park DEFINE_SYSOP_TYPE_PARAM_FUNC(tlbi, vale2is)
168*54fd6939SJiyong Park DEFINE_TLBIOP_ERRATA_TYPE_PARAM_FUNC(vae3is)
169*54fd6939SJiyong Park DEFINE_TLBIOP_ERRATA_TYPE_PARAM_FUNC(vale3is)
170*54fd6939SJiyong Park #elif ERRATA_A76_1286807
171*54fd6939SJiyong Park DEFINE_TLBIOP_ERRATA_TYPE_PARAM_FUNC(vaae1is)
172*54fd6939SJiyong Park DEFINE_TLBIOP_ERRATA_TYPE_PARAM_FUNC(vaale1is)
173*54fd6939SJiyong Park DEFINE_TLBIOP_ERRATA_TYPE_PARAM_FUNC(vae2is)
174*54fd6939SJiyong Park DEFINE_TLBIOP_ERRATA_TYPE_PARAM_FUNC(vale2is)
175*54fd6939SJiyong Park DEFINE_TLBIOP_ERRATA_TYPE_PARAM_FUNC(vae3is)
176*54fd6939SJiyong Park DEFINE_TLBIOP_ERRATA_TYPE_PARAM_FUNC(vale3is)
177*54fd6939SJiyong Park #else
178*54fd6939SJiyong Park DEFINE_SYSOP_TYPE_PARAM_FUNC(tlbi, vaae1is)
179*54fd6939SJiyong Park DEFINE_SYSOP_TYPE_PARAM_FUNC(tlbi, vaale1is)
180*54fd6939SJiyong Park DEFINE_SYSOP_TYPE_PARAM_FUNC(tlbi, vae2is)
181*54fd6939SJiyong Park DEFINE_SYSOP_TYPE_PARAM_FUNC(tlbi, vale2is)
182*54fd6939SJiyong Park DEFINE_SYSOP_TYPE_PARAM_FUNC(tlbi, vae3is)
183*54fd6939SJiyong Park DEFINE_SYSOP_TYPE_PARAM_FUNC(tlbi, vale3is)
184*54fd6939SJiyong Park #endif
185*54fd6939SJiyong Park 
186*54fd6939SJiyong Park /*******************************************************************************
187*54fd6939SJiyong Park  * Cache maintenance accessor prototypes
188*54fd6939SJiyong Park  ******************************************************************************/
189*54fd6939SJiyong Park DEFINE_SYSOP_TYPE_PARAM_FUNC(dc, isw)
190*54fd6939SJiyong Park DEFINE_SYSOP_TYPE_PARAM_FUNC(dc, cisw)
191*54fd6939SJiyong Park #if ERRATA_A53_827319
192*54fd6939SJiyong Park DEFINE_DCOP_ERRATA_A53_TYPE_PARAM_FUNC(csw, cisw)
193*54fd6939SJiyong Park #else
194*54fd6939SJiyong Park DEFINE_SYSOP_TYPE_PARAM_FUNC(dc, csw)
195*54fd6939SJiyong Park #endif
196*54fd6939SJiyong Park #if ERRATA_A53_819472 || ERRATA_A53_824069 || ERRATA_A53_827319
197*54fd6939SJiyong Park DEFINE_DCOP_ERRATA_A53_TYPE_PARAM_FUNC(cvac, civac)
198*54fd6939SJiyong Park #else
199*54fd6939SJiyong Park DEFINE_SYSOP_TYPE_PARAM_FUNC(dc, cvac)
200*54fd6939SJiyong Park #endif
201*54fd6939SJiyong Park DEFINE_SYSOP_TYPE_PARAM_FUNC(dc, ivac)
202*54fd6939SJiyong Park DEFINE_SYSOP_TYPE_PARAM_FUNC(dc, civac)
203*54fd6939SJiyong Park #if ERRATA_A53_819472 || ERRATA_A53_824069 || ERRATA_A53_827319
204*54fd6939SJiyong Park DEFINE_DCOP_ERRATA_A53_TYPE_PARAM_FUNC(cvau, civac)
205*54fd6939SJiyong Park #else
206*54fd6939SJiyong Park DEFINE_SYSOP_TYPE_PARAM_FUNC(dc, cvau)
207*54fd6939SJiyong Park #endif
208*54fd6939SJiyong Park DEFINE_SYSOP_TYPE_PARAM_FUNC(dc, zva)
209*54fd6939SJiyong Park 
210*54fd6939SJiyong Park /*******************************************************************************
211*54fd6939SJiyong Park  * Address translation accessor prototypes
212*54fd6939SJiyong Park  ******************************************************************************/
213*54fd6939SJiyong Park DEFINE_SYSOP_TYPE_PARAM_FUNC(at, s12e1r)
214*54fd6939SJiyong Park DEFINE_SYSOP_TYPE_PARAM_FUNC(at, s12e1w)
215*54fd6939SJiyong Park DEFINE_SYSOP_TYPE_PARAM_FUNC(at, s12e0r)
216*54fd6939SJiyong Park DEFINE_SYSOP_TYPE_PARAM_FUNC(at, s12e0w)
217*54fd6939SJiyong Park DEFINE_SYSOP_TYPE_PARAM_FUNC(at, s1e1r)
218*54fd6939SJiyong Park DEFINE_SYSOP_TYPE_PARAM_FUNC(at, s1e2r)
219*54fd6939SJiyong Park DEFINE_SYSOP_TYPE_PARAM_FUNC(at, s1e3r)
220*54fd6939SJiyong Park 
221*54fd6939SJiyong Park /*******************************************************************************
222*54fd6939SJiyong Park  * Strip Pointer Authentication Code
223*54fd6939SJiyong Park  ******************************************************************************/
224*54fd6939SJiyong Park DEFINE_SYSOP_PARAM_FUNC(xpaci)
225*54fd6939SJiyong Park 
226*54fd6939SJiyong Park void flush_dcache_range(uintptr_t addr, size_t size);
227*54fd6939SJiyong Park void clean_dcache_range(uintptr_t addr, size_t size);
228*54fd6939SJiyong Park void inv_dcache_range(uintptr_t addr, size_t size);
229*54fd6939SJiyong Park bool is_dcache_enabled(void);
230*54fd6939SJiyong Park 
231*54fd6939SJiyong Park void dcsw_op_louis(u_register_t op_type);
232*54fd6939SJiyong Park void dcsw_op_all(u_register_t op_type);
233*54fd6939SJiyong Park 
234*54fd6939SJiyong Park void disable_mmu_el1(void);
235*54fd6939SJiyong Park void disable_mmu_el3(void);
236*54fd6939SJiyong Park void disable_mpu_el2(void);
237*54fd6939SJiyong Park void disable_mmu_icache_el1(void);
238*54fd6939SJiyong Park void disable_mmu_icache_el3(void);
239*54fd6939SJiyong Park void disable_mpu_icache_el2(void);
240*54fd6939SJiyong Park 
241*54fd6939SJiyong Park /*******************************************************************************
242*54fd6939SJiyong Park  * Misc. accessor prototypes
243*54fd6939SJiyong Park  ******************************************************************************/
244*54fd6939SJiyong Park 
245*54fd6939SJiyong Park #define write_daifclr(val) SYSREG_WRITE_CONST(daifclr, val)
246*54fd6939SJiyong Park #define write_daifset(val) SYSREG_WRITE_CONST(daifset, val)
247*54fd6939SJiyong Park 
248*54fd6939SJiyong Park DEFINE_SYSREG_RW_FUNCS(par_el1)
DEFINE_SYSREG_READ_FUNC(id_pfr1_el1)249*54fd6939SJiyong Park DEFINE_SYSREG_READ_FUNC(id_pfr1_el1)
250*54fd6939SJiyong Park DEFINE_SYSREG_READ_FUNC(id_aa64isar0_el1)
251*54fd6939SJiyong Park DEFINE_SYSREG_READ_FUNC(id_aa64isar1_el1)
252*54fd6939SJiyong Park DEFINE_SYSREG_READ_FUNC(id_aa64pfr0_el1)
253*54fd6939SJiyong Park DEFINE_SYSREG_READ_FUNC(id_aa64pfr1_el1)
254*54fd6939SJiyong Park DEFINE_SYSREG_READ_FUNC(id_aa64dfr0_el1)
255*54fd6939SJiyong Park DEFINE_SYSREG_READ_FUNC(id_afr0_el1)
256*54fd6939SJiyong Park DEFINE_SYSREG_READ_FUNC(CurrentEl)
257*54fd6939SJiyong Park DEFINE_SYSREG_READ_FUNC(ctr_el0)
258*54fd6939SJiyong Park DEFINE_SYSREG_RW_FUNCS(daif)
259*54fd6939SJiyong Park DEFINE_SYSREG_RW_FUNCS(spsr_el1)
260*54fd6939SJiyong Park DEFINE_SYSREG_RW_FUNCS(spsr_el2)
261*54fd6939SJiyong Park DEFINE_SYSREG_RW_FUNCS(spsr_el3)
262*54fd6939SJiyong Park DEFINE_SYSREG_RW_FUNCS(elr_el1)
263*54fd6939SJiyong Park DEFINE_SYSREG_RW_FUNCS(elr_el2)
264*54fd6939SJiyong Park DEFINE_SYSREG_RW_FUNCS(elr_el3)
265*54fd6939SJiyong Park DEFINE_SYSREG_RW_FUNCS(mdccsr_el0)
266*54fd6939SJiyong Park DEFINE_SYSREG_RW_FUNCS(dbgdtrrx_el0)
267*54fd6939SJiyong Park DEFINE_SYSREG_RW_FUNCS(dbgdtrtx_el0)
268*54fd6939SJiyong Park 
269*54fd6939SJiyong Park DEFINE_SYSOP_FUNC(wfi)
270*54fd6939SJiyong Park DEFINE_SYSOP_FUNC(wfe)
271*54fd6939SJiyong Park DEFINE_SYSOP_FUNC(sev)
272*54fd6939SJiyong Park DEFINE_SYSOP_TYPE_FUNC(dsb, sy)
273*54fd6939SJiyong Park DEFINE_SYSOP_TYPE_FUNC(dmb, sy)
274*54fd6939SJiyong Park DEFINE_SYSOP_TYPE_FUNC(dmb, st)
275*54fd6939SJiyong Park DEFINE_SYSOP_TYPE_FUNC(dmb, ld)
276*54fd6939SJiyong Park DEFINE_SYSOP_TYPE_FUNC(dsb, ish)
277*54fd6939SJiyong Park DEFINE_SYSOP_TYPE_FUNC(dsb, nsh)
278*54fd6939SJiyong Park DEFINE_SYSOP_TYPE_FUNC(dsb, ishst)
279*54fd6939SJiyong Park DEFINE_SYSOP_TYPE_FUNC(dmb, oshld)
280*54fd6939SJiyong Park DEFINE_SYSOP_TYPE_FUNC(dmb, oshst)
281*54fd6939SJiyong Park DEFINE_SYSOP_TYPE_FUNC(dmb, osh)
282*54fd6939SJiyong Park DEFINE_SYSOP_TYPE_FUNC(dmb, nshld)
283*54fd6939SJiyong Park DEFINE_SYSOP_TYPE_FUNC(dmb, nshst)
284*54fd6939SJiyong Park DEFINE_SYSOP_TYPE_FUNC(dmb, nsh)
285*54fd6939SJiyong Park DEFINE_SYSOP_TYPE_FUNC(dmb, ishld)
286*54fd6939SJiyong Park DEFINE_SYSOP_TYPE_FUNC(dmb, ishst)
287*54fd6939SJiyong Park DEFINE_SYSOP_TYPE_FUNC(dmb, ish)
288*54fd6939SJiyong Park DEFINE_SYSOP_FUNC(isb)
289*54fd6939SJiyong Park 
290*54fd6939SJiyong Park static inline void enable_irq(void)
291*54fd6939SJiyong Park {
292*54fd6939SJiyong Park 	/*
293*54fd6939SJiyong Park 	 * The compiler memory barrier will prevent the compiler from
294*54fd6939SJiyong Park 	 * scheduling non-volatile memory access after the write to the
295*54fd6939SJiyong Park 	 * register.
296*54fd6939SJiyong Park 	 *
297*54fd6939SJiyong Park 	 * This could happen if some initialization code issues non-volatile
298*54fd6939SJiyong Park 	 * accesses to an area used by an interrupt handler, in the assumption
299*54fd6939SJiyong Park 	 * that it is safe as the interrupts are disabled at the time it does
300*54fd6939SJiyong Park 	 * that (according to program order). However, non-volatile accesses
301*54fd6939SJiyong Park 	 * are not necessarily in program order relatively with volatile inline
302*54fd6939SJiyong Park 	 * assembly statements (and volatile accesses).
303*54fd6939SJiyong Park 	 */
304*54fd6939SJiyong Park 	COMPILER_BARRIER();
305*54fd6939SJiyong Park 	write_daifclr(DAIF_IRQ_BIT);
306*54fd6939SJiyong Park 	isb();
307*54fd6939SJiyong Park }
308*54fd6939SJiyong Park 
enable_fiq(void)309*54fd6939SJiyong Park static inline void enable_fiq(void)
310*54fd6939SJiyong Park {
311*54fd6939SJiyong Park 	COMPILER_BARRIER();
312*54fd6939SJiyong Park 	write_daifclr(DAIF_FIQ_BIT);
313*54fd6939SJiyong Park 	isb();
314*54fd6939SJiyong Park }
315*54fd6939SJiyong Park 
enable_serror(void)316*54fd6939SJiyong Park static inline void enable_serror(void)
317*54fd6939SJiyong Park {
318*54fd6939SJiyong Park 	COMPILER_BARRIER();
319*54fd6939SJiyong Park 	write_daifclr(DAIF_ABT_BIT);
320*54fd6939SJiyong Park 	isb();
321*54fd6939SJiyong Park }
322*54fd6939SJiyong Park 
enable_debug_exceptions(void)323*54fd6939SJiyong Park static inline void enable_debug_exceptions(void)
324*54fd6939SJiyong Park {
325*54fd6939SJiyong Park 	COMPILER_BARRIER();
326*54fd6939SJiyong Park 	write_daifclr(DAIF_DBG_BIT);
327*54fd6939SJiyong Park 	isb();
328*54fd6939SJiyong Park }
329*54fd6939SJiyong Park 
disable_irq(void)330*54fd6939SJiyong Park static inline void disable_irq(void)
331*54fd6939SJiyong Park {
332*54fd6939SJiyong Park 	COMPILER_BARRIER();
333*54fd6939SJiyong Park 	write_daifset(DAIF_IRQ_BIT);
334*54fd6939SJiyong Park 	isb();
335*54fd6939SJiyong Park }
336*54fd6939SJiyong Park 
disable_fiq(void)337*54fd6939SJiyong Park static inline void disable_fiq(void)
338*54fd6939SJiyong Park {
339*54fd6939SJiyong Park 	COMPILER_BARRIER();
340*54fd6939SJiyong Park 	write_daifset(DAIF_FIQ_BIT);
341*54fd6939SJiyong Park 	isb();
342*54fd6939SJiyong Park }
343*54fd6939SJiyong Park 
disable_serror(void)344*54fd6939SJiyong Park static inline void disable_serror(void)
345*54fd6939SJiyong Park {
346*54fd6939SJiyong Park 	COMPILER_BARRIER();
347*54fd6939SJiyong Park 	write_daifset(DAIF_ABT_BIT);
348*54fd6939SJiyong Park 	isb();
349*54fd6939SJiyong Park }
350*54fd6939SJiyong Park 
disable_debug_exceptions(void)351*54fd6939SJiyong Park static inline void disable_debug_exceptions(void)
352*54fd6939SJiyong Park {
353*54fd6939SJiyong Park 	COMPILER_BARRIER();
354*54fd6939SJiyong Park 	write_daifset(DAIF_DBG_BIT);
355*54fd6939SJiyong Park 	isb();
356*54fd6939SJiyong Park }
357*54fd6939SJiyong Park 
358*54fd6939SJiyong Park void __dead2 smc(uint64_t x0, uint64_t x1, uint64_t x2, uint64_t x3,
359*54fd6939SJiyong Park 		 uint64_t x4, uint64_t x5, uint64_t x6, uint64_t x7);
360*54fd6939SJiyong Park 
361*54fd6939SJiyong Park /*******************************************************************************
362*54fd6939SJiyong Park  * System register accessor prototypes
363*54fd6939SJiyong Park  ******************************************************************************/
364*54fd6939SJiyong Park DEFINE_SYSREG_READ_FUNC(midr_el1)
DEFINE_SYSREG_READ_FUNC(mpidr_el1)365*54fd6939SJiyong Park DEFINE_SYSREG_READ_FUNC(mpidr_el1)
366*54fd6939SJiyong Park DEFINE_SYSREG_READ_FUNC(id_aa64mmfr0_el1)
367*54fd6939SJiyong Park DEFINE_SYSREG_READ_FUNC(id_aa64mmfr1_el1)
368*54fd6939SJiyong Park 
369*54fd6939SJiyong Park DEFINE_SYSREG_RW_FUNCS(scr_el3)
370*54fd6939SJiyong Park DEFINE_SYSREG_RW_FUNCS(hcr_el2)
371*54fd6939SJiyong Park 
372*54fd6939SJiyong Park DEFINE_SYSREG_RW_FUNCS(vbar_el1)
373*54fd6939SJiyong Park DEFINE_SYSREG_RW_FUNCS(vbar_el2)
374*54fd6939SJiyong Park DEFINE_SYSREG_RW_FUNCS(vbar_el3)
375*54fd6939SJiyong Park 
376*54fd6939SJiyong Park DEFINE_SYSREG_RW_FUNCS(sctlr_el1)
377*54fd6939SJiyong Park DEFINE_SYSREG_RW_FUNCS(sctlr_el2)
378*54fd6939SJiyong Park DEFINE_SYSREG_RW_FUNCS(sctlr_el3)
379*54fd6939SJiyong Park 
380*54fd6939SJiyong Park DEFINE_SYSREG_RW_FUNCS(actlr_el1)
381*54fd6939SJiyong Park DEFINE_SYSREG_RW_FUNCS(actlr_el2)
382*54fd6939SJiyong Park DEFINE_SYSREG_RW_FUNCS(actlr_el3)
383*54fd6939SJiyong Park 
384*54fd6939SJiyong Park DEFINE_SYSREG_RW_FUNCS(esr_el1)
385*54fd6939SJiyong Park DEFINE_SYSREG_RW_FUNCS(esr_el2)
386*54fd6939SJiyong Park DEFINE_SYSREG_RW_FUNCS(esr_el3)
387*54fd6939SJiyong Park 
388*54fd6939SJiyong Park DEFINE_SYSREG_RW_FUNCS(afsr0_el1)
389*54fd6939SJiyong Park DEFINE_SYSREG_RW_FUNCS(afsr0_el2)
390*54fd6939SJiyong Park DEFINE_SYSREG_RW_FUNCS(afsr0_el3)
391*54fd6939SJiyong Park 
392*54fd6939SJiyong Park DEFINE_SYSREG_RW_FUNCS(afsr1_el1)
393*54fd6939SJiyong Park DEFINE_SYSREG_RW_FUNCS(afsr1_el2)
394*54fd6939SJiyong Park DEFINE_SYSREG_RW_FUNCS(afsr1_el3)
395*54fd6939SJiyong Park 
396*54fd6939SJiyong Park DEFINE_SYSREG_RW_FUNCS(far_el1)
397*54fd6939SJiyong Park DEFINE_SYSREG_RW_FUNCS(far_el2)
398*54fd6939SJiyong Park DEFINE_SYSREG_RW_FUNCS(far_el3)
399*54fd6939SJiyong Park 
400*54fd6939SJiyong Park DEFINE_SYSREG_RW_FUNCS(mair_el1)
401*54fd6939SJiyong Park DEFINE_SYSREG_RW_FUNCS(mair_el2)
402*54fd6939SJiyong Park DEFINE_SYSREG_RW_FUNCS(mair_el3)
403*54fd6939SJiyong Park 
404*54fd6939SJiyong Park DEFINE_SYSREG_RW_FUNCS(amair_el1)
405*54fd6939SJiyong Park DEFINE_SYSREG_RW_FUNCS(amair_el2)
406*54fd6939SJiyong Park DEFINE_SYSREG_RW_FUNCS(amair_el3)
407*54fd6939SJiyong Park 
408*54fd6939SJiyong Park DEFINE_SYSREG_READ_FUNC(rvbar_el1)
409*54fd6939SJiyong Park DEFINE_SYSREG_READ_FUNC(rvbar_el2)
410*54fd6939SJiyong Park DEFINE_SYSREG_READ_FUNC(rvbar_el3)
411*54fd6939SJiyong Park 
412*54fd6939SJiyong Park DEFINE_SYSREG_RW_FUNCS(rmr_el1)
413*54fd6939SJiyong Park DEFINE_SYSREG_RW_FUNCS(rmr_el2)
414*54fd6939SJiyong Park DEFINE_SYSREG_RW_FUNCS(rmr_el3)
415*54fd6939SJiyong Park 
416*54fd6939SJiyong Park DEFINE_SYSREG_RW_FUNCS(tcr_el1)
417*54fd6939SJiyong Park DEFINE_SYSREG_RW_FUNCS(tcr_el2)
418*54fd6939SJiyong Park DEFINE_SYSREG_RW_FUNCS(tcr_el3)
419*54fd6939SJiyong Park 
420*54fd6939SJiyong Park DEFINE_SYSREG_RW_FUNCS(ttbr0_el1)
421*54fd6939SJiyong Park DEFINE_SYSREG_RW_FUNCS(ttbr0_el2)
422*54fd6939SJiyong Park DEFINE_SYSREG_RW_FUNCS(ttbr0_el3)
423*54fd6939SJiyong Park 
424*54fd6939SJiyong Park DEFINE_SYSREG_RW_FUNCS(ttbr1_el1)
425*54fd6939SJiyong Park 
426*54fd6939SJiyong Park DEFINE_SYSREG_RW_FUNCS(vttbr_el2)
427*54fd6939SJiyong Park 
428*54fd6939SJiyong Park DEFINE_SYSREG_RW_FUNCS(cptr_el2)
429*54fd6939SJiyong Park DEFINE_SYSREG_RW_FUNCS(cptr_el3)
430*54fd6939SJiyong Park 
431*54fd6939SJiyong Park DEFINE_SYSREG_RW_FUNCS(cpacr_el1)
432*54fd6939SJiyong Park DEFINE_SYSREG_RW_FUNCS(cntfrq_el0)
433*54fd6939SJiyong Park DEFINE_SYSREG_RW_FUNCS(cnthp_ctl_el2)
434*54fd6939SJiyong Park DEFINE_SYSREG_RW_FUNCS(cnthp_tval_el2)
435*54fd6939SJiyong Park DEFINE_SYSREG_RW_FUNCS(cnthp_cval_el2)
436*54fd6939SJiyong Park DEFINE_SYSREG_RW_FUNCS(cntps_ctl_el1)
437*54fd6939SJiyong Park DEFINE_SYSREG_RW_FUNCS(cntps_tval_el1)
438*54fd6939SJiyong Park DEFINE_SYSREG_RW_FUNCS(cntps_cval_el1)
439*54fd6939SJiyong Park DEFINE_SYSREG_RW_FUNCS(cntp_ctl_el0)
440*54fd6939SJiyong Park DEFINE_SYSREG_RW_FUNCS(cntp_tval_el0)
441*54fd6939SJiyong Park DEFINE_SYSREG_RW_FUNCS(cntp_cval_el0)
442*54fd6939SJiyong Park DEFINE_SYSREG_READ_FUNC(cntpct_el0)
443*54fd6939SJiyong Park DEFINE_SYSREG_RW_FUNCS(cnthctl_el2)
444*54fd6939SJiyong Park 
445*54fd6939SJiyong Park DEFINE_SYSREG_RW_FUNCS(vtcr_el2)
446*54fd6939SJiyong Park 
447*54fd6939SJiyong Park #define get_cntp_ctl_enable(x)  (((x) >> CNTP_CTL_ENABLE_SHIFT) & \
448*54fd6939SJiyong Park 					CNTP_CTL_ENABLE_MASK)
449*54fd6939SJiyong Park #define get_cntp_ctl_imask(x)   (((x) >> CNTP_CTL_IMASK_SHIFT) & \
450*54fd6939SJiyong Park 					CNTP_CTL_IMASK_MASK)
451*54fd6939SJiyong Park #define get_cntp_ctl_istatus(x) (((x) >> CNTP_CTL_ISTATUS_SHIFT) & \
452*54fd6939SJiyong Park 					CNTP_CTL_ISTATUS_MASK)
453*54fd6939SJiyong Park 
454*54fd6939SJiyong Park #define set_cntp_ctl_enable(x)  ((x) |= (U(1) << CNTP_CTL_ENABLE_SHIFT))
455*54fd6939SJiyong Park #define set_cntp_ctl_imask(x)   ((x) |= (U(1) << CNTP_CTL_IMASK_SHIFT))
456*54fd6939SJiyong Park 
457*54fd6939SJiyong Park #define clr_cntp_ctl_enable(x)  ((x) &= ~(U(1) << CNTP_CTL_ENABLE_SHIFT))
458*54fd6939SJiyong Park #define clr_cntp_ctl_imask(x)   ((x) &= ~(U(1) << CNTP_CTL_IMASK_SHIFT))
459*54fd6939SJiyong Park 
460*54fd6939SJiyong Park DEFINE_SYSREG_RW_FUNCS(tpidr_el3)
461*54fd6939SJiyong Park 
462*54fd6939SJiyong Park DEFINE_SYSREG_RW_FUNCS(cntvoff_el2)
463*54fd6939SJiyong Park 
464*54fd6939SJiyong Park DEFINE_SYSREG_RW_FUNCS(vpidr_el2)
465*54fd6939SJiyong Park DEFINE_SYSREG_RW_FUNCS(vmpidr_el2)
466*54fd6939SJiyong Park 
467*54fd6939SJiyong Park DEFINE_SYSREG_READ_FUNC(isr_el1)
468*54fd6939SJiyong Park 
469*54fd6939SJiyong Park DEFINE_SYSREG_RW_FUNCS(mdcr_el2)
470*54fd6939SJiyong Park DEFINE_SYSREG_RW_FUNCS(mdcr_el3)
471*54fd6939SJiyong Park DEFINE_SYSREG_RW_FUNCS(hstr_el2)
472*54fd6939SJiyong Park DEFINE_SYSREG_RW_FUNCS(pmcr_el0)
473*54fd6939SJiyong Park 
474*54fd6939SJiyong Park /* GICv3 System Registers */
475*54fd6939SJiyong Park 
476*54fd6939SJiyong Park DEFINE_RENAME_SYSREG_RW_FUNCS(icc_sre_el1, ICC_SRE_EL1)
477*54fd6939SJiyong Park DEFINE_RENAME_SYSREG_RW_FUNCS(icc_sre_el2, ICC_SRE_EL2)
478*54fd6939SJiyong Park DEFINE_RENAME_SYSREG_RW_FUNCS(icc_sre_el3, ICC_SRE_EL3)
479*54fd6939SJiyong Park DEFINE_RENAME_SYSREG_RW_FUNCS(icc_pmr_el1, ICC_PMR_EL1)
480*54fd6939SJiyong Park DEFINE_RENAME_SYSREG_READ_FUNC(icc_rpr_el1, ICC_RPR_EL1)
481*54fd6939SJiyong Park DEFINE_RENAME_SYSREG_RW_FUNCS(icc_igrpen1_el3, ICC_IGRPEN1_EL3)
482*54fd6939SJiyong Park DEFINE_RENAME_SYSREG_RW_FUNCS(icc_igrpen1_el1, ICC_IGRPEN1_EL1)
483*54fd6939SJiyong Park DEFINE_RENAME_SYSREG_RW_FUNCS(icc_igrpen0_el1, ICC_IGRPEN0_EL1)
484*54fd6939SJiyong Park DEFINE_RENAME_SYSREG_READ_FUNC(icc_hppir0_el1, ICC_HPPIR0_EL1)
485*54fd6939SJiyong Park DEFINE_RENAME_SYSREG_READ_FUNC(icc_hppir1_el1, ICC_HPPIR1_EL1)
486*54fd6939SJiyong Park DEFINE_RENAME_SYSREG_READ_FUNC(icc_iar0_el1, ICC_IAR0_EL1)
487*54fd6939SJiyong Park DEFINE_RENAME_SYSREG_READ_FUNC(icc_iar1_el1, ICC_IAR1_EL1)
488*54fd6939SJiyong Park DEFINE_RENAME_SYSREG_WRITE_FUNC(icc_eoir0_el1, ICC_EOIR0_EL1)
489*54fd6939SJiyong Park DEFINE_RENAME_SYSREG_WRITE_FUNC(icc_eoir1_el1, ICC_EOIR1_EL1)
490*54fd6939SJiyong Park DEFINE_RENAME_SYSREG_WRITE_FUNC(icc_sgi0r_el1, ICC_SGI0R_EL1)
491*54fd6939SJiyong Park DEFINE_RENAME_SYSREG_RW_FUNCS(icc_sgi1r, ICC_SGI1R)
492*54fd6939SJiyong Park 
493*54fd6939SJiyong Park DEFINE_RENAME_SYSREG_READ_FUNC(amcfgr_el0, AMCFGR_EL0)
494*54fd6939SJiyong Park DEFINE_RENAME_SYSREG_READ_FUNC(amcgcr_el0, AMCGCR_EL0)
495*54fd6939SJiyong Park DEFINE_RENAME_SYSREG_READ_FUNC(amcg1idr_el0, AMCG1IDR_EL0)
496*54fd6939SJiyong Park DEFINE_RENAME_SYSREG_RW_FUNCS(amcr_el0, AMCR_EL0)
497*54fd6939SJiyong Park DEFINE_RENAME_SYSREG_RW_FUNCS(amcntenclr0_el0, AMCNTENCLR0_EL0)
498*54fd6939SJiyong Park DEFINE_RENAME_SYSREG_RW_FUNCS(amcntenset0_el0, AMCNTENSET0_EL0)
499*54fd6939SJiyong Park DEFINE_RENAME_SYSREG_RW_FUNCS(amcntenclr1_el0, AMCNTENCLR1_EL0)
500*54fd6939SJiyong Park DEFINE_RENAME_SYSREG_RW_FUNCS(amcntenset1_el0, AMCNTENSET1_EL0)
501*54fd6939SJiyong Park 
502*54fd6939SJiyong Park DEFINE_RENAME_SYSREG_READ_FUNC(mpamidr_el1, MPAMIDR_EL1)
503*54fd6939SJiyong Park DEFINE_RENAME_SYSREG_RW_FUNCS(mpam3_el3, MPAM3_EL3)
504*54fd6939SJiyong Park DEFINE_RENAME_SYSREG_RW_FUNCS(mpam2_el2, MPAM2_EL2)
505*54fd6939SJiyong Park DEFINE_RENAME_SYSREG_RW_FUNCS(mpamhcr_el2, MPAMHCR_EL2)
506*54fd6939SJiyong Park 
507*54fd6939SJiyong Park DEFINE_RENAME_SYSREG_RW_FUNCS(pmblimitr_el1, PMBLIMITR_EL1)
508*54fd6939SJiyong Park 
509*54fd6939SJiyong Park DEFINE_RENAME_SYSREG_WRITE_FUNC(zcr_el3, ZCR_EL3)
510*54fd6939SJiyong Park DEFINE_RENAME_SYSREG_WRITE_FUNC(zcr_el2, ZCR_EL2)
511*54fd6939SJiyong Park 
512*54fd6939SJiyong Park DEFINE_RENAME_SYSREG_READ_FUNC(id_aa64smfr0_el1, ID_AA64SMFR0_EL1)
513*54fd6939SJiyong Park DEFINE_RENAME_SYSREG_RW_FUNCS(smcr_el3, SMCR_EL3)
514*54fd6939SJiyong Park 
515*54fd6939SJiyong Park DEFINE_RENAME_SYSREG_READ_FUNC(erridr_el1, ERRIDR_EL1)
516*54fd6939SJiyong Park DEFINE_RENAME_SYSREG_WRITE_FUNC(errselr_el1, ERRSELR_EL1)
517*54fd6939SJiyong Park 
518*54fd6939SJiyong Park DEFINE_RENAME_SYSREG_READ_FUNC(erxfr_el1, ERXFR_EL1)
519*54fd6939SJiyong Park DEFINE_RENAME_SYSREG_RW_FUNCS(erxctlr_el1, ERXCTLR_EL1)
520*54fd6939SJiyong Park DEFINE_RENAME_SYSREG_RW_FUNCS(erxstatus_el1, ERXSTATUS_EL1)
521*54fd6939SJiyong Park DEFINE_RENAME_SYSREG_READ_FUNC(erxaddr_el1, ERXADDR_EL1)
522*54fd6939SJiyong Park DEFINE_RENAME_SYSREG_READ_FUNC(erxmisc0_el1, ERXMISC0_EL1)
523*54fd6939SJiyong Park DEFINE_RENAME_SYSREG_READ_FUNC(erxmisc1_el1, ERXMISC1_EL1)
524*54fd6939SJiyong Park 
525*54fd6939SJiyong Park /* Armv8.2 Registers */
526*54fd6939SJiyong Park DEFINE_RENAME_SYSREG_READ_FUNC(id_aa64mmfr2_el1, ID_AA64MMFR2_EL1)
527*54fd6939SJiyong Park 
528*54fd6939SJiyong Park /* Armv8.3 Pointer Authentication Registers */
529*54fd6939SJiyong Park DEFINE_RENAME_SYSREG_RW_FUNCS(apiakeyhi_el1, APIAKeyHi_EL1)
530*54fd6939SJiyong Park DEFINE_RENAME_SYSREG_RW_FUNCS(apiakeylo_el1, APIAKeyLo_EL1)
531*54fd6939SJiyong Park 
532*54fd6939SJiyong Park /* Armv8.5 MTE Registers */
533*54fd6939SJiyong Park DEFINE_RENAME_SYSREG_RW_FUNCS(tfsre0_el1, TFSRE0_EL1)
534*54fd6939SJiyong Park DEFINE_RENAME_SYSREG_RW_FUNCS(tfsr_el1, TFSR_EL1)
535*54fd6939SJiyong Park DEFINE_RENAME_SYSREG_RW_FUNCS(rgsr_el1, RGSR_EL1)
536*54fd6939SJiyong Park DEFINE_RENAME_SYSREG_RW_FUNCS(gcr_el1, GCR_EL1)
537*54fd6939SJiyong Park 
538*54fd6939SJiyong Park /* Armv8.5 FEAT_RNG Registers */
539*54fd6939SJiyong Park DEFINE_SYSREG_READ_FUNC(rndr)
540*54fd6939SJiyong Park DEFINE_SYSREG_READ_FUNC(rndrrs)
541*54fd6939SJiyong Park 
542*54fd6939SJiyong Park /* FEAT_HCX Register */
543*54fd6939SJiyong Park DEFINE_RENAME_SYSREG_RW_FUNCS(hcrx_el2, HCRX_EL2)
544*54fd6939SJiyong Park 
545*54fd6939SJiyong Park /* DynamIQ Shared Unit power management */
546*54fd6939SJiyong Park DEFINE_RENAME_SYSREG_RW_FUNCS(clusterpwrdn_el1, CLUSTERPWRDN_EL1)
547*54fd6939SJiyong Park 
548*54fd6939SJiyong Park /* CPU Power/Performance Management registers */
549*54fd6939SJiyong Park DEFINE_RENAME_SYSREG_RW_FUNCS(cpuppmcr_el3, CPUPPMCR_EL3)
550*54fd6939SJiyong Park DEFINE_RENAME_SYSREG_RW_FUNCS(cpumpmmcr_el3, CPUMPMMCR_EL3)
551*54fd6939SJiyong Park 
552*54fd6939SJiyong Park /* Armv9.2 RME Registers */
553*54fd6939SJiyong Park DEFINE_RENAME_SYSREG_RW_FUNCS(gptbr_el3, GPTBR_EL3)
554*54fd6939SJiyong Park DEFINE_RENAME_SYSREG_RW_FUNCS(gpccr_el3, GPCCR_EL3)
555*54fd6939SJiyong Park 
556*54fd6939SJiyong Park #define IS_IN_EL(x) \
557*54fd6939SJiyong Park 	(GET_EL(read_CurrentEl()) == MODE_EL##x)
558*54fd6939SJiyong Park 
559*54fd6939SJiyong Park #define IS_IN_EL1() IS_IN_EL(1)
560*54fd6939SJiyong Park #define IS_IN_EL2() IS_IN_EL(2)
561*54fd6939SJiyong Park #define IS_IN_EL3() IS_IN_EL(3)
562*54fd6939SJiyong Park 
563*54fd6939SJiyong Park static inline unsigned int get_current_el(void)
564*54fd6939SJiyong Park {
565*54fd6939SJiyong Park 	return GET_EL(read_CurrentEl());
566*54fd6939SJiyong Park }
567*54fd6939SJiyong Park 
get_current_el_maybe_constant(void)568*54fd6939SJiyong Park static inline unsigned int get_current_el_maybe_constant(void)
569*54fd6939SJiyong Park {
570*54fd6939SJiyong Park #if defined(IMAGE_AT_EL1)
571*54fd6939SJiyong Park 	return 1;
572*54fd6939SJiyong Park #elif defined(IMAGE_AT_EL2)
573*54fd6939SJiyong Park 	return 2;	/* no use-case in TF-A */
574*54fd6939SJiyong Park #elif defined(IMAGE_AT_EL3)
575*54fd6939SJiyong Park 	return 3;
576*54fd6939SJiyong Park #else
577*54fd6939SJiyong Park 	/*
578*54fd6939SJiyong Park 	 * If we do not know which exception level this is being built for
579*54fd6939SJiyong Park 	 * (e.g. built for library), fall back to run-time detection.
580*54fd6939SJiyong Park 	 */
581*54fd6939SJiyong Park 	return get_current_el();
582*54fd6939SJiyong Park #endif
583*54fd6939SJiyong Park }
584*54fd6939SJiyong Park 
585*54fd6939SJiyong Park /*
586*54fd6939SJiyong Park  * Check if an EL is implemented from AA64PFR0 register fields.
587*54fd6939SJiyong Park  */
el_implemented(unsigned int el)588*54fd6939SJiyong Park static inline uint64_t el_implemented(unsigned int el)
589*54fd6939SJiyong Park {
590*54fd6939SJiyong Park 	if (el > 3U) {
591*54fd6939SJiyong Park 		return EL_IMPL_NONE;
592*54fd6939SJiyong Park 	} else {
593*54fd6939SJiyong Park 		unsigned int shift = ID_AA64PFR0_EL1_SHIFT * el;
594*54fd6939SJiyong Park 
595*54fd6939SJiyong Park 		return (read_id_aa64pfr0_el1() >> shift) & ID_AA64PFR0_ELX_MASK;
596*54fd6939SJiyong Park 	}
597*54fd6939SJiyong Park }
598*54fd6939SJiyong Park 
599*54fd6939SJiyong Park /*
600*54fd6939SJiyong Park  * TLBIPAALLOS instruction
601*54fd6939SJiyong Park  * (TLB Inivalidate GPT Information by PA,
602*54fd6939SJiyong Park  * All Entries, Outer Shareable)
603*54fd6939SJiyong Park  */
tlbipaallos(void)604*54fd6939SJiyong Park static inline void tlbipaallos(void)
605*54fd6939SJiyong Park {
606*54fd6939SJiyong Park 	__asm__("SYS #6,c8,c1,#4");
607*54fd6939SJiyong Park }
608*54fd6939SJiyong Park 
609*54fd6939SJiyong Park /*
610*54fd6939SJiyong Park  * Invalidate cached copies of GPT entries
611*54fd6939SJiyong Park  * from TLBs by physical address
612*54fd6939SJiyong Park  *
613*54fd6939SJiyong Park  * @pa: the starting address for the range
614*54fd6939SJiyong Park  *      of invalidation
615*54fd6939SJiyong Park  * @size: size of the range of invalidation
616*54fd6939SJiyong Park  */
617*54fd6939SJiyong Park void gpt_tlbi_by_pa(uint64_t pa, size_t size);
618*54fd6939SJiyong Park 
619*54fd6939SJiyong Park 
620*54fd6939SJiyong Park /* Previously defined accessor functions with incomplete register names  */
621*54fd6939SJiyong Park 
622*54fd6939SJiyong Park #define read_current_el()	read_CurrentEl()
623*54fd6939SJiyong Park 
624*54fd6939SJiyong Park #define dsb()			dsbsy()
625*54fd6939SJiyong Park 
626*54fd6939SJiyong Park #define read_midr()		read_midr_el1()
627*54fd6939SJiyong Park 
628*54fd6939SJiyong Park #define read_mpidr()		read_mpidr_el1()
629*54fd6939SJiyong Park 
630*54fd6939SJiyong Park #define read_scr()		read_scr_el3()
631*54fd6939SJiyong Park #define write_scr(_v)		write_scr_el3(_v)
632*54fd6939SJiyong Park 
633*54fd6939SJiyong Park #define read_hcr()		read_hcr_el2()
634*54fd6939SJiyong Park #define write_hcr(_v)		write_hcr_el2(_v)
635*54fd6939SJiyong Park 
636*54fd6939SJiyong Park #define read_cpacr()		read_cpacr_el1()
637*54fd6939SJiyong Park #define write_cpacr(_v)		write_cpacr_el1(_v)
638*54fd6939SJiyong Park 
639*54fd6939SJiyong Park #define read_clusterpwrdn()	read_clusterpwrdn_el1()
640*54fd6939SJiyong Park #define write_clusterpwrdn(_v)	write_clusterpwrdn_el1(_v)
641*54fd6939SJiyong Park 
642*54fd6939SJiyong Park #if ERRATA_SPECULATIVE_AT
643*54fd6939SJiyong Park /*
644*54fd6939SJiyong Park  * Assuming SCTLR.M bit is already enabled
645*54fd6939SJiyong Park  * 1. Enable page table walk by clearing TCR_EL1.EPDx bits
646*54fd6939SJiyong Park  * 2. Execute AT instruction for lower EL1/0
647*54fd6939SJiyong Park  * 3. Disable page table walk by setting TCR_EL1.EPDx bits
648*54fd6939SJiyong Park  */
649*54fd6939SJiyong Park #define AT(_at_inst, _va)	\
650*54fd6939SJiyong Park {	\
651*54fd6939SJiyong Park 	assert((read_sctlr_el1() & SCTLR_M_BIT) != 0ULL);	\
652*54fd6939SJiyong Park 	write_tcr_el1(read_tcr_el1() & ~(TCR_EPD0_BIT | TCR_EPD1_BIT));	\
653*54fd6939SJiyong Park 	isb();	\
654*54fd6939SJiyong Park 	_at_inst(_va);	\
655*54fd6939SJiyong Park 	write_tcr_el1(read_tcr_el1() | (TCR_EPD0_BIT | TCR_EPD1_BIT));	\
656*54fd6939SJiyong Park 	isb();	\
657*54fd6939SJiyong Park }
658*54fd6939SJiyong Park #else
659*54fd6939SJiyong Park #define AT(_at_inst, _va)	_at_inst(_va);
660*54fd6939SJiyong Park #endif
661*54fd6939SJiyong Park 
662*54fd6939SJiyong Park #endif /* ARCH_HELPERS_H */
663