Debian Codegraph @

plat/arm/board/arm_fpga/fpga_topology.c

raw
1 /*
2 * Copyright (c) 2020, ARM Limited and Contributors. All rights reserved.
3 *
4 * SPDX-License-Identifier: BSD-3-Clause
5 */
6
7 #include <arch_helpers.h>
8 #include <common/debug.h>
9 #include <lib/spinlock.h>
10
11 #include "fpga_private.h"
12 #include <plat/common/platform.h>
13 #include <platform_def.h>
14
15 unsigned char fpga_power_domain_tree_desc[FPGA_MAX_CLUSTER_COUNT + 2];
16 unsigned char fpga_valid_mpids[PLATFORM_CORE_COUNT];
17
18 const unsigned char *plat_get_power_domain_tree_desc(void)
19 {
20 unsigned int i;
21
22 /*
23 * The highest level is the system level. The next level is constituted
24 * by clusters and then cores in clusters.
25 *
26 * This description of the power domain topology is aligned with the CPU
27 * indices returned by the plat_core_pos_by_mpidr() and plat_my_core_pos()
28 * APIs.
29 *
30 * A description of the topology tree can be found at
31 * https://trustedfirmware-a.readthedocs.io/en/latest/design/psci-pd-tree.html#design
32 */
33
34 if (fpga_power_domain_tree_desc[0] == 0U) {
35 /*
36 * As fpga_power_domain_tree_desc[0] == 0, assume that the
37 * Power Domain Topology Tree has not been initialized, so
38 * perform the initialization here.
39 */
40
41 fpga_power_domain_tree_desc[0] = 1U;
42 fpga_power_domain_tree_desc[1] = FPGA_MAX_CLUSTER_COUNT;
43
44 for (i = 0U; i < FPGA_MAX_CLUSTER_COUNT; i++) {
45 fpga_power_domain_tree_desc[2 + i] =
46 (FPGA_MAX_CPUS_PER_CLUSTER *
47 FPGA_MAX_PE_PER_CPU);
48 }
49 }
50
51 return fpga_power_domain_tree_desc;
52 }
53
54 int plat_core_pos_by_mpidr(u_register_t mpidr)
55 {
56 unsigned int core_pos;
57
58 mpidr &= (MPID_MASK & ~(MPIDR_AFFLVL_MASK << MPIDR_AFF3_SHIFT));
59 mpidr |= (read_mpidr_el1() & MPIDR_MT_MASK);
60
61 if ((MPIDR_AFFLVL2_VAL(mpidr) >= FPGA_MAX_CLUSTER_COUNT) ||
62 (MPIDR_AFFLVL1_VAL(mpidr) >= FPGA_MAX_CPUS_PER_CLUSTER) ||
63 (MPIDR_AFFLVL0_VAL(mpidr) >= FPGA_MAX_PE_PER_CPU)) {
64 ERROR ("Invalid mpidr: 0x%08x\n", (uint32_t)mpidr);
65 panic();
66 }
67
68 /* Calculate the core position, based on the maximum topology. */
69 core_pos = plat_fpga_calc_core_pos(mpidr);
70
71 /* Check whether this core is actually present. */
72 if (fpga_valid_mpids[core_pos] != VALID_MPID) {
73 return -1;
74 }
75
76 return core_pos;
77 }