1 /*
2  * Copyright (c) 2019, ARM Limited and Contributors. All rights reserved.
3  *
4  * SPDX-License-Identifier: BSD-3-Clause
5  */
6 
7 #include <arch.h>
8 #include <platform_def.h>
9 #include <lib/psci/psci.h>
10 
11 static const unsigned char plat_power_domain_tree_desc[] = {1, 4};
12 
13 /*******************************************************************************
14  * This function returns the default topology tree information.
15  ******************************************************************************/
plat_get_power_domain_tree_desc(void)16 const unsigned char *plat_get_power_domain_tree_desc(void)
17 {
18 	return plat_power_domain_tree_desc;
19 }
20 
21 /*******************************************************************************
22  * This function implements a part of the critical interface between the psci
23  * generic layer and the platform that allows the former to query the platform
24  * to convert an MPIDR to a unique linear index. An error code (-1) is returned
25  * in case the MPIDR is invalid.
26  ******************************************************************************/
plat_core_pos_by_mpidr(u_register_t mpidr)27 int plat_core_pos_by_mpidr(u_register_t mpidr)
28 {
29 	unsigned int cluster_id, cpu_id;
30 
31 	mpidr &= MPIDR_AFFINITY_MASK;
32 
33 	if (mpidr & ~(MPIDR_CLUSTER_MASK | MPIDR_CPU_MASK))
34 		return -1;
35 
36 	cluster_id = (mpidr >> MPIDR_AFF1_SHIFT) & MPIDR_AFFLVL_MASK;
37 	cpu_id = (mpidr >> MPIDR_AFF0_SHIFT) & MPIDR_AFFLVL_MASK;
38 
39 	if (cluster_id >= PLATFORM_CLUSTER_COUNT)
40 		return -1;
41 
42 	/*
43 	 * Validate cpu_id by checking whether it represents a CPU in
44 	 * one of the two clusters present on the platform.
45 	 */
46 	if (cpu_id >= PLATFORM_MAX_CPUS_PER_CLUSTER)
47 		return -1;
48 
49 	return (cpu_id + (cluster_id * 4));
50 }
51 
52