blob: b366cdd8d08a23833bb93f539c7ef1e7e35c2bfe [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
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
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000400DEFINE_SYSREG_RW_FUNCS(tpidr_el3)
401
402DEFINE_SYSREG_RW_FUNCS(cntvoff_el2)
403
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200404DEFINE_SYSREG_RW_FUNCS(vpidr_el2)
405DEFINE_SYSREG_RW_FUNCS(vmpidr_el2)
406
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000407DEFINE_SYSREG_READ_FUNC(isr_el1)
408
409DEFINE_SYSREG_RW_FUNCS(mdcr_el2)
410DEFINE_SYSREG_RW_FUNCS(mdcr_el3)
411DEFINE_SYSREG_RW_FUNCS(hstr_el2)
412DEFINE_SYSREG_RW_FUNCS(pmcr_el0)
Petre-Ionut Tudorf68ebdb2019-09-18 16:13:00 +0100413DEFINE_SYSREG_RW_FUNCS(pmcntenset_el0)
414DEFINE_SYSREG_READ_FUNC(pmccntr_el0)
415DEFINE_SYSREG_RW_FUNCS(pmccfiltr_el0)
416
417DEFINE_SYSREG_RW_FUNCS(pmevtyper0_el0)
418DEFINE_SYSREG_READ_FUNC(pmevcntr0_el0)
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000419
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200420/* GICv3 System Registers */
421
422DEFINE_RENAME_SYSREG_RW_FUNCS(icc_sre_el1, ICC_SRE_EL1)
423DEFINE_RENAME_SYSREG_RW_FUNCS(icc_sre_el2, ICC_SRE_EL2)
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000424DEFINE_RENAME_SYSREG_RW_FUNCS(icc_sre_el3, ICC_SRE_EL3)
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200425DEFINE_RENAME_SYSREG_RW_FUNCS(icc_pmr_el1, ICC_PMR_EL1)
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000426DEFINE_RENAME_SYSREG_READ_FUNC(icc_rpr_el1, ICC_RPR_EL1)
427DEFINE_RENAME_SYSREG_RW_FUNCS(icc_igrpen1_el3, ICC_IGRPEN1_EL3)
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200428DEFINE_RENAME_SYSREG_RW_FUNCS(icc_igrpen1_el1, ICC_IGRPEN1_EL1)
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000429DEFINE_RENAME_SYSREG_RW_FUNCS(icc_igrpen0_el1, ICC_IGRPEN0_EL1)
430DEFINE_RENAME_SYSREG_READ_FUNC(icc_hppir0_el1, ICC_HPPIR0_EL1)
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200431DEFINE_RENAME_SYSREG_READ_FUNC(icc_hppir1_el1, ICC_HPPIR1_EL1)
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000432DEFINE_RENAME_SYSREG_READ_FUNC(icc_iar0_el1, ICC_IAR0_EL1)
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200433DEFINE_RENAME_SYSREG_READ_FUNC(icc_iar1_el1, ICC_IAR1_EL1)
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000434DEFINE_RENAME_SYSREG_WRITE_FUNC(icc_eoir0_el1, ICC_EOIR0_EL1)
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200435DEFINE_RENAME_SYSREG_WRITE_FUNC(icc_eoir1_el1, ICC_EOIR1_EL1)
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000436DEFINE_RENAME_SYSREG_WRITE_FUNC(icc_sgi0r_el1, ICC_SGI0R_EL1)
437DEFINE_RENAME_SYSREG_RW_FUNCS(icc_sgi1r, ICC_SGI1R)
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200438
johpow01b7d752a2020-10-08 17:29:11 -0500439DEFINE_RENAME_SYSREG_RW_FUNCS(amcr_el0, AMCR_EL0)
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200440DEFINE_RENAME_SYSREG_RW_FUNCS(amcgcr_el0, AMCGCR_EL0)
johpow01b7d752a2020-10-08 17:29:11 -0500441DEFINE_RENAME_SYSREG_READ_FUNC(amcfgr_el0, AMCFGR_EL0)
442DEFINE_RENAME_SYSREG_READ_FUNC(amcg1idr_el0, AMCG1IDR_EL0)
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200443DEFINE_RENAME_SYSREG_RW_FUNCS(amcntenclr0_el0, AMCNTENCLR0_EL0)
444DEFINE_RENAME_SYSREG_RW_FUNCS(amcntenset0_el0, AMCNTENSET0_EL0)
445DEFINE_RENAME_SYSREG_RW_FUNCS(amcntenclr1_el0, AMCNTENCLR1_EL0)
446DEFINE_RENAME_SYSREG_RW_FUNCS(amcntenset1_el0, AMCNTENSET1_EL0)
447
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000448DEFINE_RENAME_SYSREG_READ_FUNC(mpamidr_el1, MPAMIDR_EL1)
449DEFINE_RENAME_SYSREG_RW_FUNCS(mpam3_el3, MPAM3_EL3)
450DEFINE_RENAME_SYSREG_RW_FUNCS(mpam2_el2, MPAM2_EL2)
451DEFINE_RENAME_SYSREG_RW_FUNCS(mpamhcr_el2, MPAMHCR_EL2)
452
Manish V Badarkhe589a1122021-12-31 15:20:08 +0000453/* Static profiling control registers */
454DEFINE_RENAME_SYSREG_RW_FUNCS(pmscr_el1, PMSCR_EL1)
455DEFINE_RENAME_SYSREG_RW_FUNCS(pmsevfr_el1, PMSEVFR_EL1)
456DEFINE_RENAME_SYSREG_RW_FUNCS(pmsfcr_el1, PMSFCR_EL1)
457DEFINE_RENAME_SYSREG_RW_FUNCS(pmsicr_el1, PMSICR_EL1)
458DEFINE_RENAME_SYSREG_RW_FUNCS(pmsidr_el1, PMSIDR_EL1)
459DEFINE_RENAME_SYSREG_RW_FUNCS(pmsirr_el1, PMSIRR_EL1)
460DEFINE_RENAME_SYSREG_RW_FUNCS(pmslatfr_el1, PMSLATFR_EL1)
461DEFINE_RENAME_SYSREG_RW_FUNCS(pmsnevfr_el1, PMSNEVFR_EL1)
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000462DEFINE_RENAME_SYSREG_RW_FUNCS(pmblimitr_el1, PMBLIMITR_EL1)
Manish V Badarkhe589a1122021-12-31 15:20:08 +0000463DEFINE_RENAME_SYSREG_RW_FUNCS(pmbptr_el1, PMBPTR_EL1)
464DEFINE_RENAME_SYSREG_RW_FUNCS(pmbsr_el1, PMBSR_EL1)
465DEFINE_RENAME_SYSREG_RW_FUNCS(pmscr_el2, PMSCR_EL2)
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000466
467DEFINE_RENAME_SYSREG_WRITE_FUNC(zcr_el3, ZCR_EL3)
468DEFINE_RENAME_SYSREG_WRITE_FUNC(zcr_el2, ZCR_EL2)
469
johpow0150ccb552020-11-10 19:22:13 -0600470DEFINE_RENAME_SYSREG_READ_FUNC(id_aa64smfr0_el1, ID_AA64SMFR0_EL1)
471DEFINE_RENAME_SYSREG_RW_FUNCS(svcr, SVCR)
472DEFINE_RENAME_SYSREG_RW_FUNCS(tpidr2_el0, TPIDR2_EL0)
473DEFINE_RENAME_SYSREG_RW_FUNCS(smcr_el2, SMCR_EL2)
474
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000475DEFINE_RENAME_SYSREG_READ_FUNC(erridr_el1, ERRIDR_EL1)
476DEFINE_RENAME_SYSREG_WRITE_FUNC(errselr_el1, ERRSELR_EL1)
477
478DEFINE_RENAME_SYSREG_READ_FUNC(erxfr_el1, ERXFR_EL1)
479DEFINE_RENAME_SYSREG_RW_FUNCS(erxctlr_el1, ERXCTLR_EL1)
480DEFINE_RENAME_SYSREG_RW_FUNCS(erxstatus_el1, ERXSTATUS_EL1)
481DEFINE_RENAME_SYSREG_READ_FUNC(erxaddr_el1, ERXADDR_EL1)
482DEFINE_RENAME_SYSREG_READ_FUNC(erxmisc0_el1, ERXMISC0_EL1)
483DEFINE_RENAME_SYSREG_READ_FUNC(erxmisc1_el1, ERXMISC1_EL1)
484
Daniel Boulby39e4df22021-02-02 19:27:41 +0000485/* Armv8.1 Registers */
486DEFINE_RENAME_SYSREG_RW_FUNCS(pan, PAN)
487
Antonio Nino Diaz69068db2019-01-11 13:01:45 +0000488/* Armv8.2 Registers */
489DEFINE_RENAME_SYSREG_READ_FUNC(id_aa64mmfr2_el1, ID_AA64MMFR2_EL1)
490
Jeenu Viswambharana1c3cca2018-10-16 10:09:32 +0100491/* Armv8.3 Pointer Authentication Registers */
Joel Hutton8790f022019-03-15 14:47:02 +0000492/* Instruction keys A and B */
Antonio Nino Diaz9c9f92c2019-03-13 13:57:39 +0000493DEFINE_RENAME_SYSREG_RW_FUNCS(apiakeyhi_el1, APIAKeyHi_EL1)
494DEFINE_RENAME_SYSREG_RW_FUNCS(apiakeylo_el1, APIAKeyLo_EL1)
Jeenu Viswambharana1c3cca2018-10-16 10:09:32 +0100495
Joel Hutton8790f022019-03-15 14:47:02 +0000496DEFINE_RENAME_SYSREG_RW_FUNCS(apibkeyhi_el1, APIBKeyHi_EL1)
497DEFINE_RENAME_SYSREG_RW_FUNCS(apibkeylo_el1, APIBKeyLo_EL1)
498
499/* Data keys A and B */
500DEFINE_RENAME_SYSREG_RW_FUNCS(apdakeyhi_el1, APDAKeyHi_EL1)
501DEFINE_RENAME_SYSREG_RW_FUNCS(apdakeylo_el1, APDAKeyLo_EL1)
502
503DEFINE_RENAME_SYSREG_RW_FUNCS(apdbkeyhi_el1, APDBKeyHi_EL1)
504DEFINE_RENAME_SYSREG_RW_FUNCS(apdbkeylo_el1, APDBKeyLo_EL1)
505
506/* Generic key */
507DEFINE_RENAME_SYSREG_RW_FUNCS(apgakeyhi_el1, APGAKeyHi_EL1)
508DEFINE_RENAME_SYSREG_RW_FUNCS(apgakeylo_el1, APGAKeyLo_EL1)
509
Sandrine Bailleux277fb762019-10-08 12:10:45 +0200510/* MTE registers */
511DEFINE_RENAME_SYSREG_RW_FUNCS(tfsre0_el1, TFSRE0_EL1)
512DEFINE_RENAME_SYSREG_RW_FUNCS(tfsr_el1, TFSR_EL1)
513DEFINE_RENAME_SYSREG_RW_FUNCS(rgsr_el1, RGSR_EL1)
514DEFINE_RENAME_SYSREG_RW_FUNCS(gcr_el1, GCR_EL1)
515
Daniel Boulby39e4df22021-02-02 19:27:41 +0000516/* Armv8.4 Data Independent Timing */
517DEFINE_RENAME_SYSREG_RW_FUNCS(dit, DIT)
518
Jimmy Brisson90f1d5c2020-04-16 10:54:51 -0500519/* Armv8.6 Fine Grained Virtualization Traps Registers */
520DEFINE_RENAME_SYSREG_RW_FUNCS(hfgrtr_el2, HFGRTR_EL2)
521DEFINE_RENAME_SYSREG_RW_FUNCS(hfgwtr_el2, HFGWTR_EL2)
522DEFINE_RENAME_SYSREG_RW_FUNCS(hfgitr_el2, HFGITR_EL2)
523DEFINE_RENAME_SYSREG_RW_FUNCS(hdfgrtr_el2, HDFGRTR_EL2)
524DEFINE_RENAME_SYSREG_RW_FUNCS(hdfgwtr_el2, HDFGWTR_EL2)
525
Jimmy Brisson945095a2020-04-16 10:54:59 -0500526/* Armv8.6 Enhanced Counter Virtualization Register */
527DEFINE_RENAME_SYSREG_RW_FUNCS(cntpoff_el2, CNTPOFF_EL2)
528
Manish V Badarkhe87c03d12021-07-06 22:57:11 +0100529/* Armv9.0 Trace buffer extension System Registers */
530DEFINE_RENAME_SYSREG_RW_FUNCS(trblimitr_el1, TRBLIMITR_EL1)
531DEFINE_RENAME_SYSREG_RW_FUNCS(trbptr_el1, TRBPTR_EL1)
532DEFINE_RENAME_SYSREG_RW_FUNCS(trbbaser_el1, TRBBASER_EL1)
533DEFINE_RENAME_SYSREG_RW_FUNCS(trbsr_el1, TRBSR_EL1)
534DEFINE_RENAME_SYSREG_RW_FUNCS(trbmar_el1, TRBMAR_EL1)
535DEFINE_RENAME_SYSREG_RW_FUNCS(trbtrg_el1, TRBTRG_EL1)
536DEFINE_RENAME_SYSREG_READ_FUNC(trbidr_el1, TRBIDR_EL1)
537
johpow018c3da8b2022-01-31 18:14:41 -0600538/* FEAT_BRBE Branch record buffer extension system registers */
539DEFINE_RENAME_SYSREG_RW_FUNCS(brbcr_el1, BRBCR_EL1)
540DEFINE_RENAME_SYSREG_RW_FUNCS(brbcr_el2, BRBCR_EL2)
541DEFINE_RENAME_SYSREG_RW_FUNCS(brbfcr_el1, BRBFCR_EL1)
542DEFINE_RENAME_SYSREG_RW_FUNCS(brbts_el1, BRBTS_EL1)
543DEFINE_RENAME_SYSREG_RW_FUNCS(brbinfinj_el1, BRBINFINJ_EL1)
544DEFINE_RENAME_SYSREG_RW_FUNCS(brbsrcinj_el1, BRBSRCINJ_EL1)
545DEFINE_RENAME_SYSREG_RW_FUNCS(brbtgtinj_el1, BRBTGTINJ_EL1)
546DEFINE_RENAME_SYSREG_READ_FUNC(brbidr0_el1, BRBIDR0_EL1)
547
Manish V Badarkhe2c518e52021-07-08 16:36:57 +0100548/* Armv8.4 Trace filter control System Registers */
549DEFINE_RENAME_SYSREG_RW_FUNCS(trfcr_el1, TRFCR_EL1)
550DEFINE_RENAME_SYSREG_RW_FUNCS(trfcr_el2, TRFCR_EL2)
551
Manish V Badarkhe6d0e1b62021-07-09 13:58:28 +0100552/* Trace System Registers */
553DEFINE_RENAME_SYSREG_RW_FUNCS(trcauxctlr, TRCAUXCTLR)
554DEFINE_RENAME_SYSREG_RW_FUNCS(trcrsr, TRCRSR)
555DEFINE_RENAME_SYSREG_RW_FUNCS(trcbbctlr, TRCBBCTLR)
556DEFINE_RENAME_SYSREG_RW_FUNCS(trcccctlr, TRCCCCTLR)
557DEFINE_RENAME_SYSREG_RW_FUNCS(trcextinselr0, TRCEXTINSELR0)
558DEFINE_RENAME_SYSREG_RW_FUNCS(trcextinselr1, TRCEXTINSELR1)
559DEFINE_RENAME_SYSREG_RW_FUNCS(trcextinselr2, TRCEXTINSELR2)
560DEFINE_RENAME_SYSREG_RW_FUNCS(trcextinselr3, TRCEXTINSELR3)
561DEFINE_RENAME_SYSREG_RW_FUNCS(trcclaimset, TRCCLAIMSET)
562DEFINE_RENAME_SYSREG_RW_FUNCS(trcclaimclr, TRCCLAIMCLR)
563DEFINE_RENAME_SYSREG_READ_FUNC(trcdevarch, TRCDEVARCH)
564
johpow01d0bbe6e2021-11-11 16:13:32 -0600565/* FEAT_HCX HCRX_EL2 */
566DEFINE_RENAME_SYSREG_RW_FUNCS(hcrx_el2, HCRX_EL2)
567
Manish V Badarkhe82e1a252022-01-04 13:45:31 +0000568/* Control floating point behaviour */
569DEFINE_RENAME_SYSREG_RW_FUNCS(fpcr, FPCR)
570
Manish V Badarkheb31bc752021-12-24 08:52:52 +0000571/* ID_AA64ISAR2_EL1 */
572DEFINE_RENAME_SYSREG_READ_FUNC(id_aa64isar2_el1, ID_AA64ISAR2_EL1)
573
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200574#define IS_IN_EL(x) \
575 (GET_EL(read_CurrentEl()) == MODE_EL##x)
576
577#define IS_IN_EL1() IS_IN_EL(1)
578#define IS_IN_EL2() IS_IN_EL(2)
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000579#define IS_IN_EL3() IS_IN_EL(3)
Sandrine Bailleux3cd87d72018-10-09 11:12:55 +0200580
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000581static inline unsigned int get_current_el(void)
582{
583 return GET_EL(read_CurrentEl());
584}
585
586/*
587 * Check if an EL is implemented from AA64PFR0 register fields.
588 */
589static inline uint64_t el_implemented(unsigned int el)
590{
591 if (el > 3U) {
592 return EL_IMPL_NONE;
593 } else {
594 unsigned int shift = ID_AA64PFR0_EL1_SHIFT * el;
595
596 return (read_id_aa64pfr0_el1() >> shift) & ID_AA64PFR0_ELX_MASK;
597 }
598}
599
Sandrine Bailleuxd01a4c62018-12-20 14:44:13 +0100600/* Read the count value of the system counter. */
601static inline uint64_t syscounter_read(void)
602{
603 /*
604 * The instruction barrier is needed to guarantee that we read an
605 * accurate value. Otherwise, the CPU might speculatively read it and
606 * return a stale value.
607 */
608 isb();
609 return read_cntpct_el0();
610}
611
Madhukar Pappireddya09d5f72021-10-26 14:50:52 -0500612/* Read the value of the Counter-timer virtual count. */
613static inline uint64_t virtualcounter_read(void)
614{
615 /*
616 * The instruction barrier is needed to guarantee that we read an
617 * accurate value. Otherwise, the CPU might speculatively read it and
618 * return a stale value.
619 */
620 isb();
621 return read_cntvct_el0();
622}
623
Antonio Nino Diazdcfc4832018-11-22 15:53:23 +0000624#endif /* ARCH_HELPERS_H */