blob: b6d924b54327aafd4873aa4864e5d9ddf637045e [file] [log] [blame]
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +02001/*
Manish V Badarkhe589a1122021-12-31 15:20:08 +00002 * Copyright (c) 2013-2022, Arm Limited and Contributors. All rights reserved.
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +02003 *
4 * SPDX-License-Identifier: BSD-3-Clause
5 */
6
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +00007#ifndef ARCH_HELPERS_H
8#define ARCH_HELPERS_H
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +02009
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +000010#include <arch.h>
11#include <cdefs.h>
12#include <stdbool.h>
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +020013#include <stdint.h>
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +000014#include <string.h>
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +020015
16/**********************************************************************
17 * Macros which create inline functions to read or write CPU system
18 * registers
19 *********************************************************************/
20
21#define _DEFINE_SYSREG_READ_FUNC(_name, _reg_name) \
22static inline u_register_t read_ ## _name(void) \
23{ \
24 u_register_t v; \
25 __asm__ volatile ("mrs %0, " #_reg_name : "=r" (v)); \
26 return v; \
27}
28
29#define _DEFINE_SYSREG_WRITE_FUNC(_name, _reg_name) \
30static inline void write_ ## _name(u_register_t v) \
31{ \
32 __asm__ volatile ("msr " #_reg_name ", %0" : : "r" (v)); \
33}
34
35#define SYSREG_WRITE_CONST(reg_name, v) \
36 __asm__ volatile ("msr " #reg_name ", %0" : : "i" (v))
37
38/* Define read function for system register */
39#define DEFINE_SYSREG_READ_FUNC(_name) \
40 _DEFINE_SYSREG_READ_FUNC(_name, _name)
41
42/* Define read & write function for system register */
43#define DEFINE_SYSREG_RW_FUNCS(_name) \
44 _DEFINE_SYSREG_READ_FUNC(_name, _name) \
45 _DEFINE_SYSREG_WRITE_FUNC(_name, _name)
46
47/* Define read & write function for renamed system register */
48#define DEFINE_RENAME_SYSREG_RW_FUNCS(_name, _reg_name) \
49 _DEFINE_SYSREG_READ_FUNC(_name, _reg_name) \
50 _DEFINE_SYSREG_WRITE_FUNC(_name, _reg_name)
51
52/* Define read function for renamed system register */
53#define DEFINE_RENAME_SYSREG_READ_FUNC(_name, _reg_name) \
54 _DEFINE_SYSREG_READ_FUNC(_name, _reg_name)
55
56/* Define write function for renamed system register */
57#define DEFINE_RENAME_SYSREG_WRITE_FUNC(_name, _reg_name) \
58 _DEFINE_SYSREG_WRITE_FUNC(_name, _reg_name)
59
60/**********************************************************************
61 * Macros to create inline functions for system instructions
62 *********************************************************************/
63
64/* Define function for simple system instruction */
65#define DEFINE_SYSOP_FUNC(_op) \
66static inline void _op(void) \
67{ \
68 __asm__ (#_op); \
69}
70
71/* Define function for system instruction with type specifier */
72#define DEFINE_SYSOP_TYPE_FUNC(_op, _type) \
73static inline void _op ## _type(void) \
74{ \
75 __asm__ (#_op " " #_type); \
76}
77
78/* Define function for system instruction with register parameter */
79#define DEFINE_SYSOP_TYPE_PARAM_FUNC(_op, _type) \
80static inline void _op ## _type(uint64_t v) \
81{ \
82 __asm__ (#_op " " #_type ", %0" : : "r" (v)); \
83}
84
85/*******************************************************************************
86 * TLB maintenance accessor prototypes
87 ******************************************************************************/
88
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +000089#if ERRATA_A57_813419
90/*
91 * Define function for TLBI instruction with type specifier that implements
92 * the workaround for errata 813419 of Cortex-A57.
93 */
94#define DEFINE_TLBIOP_ERRATA_A57_813419_TYPE_FUNC(_type)\
95static inline void tlbi ## _type(void) \
96{ \
97 __asm__("tlbi " #_type "\n" \
98 "dsb ish\n" \
99 "tlbi " #_type); \
100}
101
102/*
103 * Define function for TLBI instruction with register parameter that implements
104 * the workaround for errata 813419 of Cortex-A57.
105 */
106#define DEFINE_TLBIOP_ERRATA_A57_813419_TYPE_PARAM_FUNC(_type) \
107static inline void tlbi ## _type(uint64_t v) \
108{ \
109 __asm__("tlbi " #_type ", %0\n" \
110 "dsb ish\n" \
111 "tlbi " #_type ", %0" : : "r" (v)); \
112}
113#endif /* ERRATA_A57_813419 */
114
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200115DEFINE_SYSOP_TYPE_FUNC(tlbi, alle1)
116DEFINE_SYSOP_TYPE_FUNC(tlbi, alle1is)
117DEFINE_SYSOP_TYPE_FUNC(tlbi, alle2)
118DEFINE_SYSOP_TYPE_FUNC(tlbi, alle2is)
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000119#if ERRATA_A57_813419
120DEFINE_TLBIOP_ERRATA_A57_813419_TYPE_FUNC(alle3)
121DEFINE_TLBIOP_ERRATA_A57_813419_TYPE_FUNC(alle3is)
122#else
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200123DEFINE_SYSOP_TYPE_FUNC(tlbi, alle3)
124DEFINE_SYSOP_TYPE_FUNC(tlbi, alle3is)
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000125#endif
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200126DEFINE_SYSOP_TYPE_FUNC(tlbi, vmalle1)
127
128DEFINE_SYSOP_TYPE_PARAM_FUNC(tlbi, vaae1is)
129DEFINE_SYSOP_TYPE_PARAM_FUNC(tlbi, vaale1is)
130DEFINE_SYSOP_TYPE_PARAM_FUNC(tlbi, vae2is)
131DEFINE_SYSOP_TYPE_PARAM_FUNC(tlbi, vale2is)
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000132#if ERRATA_A57_813419
133DEFINE_TLBIOP_ERRATA_A57_813419_TYPE_PARAM_FUNC(vae3is)
134DEFINE_TLBIOP_ERRATA_A57_813419_TYPE_PARAM_FUNC(vale3is)
135#else
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200136DEFINE_SYSOP_TYPE_PARAM_FUNC(tlbi, vae3is)
137DEFINE_SYSOP_TYPE_PARAM_FUNC(tlbi, vale3is)
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000138#endif
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200139
140/*******************************************************************************
141 * Cache maintenance accessor prototypes
142 ******************************************************************************/
143DEFINE_SYSOP_TYPE_PARAM_FUNC(dc, isw)
144DEFINE_SYSOP_TYPE_PARAM_FUNC(dc, cisw)
145DEFINE_SYSOP_TYPE_PARAM_FUNC(dc, csw)
146DEFINE_SYSOP_TYPE_PARAM_FUNC(dc, cvac)
147DEFINE_SYSOP_TYPE_PARAM_FUNC(dc, ivac)
148DEFINE_SYSOP_TYPE_PARAM_FUNC(dc, civac)
149DEFINE_SYSOP_TYPE_PARAM_FUNC(dc, cvau)
150DEFINE_SYSOP_TYPE_PARAM_FUNC(dc, zva)
151
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000152/*******************************************************************************
153 * Address translation accessor prototypes
154 ******************************************************************************/
155DEFINE_SYSOP_TYPE_PARAM_FUNC(at, s12e1r)
156DEFINE_SYSOP_TYPE_PARAM_FUNC(at, s12e1w)
157DEFINE_SYSOP_TYPE_PARAM_FUNC(at, s12e0r)
158DEFINE_SYSOP_TYPE_PARAM_FUNC(at, s12e0w)
159DEFINE_SYSOP_TYPE_PARAM_FUNC(at, s1e1r)
160DEFINE_SYSOP_TYPE_PARAM_FUNC(at, s1e2r)
161DEFINE_SYSOP_TYPE_PARAM_FUNC(at, s1e3r)
162
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200163void flush_dcache_range(uintptr_t addr, size_t size);
164void clean_dcache_range(uintptr_t addr, size_t size);
165void inv_dcache_range(uintptr_t addr, size_t size);
166
167void dcsw_op_louis(u_register_t op_type);
168void dcsw_op_all(u_register_t op_type);
169
170void disable_mmu(void);
171void disable_mmu_icache(void);
172
173/*******************************************************************************
174 * Misc. accessor prototypes
175 ******************************************************************************/
176
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000177#define write_daifclr(val) SYSREG_WRITE_CONST(daifclr, val)
178#define write_daifset(val) SYSREG_WRITE_CONST(daifset, val)
179
180DEFINE_SYSREG_RW_FUNCS(par_el1)
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200181DEFINE_SYSREG_READ_FUNC(id_pfr1_el1)
Jeenu Viswambharana1c3cca2018-10-16 10:09:32 +0100182DEFINE_SYSREG_READ_FUNC(id_aa64isar1_el1)
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200183DEFINE_SYSREG_READ_FUNC(id_aa64pfr0_el1)
Antonio Nino Diazcc023992019-04-04 11:18:32 +0100184DEFINE_SYSREG_READ_FUNC(id_aa64pfr1_el1)
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000185DEFINE_SYSREG_READ_FUNC(id_aa64dfr0_el1)
Antonio Nino Diazffdfd162019-02-11 15:34:32 +0000186DEFINE_SYSREG_READ_FUNC(id_afr0_el1)
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200187DEFINE_SYSREG_READ_FUNC(CurrentEl)
188DEFINE_SYSREG_READ_FUNC(ctr_el0)
189DEFINE_SYSREG_RW_FUNCS(daif)
Daniel Boulby39e4df22021-02-02 19:27:41 +0000190DEFINE_SYSREG_RW_FUNCS(nzcv)
191DEFINE_SYSREG_READ_FUNC(spsel)
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200192DEFINE_SYSREG_RW_FUNCS(spsr_el1)
193DEFINE_SYSREG_RW_FUNCS(spsr_el2)
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000194DEFINE_SYSREG_RW_FUNCS(spsr_el3)
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200195DEFINE_SYSREG_RW_FUNCS(elr_el1)
196DEFINE_SYSREG_RW_FUNCS(elr_el2)
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000197DEFINE_SYSREG_RW_FUNCS(elr_el3)
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200198
199DEFINE_SYSOP_FUNC(wfi)
200DEFINE_SYSOP_FUNC(wfe)
201DEFINE_SYSOP_FUNC(sev)
202DEFINE_SYSOP_TYPE_FUNC(dsb, sy)
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000203DEFINE_SYSOP_TYPE_FUNC(dmb, sy)
204DEFINE_SYSOP_TYPE_FUNC(dmb, st)
205DEFINE_SYSOP_TYPE_FUNC(dmb, ld)
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200206DEFINE_SYSOP_TYPE_FUNC(dsb, ish)
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000207DEFINE_SYSOP_TYPE_FUNC(dsb, nsh)
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200208DEFINE_SYSOP_TYPE_FUNC(dsb, ishst)
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200209DEFINE_SYSOP_TYPE_FUNC(dmb, oshld)
210DEFINE_SYSOP_TYPE_FUNC(dmb, oshst)
211DEFINE_SYSOP_TYPE_FUNC(dmb, osh)
212DEFINE_SYSOP_TYPE_FUNC(dmb, nshld)
213DEFINE_SYSOP_TYPE_FUNC(dmb, nshst)
214DEFINE_SYSOP_TYPE_FUNC(dmb, nsh)
215DEFINE_SYSOP_TYPE_FUNC(dmb, ishld)
216DEFINE_SYSOP_TYPE_FUNC(dmb, ishst)
217DEFINE_SYSOP_TYPE_FUNC(dmb, ish)
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000218DEFINE_SYSOP_FUNC(isb)
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200219
220static inline void enable_irq(void)
221{
222 /*
223 * The compiler memory barrier will prevent the compiler from
224 * scheduling non-volatile memory access after the write to the
225 * register.
226 *
227 * This could happen if some initialization code issues non-volatile
228 * accesses to an area used by an interrupt handler, in the assumption
229 * that it is safe as the interrupts are disabled at the time it does
230 * that (according to program order). However, non-volatile accesses
231 * are not necessarily in program order relatively with volatile inline
232 * assembly statements (and volatile accesses).
233 */
234 COMPILER_BARRIER();
235 write_daifclr(DAIF_IRQ_BIT);
236 isb();
237}
238
239static inline void enable_fiq(void)
240{
241 COMPILER_BARRIER();
242 write_daifclr(DAIF_FIQ_BIT);
243 isb();
244}
245
246static inline void enable_serror(void)
247{
248 COMPILER_BARRIER();
249 write_daifclr(DAIF_ABT_BIT);
250 isb();
251}
252
253static inline void enable_debug_exceptions(void)
254{
255 COMPILER_BARRIER();
256 write_daifclr(DAIF_DBG_BIT);
257 isb();
258}
259
260static inline void disable_irq(void)
261{
262 COMPILER_BARRIER();
263 write_daifset(DAIF_IRQ_BIT);
264 isb();
265}
266
267static inline void disable_fiq(void)
268{
269 COMPILER_BARRIER();
270 write_daifset(DAIF_FIQ_BIT);
271 isb();
272}
273
274static inline void disable_serror(void)
275{
276 COMPILER_BARRIER();
277 write_daifset(DAIF_ABT_BIT);
278 isb();
279}
280
281static inline void disable_debug_exceptions(void)
282{
283 COMPILER_BARRIER();
284 write_daifset(DAIF_DBG_BIT);
285 isb();
286}
287
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200288void __dead2 smc(uint64_t x0, uint64_t x1, uint64_t x2, uint64_t x3,
289 uint64_t x4, uint64_t x5, uint64_t x6, uint64_t x7);
290
291/*******************************************************************************
292 * System register accessor prototypes
293 ******************************************************************************/
294DEFINE_SYSREG_READ_FUNC(midr_el1)
295DEFINE_SYSREG_READ_FUNC(mpidr_el1)
296DEFINE_SYSREG_READ_FUNC(id_aa64mmfr0_el1)
Daniel Boulby39e4df22021-02-02 19:27:41 +0000297DEFINE_SYSREG_READ_FUNC(id_aa64mmfr1_el1)
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200298
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000299DEFINE_SYSREG_RW_FUNCS(scr_el3)
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200300DEFINE_SYSREG_RW_FUNCS(hcr_el2)
301
302DEFINE_SYSREG_RW_FUNCS(vbar_el1)
303DEFINE_SYSREG_RW_FUNCS(vbar_el2)
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000304DEFINE_SYSREG_RW_FUNCS(vbar_el3)
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200305
306DEFINE_SYSREG_RW_FUNCS(sctlr_el1)
307DEFINE_SYSREG_RW_FUNCS(sctlr_el2)
308DEFINE_SYSREG_RW_FUNCS(sctlr_el3)
309
310DEFINE_SYSREG_RW_FUNCS(actlr_el1)
311DEFINE_SYSREG_RW_FUNCS(actlr_el2)
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000312DEFINE_SYSREG_RW_FUNCS(actlr_el3)
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200313
314DEFINE_SYSREG_RW_FUNCS(esr_el1)
315DEFINE_SYSREG_RW_FUNCS(esr_el2)
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000316DEFINE_SYSREG_RW_FUNCS(esr_el3)
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200317
318DEFINE_SYSREG_RW_FUNCS(afsr0_el1)
319DEFINE_SYSREG_RW_FUNCS(afsr0_el2)
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000320DEFINE_SYSREG_RW_FUNCS(afsr0_el3)
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200321
322DEFINE_SYSREG_RW_FUNCS(afsr1_el1)
323DEFINE_SYSREG_RW_FUNCS(afsr1_el2)
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000324DEFINE_SYSREG_RW_FUNCS(afsr1_el3)
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200325
326DEFINE_SYSREG_RW_FUNCS(far_el1)
327DEFINE_SYSREG_RW_FUNCS(far_el2)
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000328DEFINE_SYSREG_RW_FUNCS(far_el3)
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200329
330DEFINE_SYSREG_RW_FUNCS(mair_el1)
331DEFINE_SYSREG_RW_FUNCS(mair_el2)
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000332DEFINE_SYSREG_RW_FUNCS(mair_el3)
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200333
334DEFINE_SYSREG_RW_FUNCS(amair_el1)
335DEFINE_SYSREG_RW_FUNCS(amair_el2)
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000336DEFINE_SYSREG_RW_FUNCS(amair_el3)
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200337
338DEFINE_SYSREG_READ_FUNC(rvbar_el1)
339DEFINE_SYSREG_READ_FUNC(rvbar_el2)
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000340DEFINE_SYSREG_READ_FUNC(rvbar_el3)
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200341
342DEFINE_SYSREG_RW_FUNCS(rmr_el1)
343DEFINE_SYSREG_RW_FUNCS(rmr_el2)
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000344DEFINE_SYSREG_RW_FUNCS(rmr_el3)
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200345
346DEFINE_SYSREG_RW_FUNCS(tcr_el1)
347DEFINE_SYSREG_RW_FUNCS(tcr_el2)
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000348DEFINE_SYSREG_RW_FUNCS(tcr_el3)
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200349
350DEFINE_SYSREG_RW_FUNCS(ttbr0_el1)
351DEFINE_SYSREG_RW_FUNCS(ttbr0_el2)
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000352DEFINE_SYSREG_RW_FUNCS(ttbr0_el3)
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200353
354DEFINE_SYSREG_RW_FUNCS(ttbr1_el1)
355
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000356DEFINE_SYSREG_RW_FUNCS(vttbr_el2)
357
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200358DEFINE_SYSREG_RW_FUNCS(cptr_el2)
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000359DEFINE_SYSREG_RW_FUNCS(cptr_el3)
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200360
361DEFINE_SYSREG_RW_FUNCS(cpacr_el1)
362DEFINE_SYSREG_RW_FUNCS(cntfrq_el0)
363DEFINE_SYSREG_RW_FUNCS(cnthp_ctl_el2)
364DEFINE_SYSREG_RW_FUNCS(cnthp_tval_el2)
365DEFINE_SYSREG_RW_FUNCS(cnthp_cval_el2)
366DEFINE_SYSREG_RW_FUNCS(cntps_ctl_el1)
367DEFINE_SYSREG_RW_FUNCS(cntps_tval_el1)
368DEFINE_SYSREG_RW_FUNCS(cntps_cval_el1)
369DEFINE_SYSREG_RW_FUNCS(cntp_ctl_el0)
370DEFINE_SYSREG_RW_FUNCS(cntp_tval_el0)
371DEFINE_SYSREG_RW_FUNCS(cntp_cval_el0)
372DEFINE_SYSREG_READ_FUNC(cntpct_el0)
Manish Pandeye5400572021-01-12 15:15:32 +0000373DEFINE_SYSREG_READ_FUNC(cntvct_el0)
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200374DEFINE_SYSREG_RW_FUNCS(cnthctl_el2)
375
Antonio Nino Diaz1454f502018-11-23 13:52:54 +0000376#define get_cntp_ctl_enable(x) (((x) >> CNTP_CTL_ENABLE_SHIFT) & \
377 CNTP_CTL_ENABLE_MASK)
378#define get_cntp_ctl_imask(x) (((x) >> CNTP_CTL_IMASK_SHIFT) & \
379 CNTP_CTL_IMASK_MASK)
380#define get_cntp_ctl_istatus(x) (((x) >> CNTP_CTL_ISTATUS_SHIFT) & \
381 CNTP_CTL_ISTATUS_MASK)
382
383#define set_cntp_ctl_enable(x) ((x) |= (U(1) << CNTP_CTL_ENABLE_SHIFT))
384#define set_cntp_ctl_imask(x) ((x) |= (U(1) << CNTP_CTL_IMASK_SHIFT))
385
386#define clr_cntp_ctl_enable(x) ((x) &= ~(U(1) << CNTP_CTL_ENABLE_SHIFT))
387#define clr_cntp_ctl_imask(x) ((x) &= ~(U(1) << CNTP_CTL_IMASK_SHIFT))
388
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000389DEFINE_SYSREG_RW_FUNCS(tpidr_el3)
390
391DEFINE_SYSREG_RW_FUNCS(cntvoff_el2)
392
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200393DEFINE_SYSREG_RW_FUNCS(vpidr_el2)
394DEFINE_SYSREG_RW_FUNCS(vmpidr_el2)
395
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000396DEFINE_SYSREG_READ_FUNC(isr_el1)
397
398DEFINE_SYSREG_RW_FUNCS(mdcr_el2)
399DEFINE_SYSREG_RW_FUNCS(mdcr_el3)
400DEFINE_SYSREG_RW_FUNCS(hstr_el2)
401DEFINE_SYSREG_RW_FUNCS(pmcr_el0)
Petre-Ionut Tudorf68ebdb2019-09-18 16:13:00 +0100402DEFINE_SYSREG_RW_FUNCS(pmcntenset_el0)
403DEFINE_SYSREG_READ_FUNC(pmccntr_el0)
404DEFINE_SYSREG_RW_FUNCS(pmccfiltr_el0)
405
406DEFINE_SYSREG_RW_FUNCS(pmevtyper0_el0)
407DEFINE_SYSREG_READ_FUNC(pmevcntr0_el0)
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000408
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200409/* GICv3 System Registers */
410
411DEFINE_RENAME_SYSREG_RW_FUNCS(icc_sre_el1, ICC_SRE_EL1)
412DEFINE_RENAME_SYSREG_RW_FUNCS(icc_sre_el2, ICC_SRE_EL2)
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000413DEFINE_RENAME_SYSREG_RW_FUNCS(icc_sre_el3, ICC_SRE_EL3)
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200414DEFINE_RENAME_SYSREG_RW_FUNCS(icc_pmr_el1, ICC_PMR_EL1)
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000415DEFINE_RENAME_SYSREG_READ_FUNC(icc_rpr_el1, ICC_RPR_EL1)
416DEFINE_RENAME_SYSREG_RW_FUNCS(icc_igrpen1_el3, ICC_IGRPEN1_EL3)
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200417DEFINE_RENAME_SYSREG_RW_FUNCS(icc_igrpen1_el1, ICC_IGRPEN1_EL1)
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000418DEFINE_RENAME_SYSREG_RW_FUNCS(icc_igrpen0_el1, ICC_IGRPEN0_EL1)
419DEFINE_RENAME_SYSREG_READ_FUNC(icc_hppir0_el1, ICC_HPPIR0_EL1)
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200420DEFINE_RENAME_SYSREG_READ_FUNC(icc_hppir1_el1, ICC_HPPIR1_EL1)
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000421DEFINE_RENAME_SYSREG_READ_FUNC(icc_iar0_el1, ICC_IAR0_EL1)
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200422DEFINE_RENAME_SYSREG_READ_FUNC(icc_iar1_el1, ICC_IAR1_EL1)
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000423DEFINE_RENAME_SYSREG_WRITE_FUNC(icc_eoir0_el1, ICC_EOIR0_EL1)
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200424DEFINE_RENAME_SYSREG_WRITE_FUNC(icc_eoir1_el1, ICC_EOIR1_EL1)
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000425DEFINE_RENAME_SYSREG_WRITE_FUNC(icc_sgi0r_el1, ICC_SGI0R_EL1)
426DEFINE_RENAME_SYSREG_RW_FUNCS(icc_sgi1r, ICC_SGI1R)
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200427
johpow01b7d752a2020-10-08 17:29:11 -0500428DEFINE_RENAME_SYSREG_RW_FUNCS(amcr_el0, AMCR_EL0)
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200429DEFINE_RENAME_SYSREG_RW_FUNCS(amcgcr_el0, AMCGCR_EL0)
johpow01b7d752a2020-10-08 17:29:11 -0500430DEFINE_RENAME_SYSREG_READ_FUNC(amcfgr_el0, AMCFGR_EL0)
431DEFINE_RENAME_SYSREG_READ_FUNC(amcg1idr_el0, AMCG1IDR_EL0)
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200432DEFINE_RENAME_SYSREG_RW_FUNCS(amcntenclr0_el0, AMCNTENCLR0_EL0)
433DEFINE_RENAME_SYSREG_RW_FUNCS(amcntenset0_el0, AMCNTENSET0_EL0)
434DEFINE_RENAME_SYSREG_RW_FUNCS(amcntenclr1_el0, AMCNTENCLR1_EL0)
435DEFINE_RENAME_SYSREG_RW_FUNCS(amcntenset1_el0, AMCNTENSET1_EL0)
436
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000437DEFINE_RENAME_SYSREG_READ_FUNC(mpamidr_el1, MPAMIDR_EL1)
438DEFINE_RENAME_SYSREG_RW_FUNCS(mpam3_el3, MPAM3_EL3)
439DEFINE_RENAME_SYSREG_RW_FUNCS(mpam2_el2, MPAM2_EL2)
440DEFINE_RENAME_SYSREG_RW_FUNCS(mpamhcr_el2, MPAMHCR_EL2)
441
Manish V Badarkhe589a1122021-12-31 15:20:08 +0000442/* Static profiling control registers */
443DEFINE_RENAME_SYSREG_RW_FUNCS(pmscr_el1, PMSCR_EL1)
444DEFINE_RENAME_SYSREG_RW_FUNCS(pmsevfr_el1, PMSEVFR_EL1)
445DEFINE_RENAME_SYSREG_RW_FUNCS(pmsfcr_el1, PMSFCR_EL1)
446DEFINE_RENAME_SYSREG_RW_FUNCS(pmsicr_el1, PMSICR_EL1)
447DEFINE_RENAME_SYSREG_RW_FUNCS(pmsidr_el1, PMSIDR_EL1)
448DEFINE_RENAME_SYSREG_RW_FUNCS(pmsirr_el1, PMSIRR_EL1)
449DEFINE_RENAME_SYSREG_RW_FUNCS(pmslatfr_el1, PMSLATFR_EL1)
450DEFINE_RENAME_SYSREG_RW_FUNCS(pmsnevfr_el1, PMSNEVFR_EL1)
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000451DEFINE_RENAME_SYSREG_RW_FUNCS(pmblimitr_el1, PMBLIMITR_EL1)
Manish V Badarkhe589a1122021-12-31 15:20:08 +0000452DEFINE_RENAME_SYSREG_RW_FUNCS(pmbptr_el1, PMBPTR_EL1)
453DEFINE_RENAME_SYSREG_RW_FUNCS(pmbsr_el1, PMBSR_EL1)
454DEFINE_RENAME_SYSREG_RW_FUNCS(pmscr_el2, PMSCR_EL2)
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000455
456DEFINE_RENAME_SYSREG_WRITE_FUNC(zcr_el3, ZCR_EL3)
457DEFINE_RENAME_SYSREG_WRITE_FUNC(zcr_el2, ZCR_EL2)
458
johpow0150ccb552020-11-10 19:22:13 -0600459DEFINE_RENAME_SYSREG_READ_FUNC(id_aa64smfr0_el1, ID_AA64SMFR0_EL1)
460DEFINE_RENAME_SYSREG_RW_FUNCS(svcr, SVCR)
461DEFINE_RENAME_SYSREG_RW_FUNCS(tpidr2_el0, TPIDR2_EL0)
462DEFINE_RENAME_SYSREG_RW_FUNCS(smcr_el2, SMCR_EL2)
463
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000464DEFINE_RENAME_SYSREG_READ_FUNC(erridr_el1, ERRIDR_EL1)
465DEFINE_RENAME_SYSREG_WRITE_FUNC(errselr_el1, ERRSELR_EL1)
466
467DEFINE_RENAME_SYSREG_READ_FUNC(erxfr_el1, ERXFR_EL1)
468DEFINE_RENAME_SYSREG_RW_FUNCS(erxctlr_el1, ERXCTLR_EL1)
469DEFINE_RENAME_SYSREG_RW_FUNCS(erxstatus_el1, ERXSTATUS_EL1)
470DEFINE_RENAME_SYSREG_READ_FUNC(erxaddr_el1, ERXADDR_EL1)
471DEFINE_RENAME_SYSREG_READ_FUNC(erxmisc0_el1, ERXMISC0_EL1)
472DEFINE_RENAME_SYSREG_READ_FUNC(erxmisc1_el1, ERXMISC1_EL1)
473
Daniel Boulby39e4df22021-02-02 19:27:41 +0000474/* Armv8.1 Registers */
475DEFINE_RENAME_SYSREG_RW_FUNCS(pan, PAN)
476
Antonio Nino Diaz69068db2019-01-11 13:01:45 +0000477/* Armv8.2 Registers */
478DEFINE_RENAME_SYSREG_READ_FUNC(id_aa64mmfr2_el1, ID_AA64MMFR2_EL1)
479
Jeenu Viswambharana1c3cca2018-10-16 10:09:32 +0100480/* Armv8.3 Pointer Authentication Registers */
Joel Hutton8790f022019-03-15 14:47:02 +0000481/* Instruction keys A and B */
Antonio Nino Diaz9c9f92c2019-03-13 13:57:39 +0000482DEFINE_RENAME_SYSREG_RW_FUNCS(apiakeyhi_el1, APIAKeyHi_EL1)
483DEFINE_RENAME_SYSREG_RW_FUNCS(apiakeylo_el1, APIAKeyLo_EL1)
Jeenu Viswambharana1c3cca2018-10-16 10:09:32 +0100484
Joel Hutton8790f022019-03-15 14:47:02 +0000485DEFINE_RENAME_SYSREG_RW_FUNCS(apibkeyhi_el1, APIBKeyHi_EL1)
486DEFINE_RENAME_SYSREG_RW_FUNCS(apibkeylo_el1, APIBKeyLo_EL1)
487
488/* Data keys A and B */
489DEFINE_RENAME_SYSREG_RW_FUNCS(apdakeyhi_el1, APDAKeyHi_EL1)
490DEFINE_RENAME_SYSREG_RW_FUNCS(apdakeylo_el1, APDAKeyLo_EL1)
491
492DEFINE_RENAME_SYSREG_RW_FUNCS(apdbkeyhi_el1, APDBKeyHi_EL1)
493DEFINE_RENAME_SYSREG_RW_FUNCS(apdbkeylo_el1, APDBKeyLo_EL1)
494
495/* Generic key */
496DEFINE_RENAME_SYSREG_RW_FUNCS(apgakeyhi_el1, APGAKeyHi_EL1)
497DEFINE_RENAME_SYSREG_RW_FUNCS(apgakeylo_el1, APGAKeyLo_EL1)
498
Sandrine Bailleux277fb762019-10-08 12:10:45 +0200499/* MTE registers */
500DEFINE_RENAME_SYSREG_RW_FUNCS(tfsre0_el1, TFSRE0_EL1)
501DEFINE_RENAME_SYSREG_RW_FUNCS(tfsr_el1, TFSR_EL1)
502DEFINE_RENAME_SYSREG_RW_FUNCS(rgsr_el1, RGSR_EL1)
503DEFINE_RENAME_SYSREG_RW_FUNCS(gcr_el1, GCR_EL1)
504
Daniel Boulby39e4df22021-02-02 19:27:41 +0000505/* Armv8.4 Data Independent Timing */
506DEFINE_RENAME_SYSREG_RW_FUNCS(dit, DIT)
507
Jimmy Brisson90f1d5c2020-04-16 10:54:51 -0500508/* Armv8.6 Fine Grained Virtualization Traps Registers */
509DEFINE_RENAME_SYSREG_RW_FUNCS(hfgrtr_el2, HFGRTR_EL2)
510DEFINE_RENAME_SYSREG_RW_FUNCS(hfgwtr_el2, HFGWTR_EL2)
511DEFINE_RENAME_SYSREG_RW_FUNCS(hfgitr_el2, HFGITR_EL2)
512DEFINE_RENAME_SYSREG_RW_FUNCS(hdfgrtr_el2, HDFGRTR_EL2)
513DEFINE_RENAME_SYSREG_RW_FUNCS(hdfgwtr_el2, HDFGWTR_EL2)
514
Jimmy Brisson945095a2020-04-16 10:54:59 -0500515/* Armv8.6 Enhanced Counter Virtualization Register */
516DEFINE_RENAME_SYSREG_RW_FUNCS(cntpoff_el2, CNTPOFF_EL2)
517
Manish V Badarkhe87c03d12021-07-06 22:57:11 +0100518/* Armv9.0 Trace buffer extension System Registers */
519DEFINE_RENAME_SYSREG_RW_FUNCS(trblimitr_el1, TRBLIMITR_EL1)
520DEFINE_RENAME_SYSREG_RW_FUNCS(trbptr_el1, TRBPTR_EL1)
521DEFINE_RENAME_SYSREG_RW_FUNCS(trbbaser_el1, TRBBASER_EL1)
522DEFINE_RENAME_SYSREG_RW_FUNCS(trbsr_el1, TRBSR_EL1)
523DEFINE_RENAME_SYSREG_RW_FUNCS(trbmar_el1, TRBMAR_EL1)
524DEFINE_RENAME_SYSREG_RW_FUNCS(trbtrg_el1, TRBTRG_EL1)
525DEFINE_RENAME_SYSREG_READ_FUNC(trbidr_el1, TRBIDR_EL1)
526
johpow018c3da8b2022-01-31 18:14:41 -0600527/* FEAT_BRBE Branch record buffer extension system registers */
528DEFINE_RENAME_SYSREG_RW_FUNCS(brbcr_el1, BRBCR_EL1)
529DEFINE_RENAME_SYSREG_RW_FUNCS(brbcr_el2, BRBCR_EL2)
530DEFINE_RENAME_SYSREG_RW_FUNCS(brbfcr_el1, BRBFCR_EL1)
531DEFINE_RENAME_SYSREG_RW_FUNCS(brbts_el1, BRBTS_EL1)
532DEFINE_RENAME_SYSREG_RW_FUNCS(brbinfinj_el1, BRBINFINJ_EL1)
533DEFINE_RENAME_SYSREG_RW_FUNCS(brbsrcinj_el1, BRBSRCINJ_EL1)
534DEFINE_RENAME_SYSREG_RW_FUNCS(brbtgtinj_el1, BRBTGTINJ_EL1)
535DEFINE_RENAME_SYSREG_READ_FUNC(brbidr0_el1, BRBIDR0_EL1)
536
Manish V Badarkhe2c518e52021-07-08 16:36:57 +0100537/* Armv8.4 Trace filter control System Registers */
538DEFINE_RENAME_SYSREG_RW_FUNCS(trfcr_el1, TRFCR_EL1)
539DEFINE_RENAME_SYSREG_RW_FUNCS(trfcr_el2, TRFCR_EL2)
540
Manish V Badarkhe6d0e1b62021-07-09 13:58:28 +0100541/* Trace System Registers */
542DEFINE_RENAME_SYSREG_RW_FUNCS(trcauxctlr, TRCAUXCTLR)
543DEFINE_RENAME_SYSREG_RW_FUNCS(trcrsr, TRCRSR)
544DEFINE_RENAME_SYSREG_RW_FUNCS(trcbbctlr, TRCBBCTLR)
545DEFINE_RENAME_SYSREG_RW_FUNCS(trcccctlr, TRCCCCTLR)
546DEFINE_RENAME_SYSREG_RW_FUNCS(trcextinselr0, TRCEXTINSELR0)
547DEFINE_RENAME_SYSREG_RW_FUNCS(trcextinselr1, TRCEXTINSELR1)
548DEFINE_RENAME_SYSREG_RW_FUNCS(trcextinselr2, TRCEXTINSELR2)
549DEFINE_RENAME_SYSREG_RW_FUNCS(trcextinselr3, TRCEXTINSELR3)
550DEFINE_RENAME_SYSREG_RW_FUNCS(trcclaimset, TRCCLAIMSET)
551DEFINE_RENAME_SYSREG_RW_FUNCS(trcclaimclr, TRCCLAIMCLR)
552DEFINE_RENAME_SYSREG_READ_FUNC(trcdevarch, TRCDEVARCH)
553
johpow01d0bbe6e2021-11-11 16:13:32 -0600554/* FEAT_HCX HCRX_EL2 */
555DEFINE_RENAME_SYSREG_RW_FUNCS(hcrx_el2, HCRX_EL2)
556
Manish V Badarkhe82e1a252022-01-04 13:45:31 +0000557/* Control floating point behaviour */
558DEFINE_RENAME_SYSREG_RW_FUNCS(fpcr, FPCR)
559
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200560#define IS_IN_EL(x) \
561 (GET_EL(read_CurrentEl()) == MODE_EL##x)
562
563#define IS_IN_EL1() IS_IN_EL(1)
564#define IS_IN_EL2() IS_IN_EL(2)
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000565#define IS_IN_EL3() IS_IN_EL(3)
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200566
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000567static inline unsigned int get_current_el(void)
568{
569 return GET_EL(read_CurrentEl());
570}
571
572/*
573 * Check if an EL is implemented from AA64PFR0 register fields.
574 */
575static inline uint64_t el_implemented(unsigned int el)
576{
577 if (el > 3U) {
578 return EL_IMPL_NONE;
579 } else {
580 unsigned int shift = ID_AA64PFR0_EL1_SHIFT * el;
581
582 return (read_id_aa64pfr0_el1() >> shift) & ID_AA64PFR0_ELX_MASK;
583 }
584}
585
Sandrine Bailleuxd01a4c62018-12-20 14:44:13 +0100586/* Read the count value of the system counter. */
587static inline uint64_t syscounter_read(void)
588{
589 /*
590 * The instruction barrier is needed to guarantee that we read an
591 * accurate value. Otherwise, the CPU might speculatively read it and
592 * return a stale value.
593 */
594 isb();
595 return read_cntpct_el0();
596}
597
Madhukar Pappireddya09d5f72021-10-26 14:50:52 -0500598/* Read the value of the Counter-timer virtual count. */
599static inline uint64_t virtualcounter_read(void)
600{
601 /*
602 * The instruction barrier is needed to guarantee that we read an
603 * accurate value. Otherwise, the CPU might speculatively read it and
604 * return a stale value.
605 */
606 isb();
607 return read_cntvct_el0();
608}
609
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000610#endif /* ARCH_HELPERS_H */