1 /*
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 */
arch_curr_cpu(void)18 static ALWAYS_INLINE _cpu_t *arch_curr_cpu(void)
19 {
20 	return (_cpu_t *)(read_tpidrro_el0() & TPIDRROEL0_CURR_CPU);
21 }
22 
arch_exception_depth(void)23 static ALWAYS_INLINE int arch_exception_depth(void)
24 {
25 	return (read_tpidrro_el0() & TPIDRROEL0_EXC_DEPTH) / TPIDRROEL0_EXC_UNIT;
26 }
27 
arch_proc_id(void)28 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 
arch_num_cpus(void)37 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 */
44