xref: /aosp_15_r20/external/arm-trusted-firmware/plat/renesas/common/plat_topology.c (revision 54fd6939e177f8ff529b10183254802c76df6d08)
1*54fd6939SJiyong Park /*
2*54fd6939SJiyong Park  * Copyright (c) 2018, Renesas Electronics Corporation. All rights reserved.
3*54fd6939SJiyong Park  *
4*54fd6939SJiyong Park  * SPDX-License-Identifier: BSD-3-Clause
5*54fd6939SJiyong Park  */
6*54fd6939SJiyong Park 
7*54fd6939SJiyong Park #include <platform_def.h>
8*54fd6939SJiyong Park 
9*54fd6939SJiyong Park #include <common/debug.h>
10*54fd6939SJiyong Park #include <lib/psci/psci.h>
11*54fd6939SJiyong Park 
12*54fd6939SJiyong Park static const unsigned char rcar_power_domain_tree_desc[] = {
13*54fd6939SJiyong Park 	1,
14*54fd6939SJiyong Park 	PLATFORM_CLUSTER_COUNT,
15*54fd6939SJiyong Park 	PLATFORM_CLUSTER0_CORE_COUNT,
16*54fd6939SJiyong Park 	PLATFORM_CLUSTER1_CORE_COUNT
17*54fd6939SJiyong Park };
18*54fd6939SJiyong Park 
plat_get_power_domain_tree_desc(void)19*54fd6939SJiyong Park const unsigned char *plat_get_power_domain_tree_desc(void)
20*54fd6939SJiyong Park {
21*54fd6939SJiyong Park 	return rcar_power_domain_tree_desc;
22*54fd6939SJiyong Park }
23*54fd6939SJiyong Park 
plat_core_pos_by_mpidr(u_register_t mpidr)24*54fd6939SJiyong Park int plat_core_pos_by_mpidr(u_register_t mpidr)
25*54fd6939SJiyong Park {
26*54fd6939SJiyong Park 	unsigned int cluster_id, cpu_id;
27*54fd6939SJiyong Park 
28*54fd6939SJiyong Park 	mpidr &= MPIDR_AFFINITY_MASK;
29*54fd6939SJiyong Park 
30*54fd6939SJiyong Park 	if (mpidr & ~(MPIDR_CLUSTER_MASK | MPIDR_CPU_MASK))
31*54fd6939SJiyong Park 		return -1;
32*54fd6939SJiyong Park 
33*54fd6939SJiyong Park 	cluster_id = (mpidr >> MPIDR_AFF1_SHIFT) & MPIDR_AFFLVL_MASK;
34*54fd6939SJiyong Park 	cpu_id = (mpidr >> MPIDR_AFF0_SHIFT) & MPIDR_AFFLVL_MASK;
35*54fd6939SJiyong Park 
36*54fd6939SJiyong Park 	if (cluster_id >= PLATFORM_CLUSTER_COUNT)
37*54fd6939SJiyong Park 		return -1;
38*54fd6939SJiyong Park 
39*54fd6939SJiyong Park 	if (cluster_id == 0 && cpu_id >= PLATFORM_CLUSTER0_CORE_COUNT)
40*54fd6939SJiyong Park 		return -1;
41*54fd6939SJiyong Park 
42*54fd6939SJiyong Park 	if (cluster_id == 1 && cpu_id >= PLATFORM_CLUSTER1_CORE_COUNT)
43*54fd6939SJiyong Park 		return -1;
44*54fd6939SJiyong Park 
45*54fd6939SJiyong Park 	return (cpu_id + cluster_id * PLATFORM_CLUSTER0_CORE_COUNT);
46*54fd6939SJiyong Park }
47*54fd6939SJiyong Park 
48