diff options
author | Dimitris Papastamos <dimitris.papastamos@arm.com> | 2018-04-12 10:47:14 +0100 |
---|---|---|
committer | GitHub <noreply@github.com> | 2018-04-12 10:47:14 +0100 |
commit | 0f17a683246e20869395223215bb5e2f4fb1d81e (patch) | |
tree | 83fc8ccf5bf629331face46cb83e6404afb49022 /plat | |
parent | aa2fcb43994c0a8cf92b4fc351f4491664255b88 (diff) | |
parent | 468bea41283206f1976292bb49cfcd9f5767e152 (diff) | |
download | platform_external_arm-trusted-firmware-0f17a683246e20869395223215bb5e2f4fb1d81e.tar.gz platform_external_arm-trusted-firmware-0f17a683246e20869395223215bb5e2f4fb1d81e.tar.bz2 platform_external_arm-trusted-firmware-0f17a683246e20869395223215bb5e2f4fb1d81e.zip |
Merge pull request #1347 from davidcunado-arm/dc/affinities
FVP: Fix function for translating MPIDR to linear index
Diffstat (limited to 'plat')
-rw-r--r-- | plat/arm/board/fvp/aarch32/fvp_helpers.S | 22 |
1 files changed, 14 insertions, 8 deletions
diff --git a/plat/arm/board/fvp/aarch32/fvp_helpers.S b/plat/arm/board/fvp/aarch32/fvp_helpers.S index 143972d26..5d8854698 100644 --- a/plat/arm/board/fvp/aarch32/fvp_helpers.S +++ b/plat/arm/board/fvp/aarch32/fvp_helpers.S @@ -104,15 +104,20 @@ func plat_is_my_cpu_primary bx lr endfunc plat_is_my_cpu_primary - /* ----------------------------------------------------- + /* --------------------------------------------------------------------- * unsigned int plat_arm_calc_core_pos(u_register_t mpidr) * * Function to calculate the core position on FVP. * - * (ClusterId * FVP_MAX_CPUS_PER_CLUSTER) + + * (ClusterId * FVP_MAX_CPUS_PER_CLUSTER * FVP_MAX_PE_PER_CPU) + * (CPUId * FVP_MAX_PE_PER_CPU) + * ThreadId - * ----------------------------------------------------- + * + * which can be simplified as: + * + * ((ClusterId * FVP_MAX_CPUS_PER_CLUSTER + CPUId) * FVP_MAX_PE_PER_CPU) + * + ThreadId + * --------------------------------------------------------------------- */ func plat_arm_calc_core_pos mov r3, r0 @@ -125,14 +130,15 @@ func plat_arm_calc_core_pos lsleq r3, r0, #MPIDR_AFFINITY_BITS /* Extract individual affinity fields from MPIDR */ - mov r2, #FVP_MAX_PE_PER_CPU ubfx r0, r3, #MPIDR_AFF0_SHIFT, #MPIDR_AFFINITY_BITS ubfx r1, r3, #MPIDR_AFF1_SHIFT, #MPIDR_AFFINITY_BITS - mla r0, r1, r2, r0 - - mov r1, #FVP_MAX_CPUS_PER_CLUSTER ubfx r2, r3, #MPIDR_AFF2_SHIFT, #MPIDR_AFFINITY_BITS - mla r0, r1, r2, r0 + + /* Compute linear position */ + mov r3, #FVP_MAX_CPUS_PER_CLUSTER + mla r1, r2, r3, r1 + mov r3, #FVP_MAX_PE_PER_CPU + mla r0, r1, r3, r0 bx lr endfunc plat_arm_calc_core_pos |