Debian Codegraph @

plat/arm/board/neoverse_rd/platform/rdv1mc/rdv1mc_plat.c

raw
1 /*
2 * Copyright (c) 2020-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 <plat/arm/common/plat_arm.h>
10 #include <plat/common/platform.h>
11
12 #include <nrd_plat.h>
13
14 #if defined(IMAGE_BL31)
15 static const mmap_region_t rdv1mc_dynamic_mmap[] = {
16 NRD_CSS_SHARED_RAM_MMAP(1),
17 NRD_CSS_PERIPH_MMAP(1),
18 NRD_ROS_PERIPH_MMAP(1),
19 #if (NRD_CHIP_COUNT > 2)
20 NRD_CSS_SHARED_RAM_MMAP(2),
21 NRD_CSS_PERIPH_MMAP(2),
22 NRD_ROS_PERIPH_MMAP(2),
23 #endif
24 #if (NRD_CHIP_COUNT > 3)
25 NRD_CSS_SHARED_RAM_MMAP(3),
26 NRD_CSS_PERIPH_MMAP(3),
27 NRD_ROS_PERIPH_MMAP(3)
28 #endif
29 };
30
31 static struct gic600_multichip_data rdv1mc_multichip_data __init = {
32 .rt_owner_base = PLAT_ARM_GICD_BASE,
33 .rt_owner = 0,
34 .chip_count = NRD_CHIP_COUNT,
35 .chip_addrs = {
36 PLAT_ARM_GICD_BASE >> 16,
37 (PLAT_ARM_GICD_BASE + NRD_REMOTE_CHIP_MEM_OFFSET(1)) >> 16,
38 #if (NRD_CHIP_COUNT > 2)
39 (PLAT_ARM_GICD_BASE + NRD_REMOTE_CHIP_MEM_OFFSET(2)) >> 16,
40 #endif
41 #if (NRD_CHIP_COUNT > 3)
42 (PLAT_ARM_GICD_BASE + NRD_REMOTE_CHIP_MEM_OFFSET(3)) >> 16,
43 #endif
44 },
45 .spi_ids = {
46 {PLAT_ARM_GICD_BASE,
47 NRD_CHIP0_SPI_MIN,
48 NRD_CHIP0_SPI_MAX},
49 {0, 0, 0},
50 #if (NRD_CHIP_COUNT > 2)
51 {0, 0, 0},
52 #endif
53 #if (NRD_CHIP_COUNT > 3)
54 {0, 0, 0},
55 #endif
56 }
57 };
58
59 static uintptr_t rdv1mc_multichip_gicr_frames[] = {
60 /* Chip 0's GICR Base */
61 PLAT_ARM_GICR_BASE,
62 /* Chip 1's GICR BASE */
63 PLAT_ARM_GICR_BASE + NRD_REMOTE_CHIP_MEM_OFFSET(1),
64 #if (NRD_CHIP_COUNT > 2)
65 /* Chip 2's GICR BASE */
66 PLAT_ARM_GICR_BASE + NRD_REMOTE_CHIP_MEM_OFFSET(2),
67 #endif
68 #if (NRD_CHIP_COUNT > 3)
69 /* Chip 3's GICR BASE */
70 PLAT_ARM_GICR_BASE + NRD_REMOTE_CHIP_MEM_OFFSET(3),
71 #endif
72 UL(0) /* Zero Termination */
73 };
74 #endif /* IMAGE_BL31 */
75
76 unsigned int plat_arm_nrd_get_platform_id(void)
77 {
78 return mmio_read_32(SID_REG_BASE + SID_SYSTEM_ID_OFFSET)
79 & SID_SYSTEM_ID_PART_NUM_MASK;
80 }
81
82 unsigned int plat_arm_nrd_get_config_id(void)
83 {
84 return mmio_read_32(SID_REG_BASE + SID_SYSTEM_CFG_OFFSET);
85 }
86
87 unsigned int plat_arm_nrd_get_multi_chip_mode(void)
88 {
89 return (mmio_read_32(SID_REG_BASE + SID_NODE_ID_OFFSET) &
90 SID_MULTI_CHIP_MODE_MASK) >> SID_MULTI_CHIP_MODE_SHIFT;
91 }
92
93 /*
94 * bl31_platform_setup_function is guarded by IMAGE_BL31 macro because
95 * PLAT_XLAT_TABLES_DYNAMIC macro is set to build only for BL31 and not
96 * for other stages.
97 */
98 #if defined(IMAGE_BL31)
99 void bl31_platform_setup(void)
100 {
101 int ret;
102 unsigned int i;
103
104 if ((plat_arm_nrd_get_multi_chip_mode() == 0) &&
105 (NRD_CHIP_COUNT > 1)) {
106 ERROR("Chip Count is %u but multi-chip mode is not enabled\n",
107 NRD_CHIP_COUNT);
108 panic();
109 } else if ((plat_arm_nrd_get_multi_chip_mode() == 1) &&
110 (NRD_CHIP_COUNT > 1)) {
111 INFO("Enabling support for multi-chip in RD-V1-MC\n");
112
113 for (i = 0; i < ARRAY_SIZE(rdv1mc_dynamic_mmap); i++) {
114 ret = mmap_add_dynamic_region(
115 rdv1mc_dynamic_mmap[i].base_pa,
116 rdv1mc_dynamic_mmap[i].base_va,
117 rdv1mc_dynamic_mmap[i].size,
118 rdv1mc_dynamic_mmap[i].attr);
119 if (ret != 0) {
120 ERROR("Failed to add dynamic mmap entry "
121 "(ret=%d)\n", ret);
122 panic();
123 }
124 }
125
126 plat_arm_override_gicr_frames(
127 rdv1mc_multichip_gicr_frames);
128 gic600_multichip_init(&rdv1mc_multichip_data);
129 }
130
131 nrd_bl31_common_platform_setup();
132 }
133 #endif /* IMAGE_BL31 */