blob: 77dc8810c53a7321e26314455654bab81645c4e2 [file] [log] [blame]
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +02001/*
AlexeiFedorov2f30f102023-03-13 19:37:46 +00002 * Copyright (c) 2013-2023, 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
Manish V Badarkheb31bc752021-12-24 08:52:52 +000078/* Define function for system instruction with register with variable parameter */
79#define DEFINE_SYSOP_PARAM_FUNC(_op) \
80static inline void _op(uint64_t v) \
81{ \
82 __asm__ (#_op " " "%0" : : "r" (v)); \
83}
84
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +020085/* Define function for system instruction with register parameter */
86#define DEFINE_SYSOP_TYPE_PARAM_FUNC(_op, _type) \
87static inline void _op ## _type(uint64_t v) \
88{ \
89 __asm__ (#_op " " #_type ", %0" : : "r" (v)); \
90}
91
92/*******************************************************************************
93 * TLB maintenance accessor prototypes
94 ******************************************************************************/
95
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +000096#if ERRATA_A57_813419
97/*
98 * Define function for TLBI instruction with type specifier that implements
99 * the workaround for errata 813419 of Cortex-A57.
100 */
101#define DEFINE_TLBIOP_ERRATA_A57_813419_TYPE_FUNC(_type)\
102static inline void tlbi ## _type(void) \
103{ \
104 __asm__("tlbi " #_type "\n" \
105 "dsb ish\n" \
106 "tlbi " #_type); \
107}
108
109/*
110 * Define function for TLBI instruction with register parameter that implements
111 * the workaround for errata 813419 of Cortex-A57.
112 */
113#define DEFINE_TLBIOP_ERRATA_A57_813419_TYPE_PARAM_FUNC(_type) \
114static inline void tlbi ## _type(uint64_t v) \
115{ \
116 __asm__("tlbi " #_type ", %0\n" \
117 "dsb ish\n" \
118 "tlbi " #_type ", %0" : : "r" (v)); \
119}
120#endif /* ERRATA_A57_813419 */
121
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200122DEFINE_SYSOP_TYPE_FUNC(tlbi, alle1)
123DEFINE_SYSOP_TYPE_FUNC(tlbi, alle1is)
124DEFINE_SYSOP_TYPE_FUNC(tlbi, alle2)
125DEFINE_SYSOP_TYPE_FUNC(tlbi, alle2is)
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000126#if ERRATA_A57_813419
127DEFINE_TLBIOP_ERRATA_A57_813419_TYPE_FUNC(alle3)
128DEFINE_TLBIOP_ERRATA_A57_813419_TYPE_FUNC(alle3is)
129#else
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200130DEFINE_SYSOP_TYPE_FUNC(tlbi, alle3)
131DEFINE_SYSOP_TYPE_FUNC(tlbi, alle3is)
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000132#endif
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200133DEFINE_SYSOP_TYPE_FUNC(tlbi, vmalle1)
134
135DEFINE_SYSOP_TYPE_PARAM_FUNC(tlbi, vaae1is)
136DEFINE_SYSOP_TYPE_PARAM_FUNC(tlbi, vaale1is)
137DEFINE_SYSOP_TYPE_PARAM_FUNC(tlbi, vae2is)
138DEFINE_SYSOP_TYPE_PARAM_FUNC(tlbi, vale2is)
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000139#if ERRATA_A57_813419
140DEFINE_TLBIOP_ERRATA_A57_813419_TYPE_PARAM_FUNC(vae3is)
141DEFINE_TLBIOP_ERRATA_A57_813419_TYPE_PARAM_FUNC(vale3is)
142#else
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200143DEFINE_SYSOP_TYPE_PARAM_FUNC(tlbi, vae3is)
144DEFINE_SYSOP_TYPE_PARAM_FUNC(tlbi, vale3is)
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000145#endif
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200146
147/*******************************************************************************
148 * Cache maintenance accessor prototypes
149 ******************************************************************************/
150DEFINE_SYSOP_TYPE_PARAM_FUNC(dc, isw)
151DEFINE_SYSOP_TYPE_PARAM_FUNC(dc, cisw)
152DEFINE_SYSOP_TYPE_PARAM_FUNC(dc, csw)
153DEFINE_SYSOP_TYPE_PARAM_FUNC(dc, cvac)
154DEFINE_SYSOP_TYPE_PARAM_FUNC(dc, ivac)
155DEFINE_SYSOP_TYPE_PARAM_FUNC(dc, civac)
156DEFINE_SYSOP_TYPE_PARAM_FUNC(dc, cvau)
157DEFINE_SYSOP_TYPE_PARAM_FUNC(dc, zva)
158
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000159/*******************************************************************************
160 * Address translation accessor prototypes
161 ******************************************************************************/
162DEFINE_SYSOP_TYPE_PARAM_FUNC(at, s12e1r)
163DEFINE_SYSOP_TYPE_PARAM_FUNC(at, s12e1w)
164DEFINE_SYSOP_TYPE_PARAM_FUNC(at, s12e0r)
165DEFINE_SYSOP_TYPE_PARAM_FUNC(at, s12e0w)
166DEFINE_SYSOP_TYPE_PARAM_FUNC(at, s1e1r)
167DEFINE_SYSOP_TYPE_PARAM_FUNC(at, s1e2r)
168DEFINE_SYSOP_TYPE_PARAM_FUNC(at, s1e3r)
169
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200170void flush_dcache_range(uintptr_t addr, size_t size);
171void clean_dcache_range(uintptr_t addr, size_t size);
172void inv_dcache_range(uintptr_t addr, size_t size);
173
174void dcsw_op_louis(u_register_t op_type);
175void dcsw_op_all(u_register_t op_type);
176
177void disable_mmu(void);
178void disable_mmu_icache(void);
179
180/*******************************************************************************
181 * Misc. accessor prototypes
182 ******************************************************************************/
183
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000184#define write_daifclr(val) SYSREG_WRITE_CONST(daifclr, val)
185#define write_daifset(val) SYSREG_WRITE_CONST(daifset, val)
186
187DEFINE_SYSREG_RW_FUNCS(par_el1)
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200188DEFINE_SYSREG_READ_FUNC(id_pfr1_el1)
Jeenu Viswambharana1c3cca2018-10-16 10:09:32 +0100189DEFINE_SYSREG_READ_FUNC(id_aa64isar1_el1)
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200190DEFINE_SYSREG_READ_FUNC(id_aa64pfr0_el1)
Antonio Nino Diazcc023992019-04-04 11:18:32 +0100191DEFINE_SYSREG_READ_FUNC(id_aa64pfr1_el1)
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000192DEFINE_SYSREG_READ_FUNC(id_aa64dfr0_el1)
Antonio Nino Diazffdfd162019-02-11 15:34:32 +0000193DEFINE_SYSREG_READ_FUNC(id_afr0_el1)
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200194DEFINE_SYSREG_READ_FUNC(CurrentEl)
195DEFINE_SYSREG_READ_FUNC(ctr_el0)
196DEFINE_SYSREG_RW_FUNCS(daif)
Daniel Boulby39e4df22021-02-02 19:27:41 +0000197DEFINE_SYSREG_RW_FUNCS(nzcv)
198DEFINE_SYSREG_READ_FUNC(spsel)
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200199DEFINE_SYSREG_RW_FUNCS(spsr_el1)
200DEFINE_SYSREG_RW_FUNCS(spsr_el2)
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000201DEFINE_SYSREG_RW_FUNCS(spsr_el3)
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200202DEFINE_SYSREG_RW_FUNCS(elr_el1)
203DEFINE_SYSREG_RW_FUNCS(elr_el2)
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000204DEFINE_SYSREG_RW_FUNCS(elr_el3)
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200205
206DEFINE_SYSOP_FUNC(wfi)
207DEFINE_SYSOP_FUNC(wfe)
208DEFINE_SYSOP_FUNC(sev)
Manish V Badarkheb31bc752021-12-24 08:52:52 +0000209DEFINE_SYSOP_FUNC(sevl)
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200210DEFINE_SYSOP_TYPE_FUNC(dsb, sy)
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000211DEFINE_SYSOP_TYPE_FUNC(dmb, sy)
212DEFINE_SYSOP_TYPE_FUNC(dmb, st)
213DEFINE_SYSOP_TYPE_FUNC(dmb, ld)
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200214DEFINE_SYSOP_TYPE_FUNC(dsb, ish)
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000215DEFINE_SYSOP_TYPE_FUNC(dsb, nsh)
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200216DEFINE_SYSOP_TYPE_FUNC(dsb, ishst)
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200217DEFINE_SYSOP_TYPE_FUNC(dmb, oshld)
218DEFINE_SYSOP_TYPE_FUNC(dmb, oshst)
219DEFINE_SYSOP_TYPE_FUNC(dmb, osh)
220DEFINE_SYSOP_TYPE_FUNC(dmb, nshld)
221DEFINE_SYSOP_TYPE_FUNC(dmb, nshst)
222DEFINE_SYSOP_TYPE_FUNC(dmb, nsh)
223DEFINE_SYSOP_TYPE_FUNC(dmb, ishld)
224DEFINE_SYSOP_TYPE_FUNC(dmb, ishst)
225DEFINE_SYSOP_TYPE_FUNC(dmb, ish)
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000226DEFINE_SYSOP_FUNC(isb)
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200227
Manish V Badarkheb31bc752021-12-24 08:52:52 +0000228DEFINE_SYSOP_PARAM_FUNC(wfit)
229DEFINE_SYSOP_PARAM_FUNC(wfet)
230
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200231static inline void enable_irq(void)
232{
233 /*
234 * The compiler memory barrier will prevent the compiler from
235 * scheduling non-volatile memory access after the write to the
236 * register.
237 *
238 * This could happen if some initialization code issues non-volatile
239 * accesses to an area used by an interrupt handler, in the assumption
240 * that it is safe as the interrupts are disabled at the time it does
241 * that (according to program order). However, non-volatile accesses
242 * are not necessarily in program order relatively with volatile inline
243 * assembly statements (and volatile accesses).
244 */
245 COMPILER_BARRIER();
246 write_daifclr(DAIF_IRQ_BIT);
247 isb();
248}
249
250static inline void enable_fiq(void)
251{
252 COMPILER_BARRIER();
253 write_daifclr(DAIF_FIQ_BIT);
254 isb();
255}
256
257static inline void enable_serror(void)
258{
259 COMPILER_BARRIER();
260 write_daifclr(DAIF_ABT_BIT);
261 isb();
262}
263
264static inline void enable_debug_exceptions(void)
265{
266 COMPILER_BARRIER();
267 write_daifclr(DAIF_DBG_BIT);
268 isb();
269}
270
271static inline void disable_irq(void)
272{
273 COMPILER_BARRIER();
274 write_daifset(DAIF_IRQ_BIT);
275 isb();
276}
277
278static inline void disable_fiq(void)
279{
280 COMPILER_BARRIER();
281 write_daifset(DAIF_FIQ_BIT);
282 isb();
283}
284
285static inline void disable_serror(void)
286{
287 COMPILER_BARRIER();
288 write_daifset(DAIF_ABT_BIT);
289 isb();
290}
291
292static inline void disable_debug_exceptions(void)
293{
294 COMPILER_BARRIER();
295 write_daifset(DAIF_DBG_BIT);
296 isb();
297}
298
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200299void __dead2 smc(uint64_t x0, uint64_t x1, uint64_t x2, uint64_t x3,
300 uint64_t x4, uint64_t x5, uint64_t x6, uint64_t x7);
301
302/*******************************************************************************
303 * System register accessor prototypes
304 ******************************************************************************/
305DEFINE_SYSREG_READ_FUNC(midr_el1)
306DEFINE_SYSREG_READ_FUNC(mpidr_el1)
307DEFINE_SYSREG_READ_FUNC(id_aa64mmfr0_el1)
Daniel Boulby39e4df22021-02-02 19:27:41 +0000308DEFINE_SYSREG_READ_FUNC(id_aa64mmfr1_el1)
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200309
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000310DEFINE_SYSREG_RW_FUNCS(scr_el3)
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200311DEFINE_SYSREG_RW_FUNCS(hcr_el2)
312
313DEFINE_SYSREG_RW_FUNCS(vbar_el1)
314DEFINE_SYSREG_RW_FUNCS(vbar_el2)
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000315DEFINE_SYSREG_RW_FUNCS(vbar_el3)
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200316
317DEFINE_SYSREG_RW_FUNCS(sctlr_el1)
318DEFINE_SYSREG_RW_FUNCS(sctlr_el2)
319DEFINE_SYSREG_RW_FUNCS(sctlr_el3)
320
321DEFINE_SYSREG_RW_FUNCS(actlr_el1)
322DEFINE_SYSREG_RW_FUNCS(actlr_el2)
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000323DEFINE_SYSREG_RW_FUNCS(actlr_el3)
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200324
325DEFINE_SYSREG_RW_FUNCS(esr_el1)
326DEFINE_SYSREG_RW_FUNCS(esr_el2)
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000327DEFINE_SYSREG_RW_FUNCS(esr_el3)
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200328
329DEFINE_SYSREG_RW_FUNCS(afsr0_el1)
330DEFINE_SYSREG_RW_FUNCS(afsr0_el2)
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000331DEFINE_SYSREG_RW_FUNCS(afsr0_el3)
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200332
333DEFINE_SYSREG_RW_FUNCS(afsr1_el1)
334DEFINE_SYSREG_RW_FUNCS(afsr1_el2)
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000335DEFINE_SYSREG_RW_FUNCS(afsr1_el3)
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200336
337DEFINE_SYSREG_RW_FUNCS(far_el1)
338DEFINE_SYSREG_RW_FUNCS(far_el2)
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000339DEFINE_SYSREG_RW_FUNCS(far_el3)
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200340
341DEFINE_SYSREG_RW_FUNCS(mair_el1)
342DEFINE_SYSREG_RW_FUNCS(mair_el2)
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000343DEFINE_SYSREG_RW_FUNCS(mair_el3)
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200344
345DEFINE_SYSREG_RW_FUNCS(amair_el1)
346DEFINE_SYSREG_RW_FUNCS(amair_el2)
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000347DEFINE_SYSREG_RW_FUNCS(amair_el3)
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200348
349DEFINE_SYSREG_READ_FUNC(rvbar_el1)
350DEFINE_SYSREG_READ_FUNC(rvbar_el2)
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000351DEFINE_SYSREG_READ_FUNC(rvbar_el3)
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200352
353DEFINE_SYSREG_RW_FUNCS(rmr_el1)
354DEFINE_SYSREG_RW_FUNCS(rmr_el2)
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000355DEFINE_SYSREG_RW_FUNCS(rmr_el3)
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200356
357DEFINE_SYSREG_RW_FUNCS(tcr_el1)
358DEFINE_SYSREG_RW_FUNCS(tcr_el2)
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000359DEFINE_SYSREG_RW_FUNCS(tcr_el3)
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200360
361DEFINE_SYSREG_RW_FUNCS(ttbr0_el1)
362DEFINE_SYSREG_RW_FUNCS(ttbr0_el2)
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000363DEFINE_SYSREG_RW_FUNCS(ttbr0_el3)
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200364
365DEFINE_SYSREG_RW_FUNCS(ttbr1_el1)
366
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000367DEFINE_SYSREG_RW_FUNCS(vttbr_el2)
368
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200369DEFINE_SYSREG_RW_FUNCS(cptr_el2)
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000370DEFINE_SYSREG_RW_FUNCS(cptr_el3)
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200371
372DEFINE_SYSREG_RW_FUNCS(cpacr_el1)
373DEFINE_SYSREG_RW_FUNCS(cntfrq_el0)
374DEFINE_SYSREG_RW_FUNCS(cnthp_ctl_el2)
375DEFINE_SYSREG_RW_FUNCS(cnthp_tval_el2)
376DEFINE_SYSREG_RW_FUNCS(cnthp_cval_el2)
377DEFINE_SYSREG_RW_FUNCS(cntps_ctl_el1)
378DEFINE_SYSREG_RW_FUNCS(cntps_tval_el1)
379DEFINE_SYSREG_RW_FUNCS(cntps_cval_el1)
380DEFINE_SYSREG_RW_FUNCS(cntp_ctl_el0)
381DEFINE_SYSREG_RW_FUNCS(cntp_tval_el0)
382DEFINE_SYSREG_RW_FUNCS(cntp_cval_el0)
383DEFINE_SYSREG_READ_FUNC(cntpct_el0)
Manish Pandeye5400572021-01-12 15:15:32 +0000384DEFINE_SYSREG_READ_FUNC(cntvct_el0)
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200385DEFINE_SYSREG_RW_FUNCS(cnthctl_el2)
386
Antonio Nino Diaz1454f502018-11-23 13:52:54 +0000387#define get_cntp_ctl_enable(x) (((x) >> CNTP_CTL_ENABLE_SHIFT) & \
388 CNTP_CTL_ENABLE_MASK)
389#define get_cntp_ctl_imask(x) (((x) >> CNTP_CTL_IMASK_SHIFT) & \
390 CNTP_CTL_IMASK_MASK)
391#define get_cntp_ctl_istatus(x) (((x) >> CNTP_CTL_ISTATUS_SHIFT) & \
392 CNTP_CTL_ISTATUS_MASK)
393
394#define set_cntp_ctl_enable(x) ((x) |= (U(1) << CNTP_CTL_ENABLE_SHIFT))
395#define set_cntp_ctl_imask(x) ((x) |= (U(1) << CNTP_CTL_IMASK_SHIFT))
396
397#define clr_cntp_ctl_enable(x) ((x) &= ~(U(1) << CNTP_CTL_ENABLE_SHIFT))
398#define clr_cntp_ctl_imask(x) ((x) &= ~(U(1) << CNTP_CTL_IMASK_SHIFT))
399
Sona Mathew07384212022-11-28 13:19:11 -0600400#define read_midr() read_midr_el1()
401
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000402DEFINE_SYSREG_RW_FUNCS(tpidr_el3)
403
404DEFINE_SYSREG_RW_FUNCS(cntvoff_el2)
405
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200406DEFINE_SYSREG_RW_FUNCS(vpidr_el2)
407DEFINE_SYSREG_RW_FUNCS(vmpidr_el2)
408
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000409DEFINE_SYSREG_READ_FUNC(isr_el1)
410
411DEFINE_SYSREG_RW_FUNCS(mdcr_el2)
412DEFINE_SYSREG_RW_FUNCS(mdcr_el3)
413DEFINE_SYSREG_RW_FUNCS(hstr_el2)
Petre-Ionut Tudorf68ebdb2019-09-18 16:13:00 +0100414
AlexeiFedorov2f30f102023-03-13 19:37:46 +0000415DEFINE_SYSREG_RW_FUNCS(pmcr_el0)
416DEFINE_SYSREG_RW_FUNCS(pmcntenclr_el0)
417DEFINE_SYSREG_RW_FUNCS(pmcntenset_el0)
418DEFINE_SYSREG_RW_FUNCS(pmccntr_el0)
419DEFINE_SYSREG_RW_FUNCS(pmccfiltr_el0)
Petre-Ionut Tudorf68ebdb2019-09-18 16:13:00 +0100420DEFINE_SYSREG_RW_FUNCS(pmevtyper0_el0)
AlexeiFedorov2f30f102023-03-13 19:37:46 +0000421DEFINE_SYSREG_RW_FUNCS(pmevcntr0_el0)
422DEFINE_SYSREG_RW_FUNCS(pmovsclr_el0)
423DEFINE_SYSREG_RW_FUNCS(pmovsset_el0)
Boyan Karatotev35e3ca02022-10-10 16:39:45 +0100424DEFINE_SYSREG_RW_FUNCS(pmselr_el0)
AlexeiFedorov2f30f102023-03-13 19:37:46 +0000425DEFINE_SYSREG_RW_FUNCS(pmuserenr_el0);
Boyan Karatotev35e3ca02022-10-10 16:39:45 +0100426DEFINE_SYSREG_RW_FUNCS(pmxevtyper_el0)
427DEFINE_SYSREG_RW_FUNCS(pmxevcntr_el0)
AlexeiFedorov2f30f102023-03-13 19:37:46 +0000428DEFINE_SYSREG_RW_FUNCS(pmintenclr_el1)
429DEFINE_SYSREG_RW_FUNCS(pmintenset_el1)
Boyan Karatotev35e3ca02022-10-10 16:39:45 +0100430
431/* parameterised event counter accessors */
432static inline u_register_t read_pmevcntrn_el0(int ctr_num)
433{
434 write_pmselr_el0(ctr_num & PMSELR_EL0_SEL_MASK);
435 return read_pmxevcntr_el0();
436}
437
438static inline void write_pmevcntrn_el0(int ctr_num, u_register_t val)
439{
440 write_pmselr_el0(ctr_num & PMSELR_EL0_SEL_MASK);
441 write_pmxevcntr_el0(val);
442}
443
444static inline u_register_t read_pmevtypern_el0(int ctr_num)
445{
446 write_pmselr_el0(ctr_num & PMSELR_EL0_SEL_MASK);
447 return read_pmxevtyper_el0();
448}
449
450static inline void write_pmevtypern_el0(int ctr_num, u_register_t val)
451{
452 write_pmselr_el0(ctr_num & PMSELR_EL0_SEL_MASK);
453 write_pmxevtyper_el0(val);
454}
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000455
Juan Pablo Conde9303f4d2022-07-25 16:38:01 -0400456/* Armv8.5 FEAT_RNG Registers */
457DEFINE_SYSREG_READ_FUNC(rndr)
458DEFINE_SYSREG_READ_FUNC(rndrrs)
459
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200460/* GICv3 System Registers */
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200461DEFINE_RENAME_SYSREG_RW_FUNCS(icc_sre_el1, ICC_SRE_EL1)
462DEFINE_RENAME_SYSREG_RW_FUNCS(icc_sre_el2, ICC_SRE_EL2)
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000463DEFINE_RENAME_SYSREG_RW_FUNCS(icc_sre_el3, ICC_SRE_EL3)
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200464DEFINE_RENAME_SYSREG_RW_FUNCS(icc_pmr_el1, ICC_PMR_EL1)
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000465DEFINE_RENAME_SYSREG_READ_FUNC(icc_rpr_el1, ICC_RPR_EL1)
466DEFINE_RENAME_SYSREG_RW_FUNCS(icc_igrpen1_el3, ICC_IGRPEN1_EL3)
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200467DEFINE_RENAME_SYSREG_RW_FUNCS(icc_igrpen1_el1, ICC_IGRPEN1_EL1)
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000468DEFINE_RENAME_SYSREG_RW_FUNCS(icc_igrpen0_el1, ICC_IGRPEN0_EL1)
469DEFINE_RENAME_SYSREG_READ_FUNC(icc_hppir0_el1, ICC_HPPIR0_EL1)
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200470DEFINE_RENAME_SYSREG_READ_FUNC(icc_hppir1_el1, ICC_HPPIR1_EL1)
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000471DEFINE_RENAME_SYSREG_READ_FUNC(icc_iar0_el1, ICC_IAR0_EL1)
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200472DEFINE_RENAME_SYSREG_READ_FUNC(icc_iar1_el1, ICC_IAR1_EL1)
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000473DEFINE_RENAME_SYSREG_WRITE_FUNC(icc_eoir0_el1, ICC_EOIR0_EL1)
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200474DEFINE_RENAME_SYSREG_WRITE_FUNC(icc_eoir1_el1, ICC_EOIR1_EL1)
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000475DEFINE_RENAME_SYSREG_WRITE_FUNC(icc_sgi0r_el1, ICC_SGI0R_EL1)
476DEFINE_RENAME_SYSREG_RW_FUNCS(icc_sgi1r, ICC_SGI1R)
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200477
AlexeiFedorov2f30f102023-03-13 19:37:46 +0000478DEFINE_RENAME_SYSREG_RW_FUNCS(icv_ctrl_el1, ICV_CTRL_EL1)
479DEFINE_RENAME_SYSREG_READ_FUNC(icv_iar1_el1, ICV_IAR1_EL1)
480DEFINE_RENAME_SYSREG_RW_FUNCS(icv_igrpen1_el1, ICV_IGRPEN1_EL1)
481DEFINE_RENAME_SYSREG_WRITE_FUNC(icv_eoir1_el1, ICV_EOIR1_EL1)
482DEFINE_RENAME_SYSREG_RW_FUNCS(icv_pmr_el1, ICV_PMR_EL1)
483
johpow01b7d752a2020-10-08 17:29:11 -0500484DEFINE_RENAME_SYSREG_RW_FUNCS(amcr_el0, AMCR_EL0)
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200485DEFINE_RENAME_SYSREG_RW_FUNCS(amcgcr_el0, AMCGCR_EL0)
johpow01b7d752a2020-10-08 17:29:11 -0500486DEFINE_RENAME_SYSREG_READ_FUNC(amcfgr_el0, AMCFGR_EL0)
487DEFINE_RENAME_SYSREG_READ_FUNC(amcg1idr_el0, AMCG1IDR_EL0)
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200488DEFINE_RENAME_SYSREG_RW_FUNCS(amcntenclr0_el0, AMCNTENCLR0_EL0)
489DEFINE_RENAME_SYSREG_RW_FUNCS(amcntenset0_el0, AMCNTENSET0_EL0)
490DEFINE_RENAME_SYSREG_RW_FUNCS(amcntenclr1_el0, AMCNTENCLR1_EL0)
491DEFINE_RENAME_SYSREG_RW_FUNCS(amcntenset1_el0, AMCNTENSET1_EL0)
492
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000493DEFINE_RENAME_SYSREG_READ_FUNC(mpamidr_el1, MPAMIDR_EL1)
494DEFINE_RENAME_SYSREG_RW_FUNCS(mpam3_el3, MPAM3_EL3)
495DEFINE_RENAME_SYSREG_RW_FUNCS(mpam2_el2, MPAM2_EL2)
496DEFINE_RENAME_SYSREG_RW_FUNCS(mpamhcr_el2, MPAMHCR_EL2)
497
Manish V Badarkhe589a1122021-12-31 15:20:08 +0000498/* Static profiling control registers */
499DEFINE_RENAME_SYSREG_RW_FUNCS(pmscr_el1, PMSCR_EL1)
500DEFINE_RENAME_SYSREG_RW_FUNCS(pmsevfr_el1, PMSEVFR_EL1)
501DEFINE_RENAME_SYSREG_RW_FUNCS(pmsfcr_el1, PMSFCR_EL1)
502DEFINE_RENAME_SYSREG_RW_FUNCS(pmsicr_el1, PMSICR_EL1)
503DEFINE_RENAME_SYSREG_RW_FUNCS(pmsidr_el1, PMSIDR_EL1)
504DEFINE_RENAME_SYSREG_RW_FUNCS(pmsirr_el1, PMSIRR_EL1)
505DEFINE_RENAME_SYSREG_RW_FUNCS(pmslatfr_el1, PMSLATFR_EL1)
506DEFINE_RENAME_SYSREG_RW_FUNCS(pmsnevfr_el1, PMSNEVFR_EL1)
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000507DEFINE_RENAME_SYSREG_RW_FUNCS(pmblimitr_el1, PMBLIMITR_EL1)
Manish V Badarkhe589a1122021-12-31 15:20:08 +0000508DEFINE_RENAME_SYSREG_RW_FUNCS(pmbptr_el1, PMBPTR_EL1)
509DEFINE_RENAME_SYSREG_RW_FUNCS(pmbsr_el1, PMBSR_EL1)
510DEFINE_RENAME_SYSREG_RW_FUNCS(pmscr_el2, PMSCR_EL2)
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000511
Arunachalam Ganapathy0bbdc2d2023-04-05 15:30:18 +0100512/* Definitions for system register interface to SVE */
513DEFINE_RENAME_SYSREG_READ_FUNC(id_aa64zfr0_el1, ID_AA64ZFR0_EL1)
514DEFINE_RENAME_SYSREG_RW_FUNCS(zcr_el2, ZCR_EL2)
515DEFINE_RENAME_SYSREG_RW_FUNCS(zcr_el1, ZCR_EL1)
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000516
johpow0150ccb552020-11-10 19:22:13 -0600517DEFINE_RENAME_SYSREG_READ_FUNC(id_aa64smfr0_el1, ID_AA64SMFR0_EL1)
518DEFINE_RENAME_SYSREG_RW_FUNCS(svcr, SVCR)
519DEFINE_RENAME_SYSREG_RW_FUNCS(tpidr2_el0, TPIDR2_EL0)
520DEFINE_RENAME_SYSREG_RW_FUNCS(smcr_el2, SMCR_EL2)
521
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000522DEFINE_RENAME_SYSREG_READ_FUNC(erridr_el1, ERRIDR_EL1)
523DEFINE_RENAME_SYSREG_WRITE_FUNC(errselr_el1, ERRSELR_EL1)
524
525DEFINE_RENAME_SYSREG_READ_FUNC(erxfr_el1, ERXFR_EL1)
526DEFINE_RENAME_SYSREG_RW_FUNCS(erxctlr_el1, ERXCTLR_EL1)
527DEFINE_RENAME_SYSREG_RW_FUNCS(erxstatus_el1, ERXSTATUS_EL1)
528DEFINE_RENAME_SYSREG_READ_FUNC(erxaddr_el1, ERXADDR_EL1)
529DEFINE_RENAME_SYSREG_READ_FUNC(erxmisc0_el1, ERXMISC0_EL1)
530DEFINE_RENAME_SYSREG_READ_FUNC(erxmisc1_el1, ERXMISC1_EL1)
531
Daniel Boulby39e4df22021-02-02 19:27:41 +0000532/* Armv8.1 Registers */
533DEFINE_RENAME_SYSREG_RW_FUNCS(pan, PAN)
534
Antonio Nino Diaz69068db2019-01-11 13:01:45 +0000535/* Armv8.2 Registers */
536DEFINE_RENAME_SYSREG_READ_FUNC(id_aa64mmfr2_el1, ID_AA64MMFR2_EL1)
537
Jeenu Viswambharana1c3cca2018-10-16 10:09:32 +0100538/* Armv8.3 Pointer Authentication Registers */
Joel Hutton8790f022019-03-15 14:47:02 +0000539/* Instruction keys A and B */
Antonio Nino Diaz9c9f92c2019-03-13 13:57:39 +0000540DEFINE_RENAME_SYSREG_RW_FUNCS(apiakeyhi_el1, APIAKeyHi_EL1)
541DEFINE_RENAME_SYSREG_RW_FUNCS(apiakeylo_el1, APIAKeyLo_EL1)
Jeenu Viswambharana1c3cca2018-10-16 10:09:32 +0100542
Joel Hutton8790f022019-03-15 14:47:02 +0000543DEFINE_RENAME_SYSREG_RW_FUNCS(apibkeyhi_el1, APIBKeyHi_EL1)
544DEFINE_RENAME_SYSREG_RW_FUNCS(apibkeylo_el1, APIBKeyLo_EL1)
545
546/* Data keys A and B */
547DEFINE_RENAME_SYSREG_RW_FUNCS(apdakeyhi_el1, APDAKeyHi_EL1)
548DEFINE_RENAME_SYSREG_RW_FUNCS(apdakeylo_el1, APDAKeyLo_EL1)
549
550DEFINE_RENAME_SYSREG_RW_FUNCS(apdbkeyhi_el1, APDBKeyHi_EL1)
551DEFINE_RENAME_SYSREG_RW_FUNCS(apdbkeylo_el1, APDBKeyLo_EL1)
552
553/* Generic key */
554DEFINE_RENAME_SYSREG_RW_FUNCS(apgakeyhi_el1, APGAKeyHi_EL1)
555DEFINE_RENAME_SYSREG_RW_FUNCS(apgakeylo_el1, APGAKeyLo_EL1)
556
Sandrine Bailleux277fb762019-10-08 12:10:45 +0200557/* MTE registers */
558DEFINE_RENAME_SYSREG_RW_FUNCS(tfsre0_el1, TFSRE0_EL1)
559DEFINE_RENAME_SYSREG_RW_FUNCS(tfsr_el1, TFSR_EL1)
560DEFINE_RENAME_SYSREG_RW_FUNCS(rgsr_el1, RGSR_EL1)
561DEFINE_RENAME_SYSREG_RW_FUNCS(gcr_el1, GCR_EL1)
562
Daniel Boulby39e4df22021-02-02 19:27:41 +0000563/* Armv8.4 Data Independent Timing */
564DEFINE_RENAME_SYSREG_RW_FUNCS(dit, DIT)
565
Jimmy Brisson90f1d5c2020-04-16 10:54:51 -0500566/* Armv8.6 Fine Grained Virtualization Traps Registers */
567DEFINE_RENAME_SYSREG_RW_FUNCS(hfgrtr_el2, HFGRTR_EL2)
568DEFINE_RENAME_SYSREG_RW_FUNCS(hfgwtr_el2, HFGWTR_EL2)
569DEFINE_RENAME_SYSREG_RW_FUNCS(hfgitr_el2, HFGITR_EL2)
570DEFINE_RENAME_SYSREG_RW_FUNCS(hdfgrtr_el2, HDFGRTR_EL2)
571DEFINE_RENAME_SYSREG_RW_FUNCS(hdfgwtr_el2, HDFGWTR_EL2)
572
Jimmy Brisson945095a2020-04-16 10:54:59 -0500573/* Armv8.6 Enhanced Counter Virtualization Register */
574DEFINE_RENAME_SYSREG_RW_FUNCS(cntpoff_el2, CNTPOFF_EL2)
575
Manish V Badarkhe87c03d12021-07-06 22:57:11 +0100576/* Armv9.0 Trace buffer extension System Registers */
577DEFINE_RENAME_SYSREG_RW_FUNCS(trblimitr_el1, TRBLIMITR_EL1)
578DEFINE_RENAME_SYSREG_RW_FUNCS(trbptr_el1, TRBPTR_EL1)
579DEFINE_RENAME_SYSREG_RW_FUNCS(trbbaser_el1, TRBBASER_EL1)
580DEFINE_RENAME_SYSREG_RW_FUNCS(trbsr_el1, TRBSR_EL1)
581DEFINE_RENAME_SYSREG_RW_FUNCS(trbmar_el1, TRBMAR_EL1)
582DEFINE_RENAME_SYSREG_RW_FUNCS(trbtrg_el1, TRBTRG_EL1)
583DEFINE_RENAME_SYSREG_READ_FUNC(trbidr_el1, TRBIDR_EL1)
584
johpow018c3da8b2022-01-31 18:14:41 -0600585/* FEAT_BRBE Branch record buffer extension system registers */
586DEFINE_RENAME_SYSREG_RW_FUNCS(brbcr_el1, BRBCR_EL1)
587DEFINE_RENAME_SYSREG_RW_FUNCS(brbcr_el2, BRBCR_EL2)
588DEFINE_RENAME_SYSREG_RW_FUNCS(brbfcr_el1, BRBFCR_EL1)
589DEFINE_RENAME_SYSREG_RW_FUNCS(brbts_el1, BRBTS_EL1)
590DEFINE_RENAME_SYSREG_RW_FUNCS(brbinfinj_el1, BRBINFINJ_EL1)
591DEFINE_RENAME_SYSREG_RW_FUNCS(brbsrcinj_el1, BRBSRCINJ_EL1)
592DEFINE_RENAME_SYSREG_RW_FUNCS(brbtgtinj_el1, BRBTGTINJ_EL1)
593DEFINE_RENAME_SYSREG_READ_FUNC(brbidr0_el1, BRBIDR0_EL1)
594
Manish V Badarkhe2c518e52021-07-08 16:36:57 +0100595/* Armv8.4 Trace filter control System Registers */
596DEFINE_RENAME_SYSREG_RW_FUNCS(trfcr_el1, TRFCR_EL1)
597DEFINE_RENAME_SYSREG_RW_FUNCS(trfcr_el2, TRFCR_EL2)
598
Manish V Badarkhe6d0e1b62021-07-09 13:58:28 +0100599/* Trace System Registers */
600DEFINE_RENAME_SYSREG_RW_FUNCS(trcauxctlr, TRCAUXCTLR)
601DEFINE_RENAME_SYSREG_RW_FUNCS(trcrsr, TRCRSR)
602DEFINE_RENAME_SYSREG_RW_FUNCS(trcbbctlr, TRCBBCTLR)
603DEFINE_RENAME_SYSREG_RW_FUNCS(trcccctlr, TRCCCCTLR)
604DEFINE_RENAME_SYSREG_RW_FUNCS(trcextinselr0, TRCEXTINSELR0)
605DEFINE_RENAME_SYSREG_RW_FUNCS(trcextinselr1, TRCEXTINSELR1)
606DEFINE_RENAME_SYSREG_RW_FUNCS(trcextinselr2, TRCEXTINSELR2)
607DEFINE_RENAME_SYSREG_RW_FUNCS(trcextinselr3, TRCEXTINSELR3)
608DEFINE_RENAME_SYSREG_RW_FUNCS(trcclaimset, TRCCLAIMSET)
609DEFINE_RENAME_SYSREG_RW_FUNCS(trcclaimclr, TRCCLAIMCLR)
610DEFINE_RENAME_SYSREG_READ_FUNC(trcdevarch, TRCDEVARCH)
611
johpow01d0bbe6e2021-11-11 16:13:32 -0600612/* FEAT_HCX HCRX_EL2 */
613DEFINE_RENAME_SYSREG_RW_FUNCS(hcrx_el2, HCRX_EL2)
614
Manish V Badarkhe82e1a252022-01-04 13:45:31 +0000615/* Control floating point behaviour */
616DEFINE_RENAME_SYSREG_RW_FUNCS(fpcr, FPCR)
617
Manish V Badarkheb31bc752021-12-24 08:52:52 +0000618/* ID_AA64ISAR2_EL1 */
619DEFINE_RENAME_SYSREG_READ_FUNC(id_aa64isar2_el1, ID_AA64ISAR2_EL1)
620
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200621#define IS_IN_EL(x) \
622 (GET_EL(read_CurrentEl()) == MODE_EL##x)
623
624#define IS_IN_EL1() IS_IN_EL(1)
625#define IS_IN_EL2() IS_IN_EL(2)
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000626#define IS_IN_EL3() IS_IN_EL(3)
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200627
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000628static inline unsigned int get_current_el(void)
629{
630 return GET_EL(read_CurrentEl());
631}
632
633/*
634 * Check if an EL is implemented from AA64PFR0 register fields.
635 */
636static inline uint64_t el_implemented(unsigned int el)
637{
638 if (el > 3U) {
639 return EL_IMPL_NONE;
640 } else {
641 unsigned int shift = ID_AA64PFR0_EL1_SHIFT * el;
642
643 return (read_id_aa64pfr0_el1() >> shift) & ID_AA64PFR0_ELX_MASK;
644 }
645}
646
Sandrine Bailleuxd01a4c62018-12-20 14:44:13 +0100647/* Read the count value of the system counter. */
648static inline uint64_t syscounter_read(void)
649{
650 /*
651 * The instruction barrier is needed to guarantee that we read an
652 * accurate value. Otherwise, the CPU might speculatively read it and
653 * return a stale value.
654 */
655 isb();
656 return read_cntpct_el0();
657}
658
Madhukar Pappireddya09d5f72021-10-26 14:50:52 -0500659/* Read the value of the Counter-timer virtual count. */
660static inline uint64_t virtualcounter_read(void)
661{
662 /*
663 * The instruction barrier is needed to guarantee that we read an
664 * accurate value. Otherwise, the CPU might speculatively read it and
665 * return a stale value.
666 */
667 isb();
668 return read_cntvct_el0();
669}
670
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000671#endif /* ARCH_HELPERS_H */