Line data    Source code

       1            0 : /*
       2              :  * Copyright 2020 NXP
       3              :  *
       4              :  * SPDX-License-Identifier: Apache-2.0
       5              :  */
       6              : 
       7              : #ifndef ZEPHYR_INCLUDE_ARCH_ARM64_ARCH_INLINES_H
       8              : #define ZEPHYR_INCLUDE_ARCH_ARM64_ARCH_INLINES_H
       9              : 
      10              : #ifndef _ASMLANGUAGE
      11              : 
      12              : #include <zephyr/kernel_structs.h>
      13              : #include <zephyr/arch/arm64/lib_helpers.h>
      14              : #include <zephyr/arch/arm64/tpidrro_el0.h>
      15              : #include <zephyr/sys/__assert.h>
      16              : 
      17              : /* Note: keep in sync with `get_cpu` in arch/arm64/core/macro_priv.inc */
      18            0 : static ALWAYS_INLINE _cpu_t *arch_curr_cpu(void)
      19              : {
      20              :         return (_cpu_t *)(read_tpidrro_el0() & TPIDRROEL0_CURR_CPU);
      21              : }
      22              : 
      23            0 : static ALWAYS_INLINE int arch_exception_depth(void)
      24              : {
      25              :         return (read_tpidrro_el0() & TPIDRROEL0_EXC_DEPTH) / TPIDRROEL0_EXC_UNIT;
      26              : }
      27              : 
      28            0 : static ALWAYS_INLINE uint32_t arch_proc_id(void)
      29              : {
      30              :         uint64_t cpu_mpid = read_mpidr_el1();
      31              : 
      32              :         __ASSERT(cpu_mpid == (uint32_t)cpu_mpid, "mpid extends past 32 bits");
      33              : 
      34              :         return (uint32_t)cpu_mpid;
      35              : }
      36              : 
      37            0 : static ALWAYS_INLINE unsigned int arch_num_cpus(void)
      38              : {
      39              :         return CONFIG_MP_MAX_NUM_CPUS;
      40              : }
      41              : 
      42              : #endif /* !_ASMLANGUAGE */
      43              : #endif /* ZEPHYR_INCLUDE_ARCH_ARM64_ARCH_INLINES_H */