mirror of
https://github.com/ARM-software/arm-trusted-firmware.git
synced 2025-04-16 09:34:18 +00:00
b30646a8f7
There are some platforms which uses MPIDR Affinity level 3 for storing extra affinity information e.g. N1SDP uses it for keeping chip id in a multichip setup, for such platforms MPIDR validation should not fail. This patch adds Aff3 bits also as part of mpidr validation mask, for platforms which does not uses Aff3 will not have any impact as these bits will be all zeros. Change-Id: Ia8273972fa7948fdb11708308d0239d2dc4dfa85 Signed-off-by: Manish Pandey <manish.pandey2@arm.com>
58 lines
1.7 KiB
C
58 lines
1.7 KiB
C
/*
|
|
* Copyright (c) 2015-2019, ARM Limited and Contributors. All rights reserved.
|
|
*
|
|
* SPDX-License-Identifier: BSD-3-Clause
|
|
*/
|
|
|
|
#include <platform_def.h>
|
|
|
|
#include <arch.h>
|
|
#include <plat/arm/common/plat_arm.h>
|
|
|
|
/*******************************************************************************
|
|
* This function validates an MPIDR by checking whether it falls within the
|
|
* acceptable bounds. An error code (-1) is returned if an incorrect mpidr
|
|
* is passed.
|
|
******************************************************************************/
|
|
int arm_check_mpidr(u_register_t mpidr)
|
|
{
|
|
unsigned int cluster_id, cpu_id;
|
|
uint64_t valid_mask;
|
|
|
|
#if ARM_PLAT_MT
|
|
unsigned int pe_id;
|
|
|
|
valid_mask = ~(MPIDR_AFFLVL_MASK |
|
|
(MPIDR_AFFLVL_MASK << MPIDR_AFF1_SHIFT) |
|
|
(MPIDR_AFFLVL_MASK << MPIDR_AFF2_SHIFT) |
|
|
(MPIDR_AFFLVL_MASK << MPIDR_AFF3_SHIFT));
|
|
cluster_id = (mpidr >> MPIDR_AFF2_SHIFT) & MPIDR_AFFLVL_MASK;
|
|
cpu_id = (mpidr >> MPIDR_AFF1_SHIFT) & MPIDR_AFFLVL_MASK;
|
|
pe_id = (mpidr >> MPIDR_AFF0_SHIFT) & MPIDR_AFFLVL_MASK;
|
|
#else
|
|
valid_mask = ~(MPIDR_CLUSTER_MASK | MPIDR_CPU_MASK);
|
|
cluster_id = (unsigned int) ((mpidr >> MPIDR_AFF1_SHIFT) &
|
|
MPIDR_AFFLVL_MASK);
|
|
cpu_id = (unsigned int) ((mpidr >> MPIDR_AFF0_SHIFT) &
|
|
MPIDR_AFFLVL_MASK);
|
|
#endif /* ARM_PLAT_MT */
|
|
|
|
mpidr &= MPIDR_AFFINITY_MASK;
|
|
if ((mpidr & valid_mask) != 0U)
|
|
return -1;
|
|
|
|
if (cluster_id >= PLAT_ARM_CLUSTER_COUNT)
|
|
return -1;
|
|
|
|
/* Validate cpu_id by checking whether it represents a CPU in
|
|
one of the two clusters present on the platform. */
|
|
if (cpu_id >= plat_arm_get_cluster_core_count(mpidr))
|
|
return -1;
|
|
|
|
#if ARM_PLAT_MT
|
|
if (pe_id >= plat_arm_get_cpu_pe_count(mpidr))
|
|
return -1;
|
|
#endif /* ARM_PLAT_MT */
|
|
|
|
return 0;
|
|
}
|