Djam/arm-trusted-firmware
1
0
Fork 0
mirror of https://github.com/ARM-software/arm-trusted-firmware.git synced 2025-04-23 21:44:15 +00:00
Code Issues Projects Releases Packages Wiki Activity Actions

feat(stm32mp2): add plat_my_core_pos

Browse source 
This function is required, at least for bakery locks.

Change-Id: I28906c50e0a0ebff5d387a424247513ec1a599fc
Signed-off-by: Yann Gautier <yann.gautier@st.com>
This commit is contained in:
Yann Gautier 2023-09-22 13:58:11 +02:00
parent 4da462dcdc
commit d1c85da8ef
1 changed files with 26 additions and 0 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

26
plat/st/stm32mp2/aarch64/stm32mp2_helper.S
View file

@ -14,6 +14,7 @@
.globl platform_mem_init .globl platform_mem_init
.globl plat_secondary_cold_boot_setup .globl plat_secondary_cold_boot_setup
.globl plat_is_my_cpu_primary .globl plat_is_my_cpu_primary
.globl plat_my_core_pos
.globl plat_crash_console_init .globl plat_crash_console_init
.globl plat_crash_console_flush .globl plat_crash_console_flush
.globl plat_crash_console_putc .globl plat_crash_console_putc
@ -50,6 +51,31 @@ func plat_is_my_cpu_primary
ret ret
endfunc plat_is_my_cpu_primary endfunc plat_is_my_cpu_primary
/* -----------------------------------------------------------
* unsigned int plat_stm32mp_get_core_pos(u_register_t mpidr)
* Helper function to calculate the core position.
* With this function: CorePos = (ClusterId * 4) +
* CoreId
* -----------------------------------------------------------
*/
func plat_stm32mp_get_core_pos
and x1, x0, #MPIDR_CPU_MASK
and x0, x0, #MPIDR_CLUSTER_MASK
add x0, x1, x0, LSR #6
ret
endfunc plat_stm32mp_get_core_pos
/* -----------------------------------------------------
* unsigned int plat_my_core_pos(void)
* This function uses the plat_stm32mp_get_core_pos()
* definition to get the index of the calling CPU.
* -----------------------------------------------------
*/
func plat_my_core_pos
mrs x0, mpidr_el1
b plat_stm32mp_get_core_pos
endfunc plat_my_core_pos
/* --------------------------------------------- /* ---------------------------------------------
* int plat_crash_console_init(void) * int plat_crash_console_init(void)
* *