xref: /rk3399_ARM-atf/plat/arm/common/arm_topology.c (revision 432b9905d5e8bcf47a077bcda97f98538cee1034)
1 /*
2  * Copyright (c) 2015, ARM Limited and Contributors. All rights reserved.
3  *
4  * Redistribution and use in source and binary forms, with or without
5  * modification, are permitted provided that the following conditions are met:
6  *
7  * Redistributions of source code must retain the above copyright notice, this
8  * list of conditions and the following disclaimer.
9  *
10  * Redistributions in binary form must reproduce the above copyright notice,
11  * this list of conditions and the following disclaimer in the documentation
12  * and/or other materials provided with the distribution.
13  *
14  * Neither the name of ARM nor the names of its contributors may be used
15  * to endorse or promote products derived from this software without specific
16  * prior written permission.
17  *
18  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
19  * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
20  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
21  * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE
22  * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
23  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
24  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
25  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
26  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
27  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
28  * POSSIBILITY OF SUCH DAMAGE.
29  */
30 
31 #include <arch.h>
32 #include <psci.h>
33 #include <plat_arm.h>
34 #include <platform_def.h>
35 
36 #define get_arm_cluster_core_count(mpidr)\
37 		(((mpidr) & 0x100) ? PLAT_ARM_CLUSTER1_CORE_COUNT :\
38 				PLAT_ARM_CLUSTER0_CORE_COUNT)
39 
40 /* The power domain tree descriptor which need to be exported by ARM platforms */
41 extern const unsigned char arm_power_domain_tree_desc[];
42 
43 
44 /*******************************************************************************
45  * This function returns the ARM default topology tree information.
46  ******************************************************************************/
47 const unsigned char *plat_get_power_domain_tree_desc(void)
48 {
49 	return arm_power_domain_tree_desc;
50 }
51 
52 /*******************************************************************************
53  * This function validates an MPIDR by checking whether it falls within the
54  * acceptable bounds. An error code (-1) is returned if an incorrect mpidr
55  * is passed.
56  ******************************************************************************/
57 int arm_check_mpidr(u_register_t mpidr)
58 {
59 	unsigned int cluster_id, cpu_id;
60 
61 	mpidr &= MPIDR_AFFINITY_MASK;
62 
63 	if (mpidr & ~(MPIDR_CLUSTER_MASK | MPIDR_CPU_MASK))
64 		return -1;
65 
66 	cluster_id = (mpidr >> MPIDR_AFF1_SHIFT) & MPIDR_AFFLVL_MASK;
67 	cpu_id = (mpidr >> MPIDR_AFF0_SHIFT) & MPIDR_AFFLVL_MASK;
68 
69 	if (cluster_id >= ARM_CLUSTER_COUNT)
70 		return -1;
71 
72 	/* Validate cpu_id by checking whether it represents a CPU in
73 	   one of the two clusters present on the platform. */
74 	if (cpu_id >= get_arm_cluster_core_count(mpidr))
75 		return -1;
76 
77 	return 0;
78 }
79