Debian Codegraph @

plat/arm/board/neoverse_rd/platform/rdv3/rdv3_bl31_setup.c

raw
1 /*
2 * Copyright (c) 2024, Arm Limited and Contributors. All rights reserved.
3 *
4 * SPDX-License-Identifier: BSD-3-Clause
5 */
6
7 #include <common/debug.h>
8 #include <drivers/arm/gic600_multichip.h>
9 #include <drivers/arm/rse_comms.h>
10 #include <drivers/arm/smmu_v3.h>
11
12 #include <plat/arm/common/plat_arm.h>
13 #include <plat/common/platform.h>
14 #include <nrd_plat.h>
15 #include <nrd_variant.h>
16 #include <rdv3_rse_comms.h>
17
18 #if (NRD_PLATFORM_VARIANT == 2)
19 static const mmap_region_t rdv3mc_dynamic_mmap[] = {
20 #if NRD_CHIP_COUNT > 1
21 NRD_CSS_SHARED_RAM_MMAP(1),
22 NRD_CSS_PERIPH_MMAP(1),
23 #endif
24 #if NRD_CHIP_COUNT > 2
25 NRD_CSS_SHARED_RAM_MMAP(2),
26 NRD_CSS_PERIPH_MMAP(2),
27 #endif
28 #if NRD_CHIP_COUNT > 3
29 NRD_CSS_SHARED_RAM_MMAP(3),
30 NRD_CSS_PERIPH_MMAP(3),
31 #endif
32 };
33
34 static struct gic600_multichip_data rdv3mc_multichip_data __init = {
35 .rt_owner_base = PLAT_ARM_GICD_BASE,
36 .rt_owner = 0,
37 .chip_count = NRD_CHIP_COUNT,
38 .chip_addrs = {
39 PLAT_ARM_GICD_BASE >> 16,
40 #if NRD_CHIP_COUNT > 1
41 (PLAT_ARM_GICD_BASE + NRD_REMOTE_CHIP_MEM_OFFSET(1)) >> 16,
42 #endif
43 #if NRD_CHIP_COUNT > 2
44 (PLAT_ARM_GICD_BASE + NRD_REMOTE_CHIP_MEM_OFFSET(2)) >> 16,
45 #endif
46 #if NRD_CHIP_COUNT > 3
47 (PLAT_ARM_GICD_BASE + NRD_REMOTE_CHIP_MEM_OFFSET(3)) >> 16,
48 #endif
49 },
50 .spi_ids = {
51 {PLAT_ARM_GICD_BASE, 32, 511},
52 #if NRD_CHIP_COUNT > 1
53 {PLAT_ARM_GICD_BASE, 512, 991},
54 #endif
55 #if NRD_CHIP_COUNT > 2
56 {PLAT_ARM_GICD_BASE, 4096, 4575},
57 #endif
58 #if NRD_CHIP_COUNT > 3
59 {PLAT_ARM_GICD_BASE, 4576, 5055},
60 #endif
61 }
62 };
63
64 static uintptr_t rdv3mc_multichip_gicr_frames[] = {
65 /* Chip 0's GICR Base */
66 PLAT_ARM_GICR_BASE,
67 #if NRD_CHIP_COUNT > 1
68 /* Chip 1's GICR BASE */
69 PLAT_ARM_GICR_BASE + NRD_REMOTE_CHIP_MEM_OFFSET(1),
70 #endif
71 #if NRD_CHIP_COUNT > 2
72 /* Chip 2's GICR BASE */
73 PLAT_ARM_GICR_BASE + NRD_REMOTE_CHIP_MEM_OFFSET(2),
74 #endif
75 #if NRD_CHIP_COUNT > 3
76 /* Chip 3's GICR BASE */
77 PLAT_ARM_GICR_BASE + NRD_REMOTE_CHIP_MEM_OFFSET(3),
78 #endif
79 UL(0) /* Zero Termination */
80 };
81 #endif /* NRD_PLATFORM_VARIANT == 2 */
82
83 void bl31_platform_setup(void)
84 {
85 /*
86 * Perform SMMUv3 GPT configuration for the GPC SMMU present in system
87 * control block on RD-V3 platforms. This SMMUv3 initialization is
88 * not fatal.
89 *
90 * Don't perform smmuv3_security_init() for this instance of SMMUv3 as
91 * the global aborts need not be configured to allow the components in
92 * system control block send transations downstream to SMMUv3.
93 */
94 if (smmuv3_init(NRD_CSS_GPC_SMMUV3_BASE) != 0) {
95 WARN("Failed initializing System SMMU.\n");
96 }
97
98 #if (NRD_PLATFORM_VARIANT == 2)
99 int ret;
100 unsigned int i;
101
102 if (plat_arm_nrd_get_multi_chip_mode() == 0) {
103 ERROR("Chip Count is %u but multi-chip mode is not enabled\n",
104 NRD_CHIP_COUNT);
105 panic();
106 } else {
107 INFO("Enabling multi-chip support for RD-V3 variant\n");
108
109 for (i = 0; i < ARRAY_SIZE(rdv3mc_dynamic_mmap); i++) {
110 ret = mmap_add_dynamic_region(
111 rdv3mc_dynamic_mmap[i].base_pa,
112 rdv3mc_dynamic_mmap[i].base_va,
113 rdv3mc_dynamic_mmap[i].size,
114 rdv3mc_dynamic_mmap[i].attr);
115 if (ret != 0) {
116 ERROR("Failed to add entry i: %d (ret=%d)\n",
117 i, ret);
118 panic();
119 }
120 }
121
122 plat_arm_override_gicr_frames(
123 rdv3mc_multichip_gicr_frames);
124 gic600_multichip_init(&rdv3mc_multichip_data);
125 }
126 #endif /* NRD_PLATFORM_VARIANT == 2 */
127 nrd_bl31_common_platform_setup();
128
129 if (plat_rse_comms_init() != 0) {
130 WARN("Failed initializing AP-RSE comms.\n");
131 }
132 }
133
134 #if RESET_TO_BL31
135 /*
136 * The GPT library might modify the gpt regions structure to optimize
137 * the layout, so the array cannot be constant.
138 */
139 static pas_region_t pas_regions[] = {
140 NRD_PAS_SHARED_SRAM,
141 NRD_PAS_SYSTEM_NCI,
142 NRD_PAS_DEBUG_NIC,
143 NRD_PAS_NS_UART,
144 NRD_PAS_REALM_UART,
145 NRD_PAS_AP_NS_WDOG,
146 NRD_PAS_AP_ROOT_WDOG,
147 NRD_PAS_AP_SECURE_WDOG,
148 NRD_PAS_SECURE_SRAM_ERB_AP,
149 NRD_PAS_NS_SRAM_ERB_AP,
150 NRD_PAS_ROOT_SRAM_ERB_AP,
151 NRD_PAS_REALM_SRAM_ERB_AP,
152 NRD_PAS_SECURE_SRAM_ERB_SCP,
153 NRD_PAS_NS_SRAM_ERB_SCP,
154 NRD_PAS_ROOT_SRAM_ERB_SCP,
155 NRD_PAS_REALM_SRAM_ERB_SCP,
156 NRD_PAS_SECURE_SRAM_ERB_MCP,
157 NRD_PAS_NS_SRAM_ERB_MCP,
158 NRD_PAS_ROOT_SRAM_ERB_MCP,
159 NRD_PAS_REALM_SRAM_ERB_MCP,
160 NRD_PAS_SECURE_SRAM_ERB_RSE,
161 NRD_PAS_NS_SRAM_ERB_RSE,
162 NRD_PAS_ROOT_SRAM_ERB_RSE,
163 NRD_PAS_REALM_SRAM_ERB_RSE,
164 NRD_PAS_RSE_SECURE_SRAM_ERB_RSM,
165 NRD_PAS_RSE_NS_SRAM_ERB_RSM,
166 NRD_PAS_SCP_SECURE_SRAM_ERB_RSM,
167 NRD_PAS_SCP_NS_SRAM_ERB_RSM,
168 NRD_PAS_MCP_SECURE_SRAM_ERB_RSM,
169 NRD_PAS_MCP_NS_SRAM_ERB_RSM,
170 NRD_PAS_AP_SCP_ROOT_MHU,
171 NRD_PAS_AP_MCP_NS_MHU,
172 NRD_PAS_AP_MCP_SECURE_MHU,
173 NRD_PAS_AP_MCP_ROOT_MHU,
174 NRD_PAS_AP_RSE_NS_MHU,
175 NRD_PAS_AP_RSE_SECURE_MHU,
176 NRD_PAS_AP_RSE_ROOT_MHU,
177 NRD_PAS_AP_RSE_REALM_MHU,
178 NRD_PAS_SCP_MCP_RSE_CROSS_CHIP_MHU,
179 NRD_PAS_SYNCNT_MSTUPDTVAL_ADDR,
180 NRD_PAS_STM_SYSTEM_ITS,
181 NRD_PAS_SCP_MCP_RSE_SHARED_SRAM,
182 NRD_PAS_GIC,
183 NRD_PAS_NS_DRAM,
184 NRD_PAS_RMM,
185 NRD_PAS_L1GPT,
186 NRD_PAS_CMN,
187 NRD_PAS_LCP_PERIPHERAL,
188 NRD_PAS_DDR_IO,
189 NRD_PAS_SMMU_NCI_IO,
190 NRD_PAS_DRAM2_CHIP0,
191 #if NRD_CHIP_COUNT > 1
192 NRD_PAS_DRAM1_CHIP1,
193 NRD_PAS_DRAM2_CHIP1,
194 #endif
195 #if NRD_CHIP_COUNT > 2
196 NRD_PAS_DRAM1_CHIP2,
197 NRD_PAS_DRAM2_CHIP2,
198 #endif
199 #if NRD_CHIP_COUNT > 3
200 NRD_PAS_DRAM1_CHIP3,
201 NRD_PAS_DRAM2_CHIP3
202 #endif
203 };
204
205 static const arm_gpt_info_t arm_gpt_info = {
206 .pas_region_base = pas_regions,
207 .pas_region_count = (unsigned int)ARRAY_SIZE(pas_regions),
208 .l0_base = (uintptr_t)ARM_L0_GPT_BASE,
209 .l1_base = (uintptr_t)ARM_L1_GPT_BASE,
210 .l0_size = (size_t)ARM_L0_GPT_SIZE,
211 .l1_size = (size_t)ARM_L1_GPT_SIZE,
212 .pps = GPCCR_PPS_256TB,
213 .pgs = GPCCR_PGS_4K
214 };
215
216 const arm_gpt_info_t *plat_arm_get_gpt_info(void)
217 {
218 return &arm_gpt_info;
219 }
220
221 #endif /* RESET_TO_BL31 */