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