xref: /optee_os/core/arch/arm/plat-marvell/otx2/core_pos.S (revision 681a92d32b969f5d1e997c63d83452873143f78d)
1/* SPDX-License-Identifier: BSD-2-Clause */
2/*
3 * Copyright (c) 2020, Marvell International Ltd.
4 */
5
6#include <asm.S>
7#include <arm.h>
8
9FUNC get_core_pos_mpidr , :
10	ubfx	x1, x0, #MPIDR_AFF0_SHIFT, #MPIDR_AFFINITY_BITS
11	mov	x2, #CFG_CLUSTERS_PER_NODE
12	mul	x1, x1, x2
13	ubfx	x2, x0, #MPIDR_AFF1_SHIFT, #MPIDR_AFFINITY_BITS
14	add	x0, x1, x2
15	ret
16END_FUNC get_core_pos_mpidr
17