michaelh/zephyr
1
0
Fork 0
Code Releases Activity

aarch64: lib_helpers: Introduce helpers for common assembly operations

Browse source 
Introduce C helpers for common assembly operations and preprocessor
constructors to create helper functions to read / write system
registers.

Signed-off-by: Carlo Caione <ccaione@baylibre.com>
This commit is contained in:
Carlo Caione 2021-02-17 11:20:27 +01:00 • committed by Anas Nashif
commit 708b9b4cc9
1 changed files with 141 additions and 0 deletions
Download patch file Download diff file Expand all files Collapse all files

141
include/arch/arm/aarch64/lib_helpers.h Normal file
View file

@ -0,0 +1,141 @@
/*
* Copyright (c) 2021 Carlo Caione <ccaione@baylibre.com>
*
* SPDX-License-Identifier: Apache-2.0
*/
#ifndef ZEPHYR_INCLUDE_ARCH_ARM_AARCH64_LIB_HELPERS_H_
#define ZEPHYR_INCLUDE_ARCH_ARM_AARCH64_LIB_HELPERS_H_
#ifndef _ASMLANGUAGE
#include <arch/arm/aarch64/cpu.h>
#include <stdint.h>
/* All the macros need a memory clobber */
#define read_sysreg(reg) \
({ \
uint64_t val; \
__asm__ volatile ("mrs %0, " STRINGIFY(reg) \
: "=r" (val) :: "memory"); \
val; \
})
#define write_sysreg(val, reg) \
({ \
__asm__ volatile ("msr " STRINGIFY(reg) ", %0" \
:: "r" (val) : "memory"); \
})
#define zero_sysreg(reg) \
({ \
__asm__ volatile ("msr " STRINGIFY(reg) ", xzr" \
::: "memory"); \
})
#define MAKE_REG_HELPER(reg) \
static ALWAYS_INLINE uint64_t read_##reg(void) \
{ \
return read_sysreg(reg); \
} \
static ALWAYS_INLINE void write_##reg(uint64_t val) \
{ \
write_sysreg(val, reg); \
} \
static ALWAYS_INLINE void zero_##reg(void) \
{ \
zero_sysreg(reg); \
}
#define MAKE_REG_HELPER_EL123(reg) \
MAKE_REG_HELPER(reg##_el1) \
MAKE_REG_HELPER(reg##_el2) \
MAKE_REG_HELPER(reg##_el3)
MAKE_REG_HELPER(cntfrq_el0);
MAKE_REG_HELPER(cnthctl_el2);
MAKE_REG_HELPER(cnthp_ctl_el2);
MAKE_REG_HELPER(cntv_ctl_el0)
MAKE_REG_HELPER(cntv_cval_el0)
MAKE_REG_HELPER(cntvct_el0);
MAKE_REG_HELPER(cntvoff_el2);
MAKE_REG_HELPER(currentel);
MAKE_REG_HELPER(daif)
MAKE_REG_HELPER(hcr_el2);
MAKE_REG_HELPER(id_aa64pfr0_el1);
MAKE_REG_HELPER(scr_el3);
MAKE_REG_HELPER_EL123(actlr)
MAKE_REG_HELPER_EL123(cpacr)
MAKE_REG_HELPER_EL123(cptr)
MAKE_REG_HELPER_EL123(elr)
MAKE_REG_HELPER_EL123(esr)
MAKE_REG_HELPER_EL123(far)
MAKE_REG_HELPER_EL123(mair)
MAKE_REG_HELPER_EL123(sctlr)
MAKE_REG_HELPER_EL123(spsr)
MAKE_REG_HELPER_EL123(tcr)
MAKE_REG_HELPER_EL123(ttbr0)
MAKE_REG_HELPER_EL123(vbar)
static ALWAYS_INLINE void enable_debug_exceptions(void)
{
__asm__ volatile ("msr DAIFClr, %0"
:: "i" (DAIFCLR_DBG_BIT) : "memory");
}
static ALWAYS_INLINE void disable_debug_exceptions(void)
{
__asm__ volatile ("msr DAIFSet, %0"
:: "i" (DAIFSET_DBG_BIT) : "memory");
}
static ALWAYS_INLINE void enable_serror_exceptions(void)
{
__asm__ volatile ("msr DAIFClr, %0"
:: "i" (DAIFCLR_ABT_BIT) : "memory");
}
static ALWAYS_INLINE void disable_serror_exceptions(void)
{
__asm__ volatile ("msr DAIFSet, %0"
:: "i" (DAIFSET_ABT_BIT) : "memory");
}
static ALWAYS_INLINE void enable_irq(void)
{
__asm__ volatile ("msr DAIFClr, %0"
:: "i" (DAIFCLR_IRQ_BIT) : "memory");
}
static ALWAYS_INLINE void disable_irq(void)
{
__asm__ volatile ("msr DAIFSet, %0"
:: "i" (DAIFSET_IRQ_BIT) : "memory");
}
static ALWAYS_INLINE void enable_fiq(void)
{
__asm__ volatile ("msr DAIFClr, %0"
:: "i" (DAIFCLR_FIQ_BIT) : "memory");
}
static ALWAYS_INLINE void disable_fiq(void)
{
__asm__ volatile ("msr DAIFSet, %0"
:: "i" (DAIFSET_FIQ_BIT) : "memory");
}
#define dsb() __asm__ volatile ("dsb sy" ::: "memory")
#define dmb() __asm__ volatile ("dmb sy" ::: "memory")
#define isb() __asm__ volatile ("isb" ::: "memory")
/* Zephyr needs these as well */
#define __ISB() isb()
#define __DMB() dmb()
#define __DSB() dsb()
#endif /* !_ASMLANGUAGE */
#endif /* ZEPHYR_INCLUDE_ARCH_ARM_AARCH64_LIB_HELPERS_H_ */