Debian Codegraph @

plat/arm/board/neoverse_rd/platform/rdn1edge/rdn1edge_plat.c

raw
1 /*
2 * Copyright (c) 2018-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 rdn1edge_dynamic_mmap[] = {
16 NRD_CSS_SHARED_RAM_MMAP(1),
17 NRD_CSS_PERIPH_MMAP(1),
18 NRD_ROS_PERIPH_MMAP(1)
19 };
20
21 static struct gic600_multichip_data rdn1e1_multichip_data __init = {
22 .rt_owner_base = PLAT_ARM_GICD_BASE,
23 .rt_owner = 0,
24 .chip_count = NRD_CHIP_COUNT,
25 .chip_addrs = {
26 PLAT_ARM_GICD_BASE >> 16,
27 (PLAT_ARM_GICD_BASE + NRD_REMOTE_CHIP_MEM_OFFSET(1)) >> 16
28 },
29 .spi_ids = {
30 {PLAT_ARM_GICD_BASE,
31 NRD_CHIP0_SPI_MIN,
32 NRD_CHIP0_SPI_MAX},
33 {0, 0, 0}
34 }
35 };
36
37 static uintptr_t rdn1e1_multichip_gicr_frames[] = {
38 PLAT_ARM_GICR_BASE, /* Chip 0's GICR Base */
39 PLAT_ARM_GICR_BASE +
40 NRD_REMOTE_CHIP_MEM_OFFSET(1), /* Chip 1's GICR BASE */
41 UL(0) /* Zero Termination */
42 };
43 #endif /* IMAGE_BL31 */
44
45 unsigned int plat_arm_nrd_get_platform_id(void)
46 {
47 return mmio_read_32(SID_REG_BASE + SID_SYSTEM_ID_OFFSET)
48 & SID_SYSTEM_ID_PART_NUM_MASK;
49 }
50
51 unsigned int plat_arm_nrd_get_config_id(void)
52 {
53 return mmio_read_32(SID_REG_BASE + SID_SYSTEM_CFG_OFFSET);
54 }
55
56 unsigned int plat_arm_nrd_get_multi_chip_mode(void)
57 {
58 return (mmio_read_32(SID_REG_BASE + SID_NODE_ID_OFFSET) &
59 SID_MULTI_CHIP_MODE_MASK) >> SID_MULTI_CHIP_MODE_SHIFT;
60 }
61
62 /*
63 * IMAGE_BL31 macro is added to build bl31_platform_setup function only for BL31
64 * because PLAT_XLAT_TABLES_DYNAMIC macro is set to build only for BL31 and not
65 * for other stages.
66 */
67 #if defined(IMAGE_BL31)
68 void bl31_platform_setup(void)
69 {
70 unsigned int i;
71 int ret;
72
73 if (plat_arm_nrd_get_multi_chip_mode() == 0 && NRD_CHIP_COUNT > 1) {
74 ERROR("Chip Count is set to %d but multi-chip mode not enabled\n",
75 NRD_CHIP_COUNT);
76 panic();
77 } else if (plat_arm_nrd_get_multi_chip_mode() == 1 &&
78 NRD_CHIP_COUNT > 1) {
79 INFO("Enabling support for multi-chip in RD-N1-Edge\n");
80
81 for (i = 0; i < ARRAY_SIZE(rdn1edge_dynamic_mmap); i++) {
82 ret = mmap_add_dynamic_region(
83 rdn1edge_dynamic_mmap[i].base_pa,
84 rdn1edge_dynamic_mmap[i].base_va,
85 rdn1edge_dynamic_mmap[i].size,
86 rdn1edge_dynamic_mmap[i].attr
87 );
88 if (ret != 0) {
89 ERROR("Failed to add dynamic mmap entry\n");
90 panic();
91 }
92 }
93
94 plat_arm_override_gicr_frames(rdn1e1_multichip_gicr_frames);
95 gic600_multichip_init(&rdn1e1_multichip_data);
96 }
97
98 nrd_bl31_common_platform_setup();
99 }
100 #endif /* IMAGE_BL31 */