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 const unsigned char mtk_power_domain_tree_desc[] = { 12 /* Number of root nodes */ 13 PLATFORM_SYSTEM_COUNT, 14 /* Number of children for the root node */ 15 PLATFORM_CLUSTER_COUNT, 16 /* Number of children for the first cluster node */ 17 PLATFORM_CLUSTER0_CORE_COUNT, 18 /* Number of children for the second cluster node */ 19 PLATFORM_CLUSTER1_CORE_COUNT 20 }; 21 22 /******************************************************************************* 23 * This function returns the MT8173 default topology tree information. 24 ******************************************************************************/ plat_get_power_domain_tree_desc(void)25const unsigned char *plat_get_power_domain_tree_desc(void) 26 { 27 return mtk_power_domain_tree_desc; 28 } 29 30 /******************************************************************************* 31 * This function implements a part of the critical interface between the psci 32 * generic layer and the platform that allows the former to query the platform 33 * to convert an MPIDR to a unique linear index. An error code (-1) is returned 34 * in case the MPIDR is invalid. 35 ******************************************************************************/ plat_core_pos_by_mpidr(u_register_t mpidr)36int plat_core_pos_by_mpidr(u_register_t mpidr) 37 { 38 unsigned int cluster_id, cpu_id; 39 40 mpidr &= MPIDR_AFFINITY_MASK; 41 42 if (mpidr & ~(MPIDR_CLUSTER_MASK | MPIDR_CPU_MASK)) 43 return -1; 44 45 cluster_id = (mpidr >> MPIDR_AFF1_SHIFT) & MPIDR_AFFLVL_MASK; 46 cpu_id = (mpidr >> MPIDR_AFF0_SHIFT) & MPIDR_AFFLVL_MASK; 47 48 if (cluster_id >= PLATFORM_CLUSTER_COUNT) 49 return -1; 50 51 /* 52 * Validate cpu_id by checking whether it represents a CPU in 53 * one of the two clusters present on the platform. 54 */ 55 if (cpu_id >= PLATFORM_MAX_CPUS_PER_CLUSTER) 56 return -1; 57 58 return (cpu_id + (cluster_id * 4)); 59 } 60