blob: 138d2c2a6bd24226a3fbedb0ed174858f86b58d2 [file] [log] [blame]
Michal Simek91794362022-08-31 16:45:14 +02001/*
2 * Copyright (c) 2018-2019, ARM Limited and Contributors. All rights reserved.
3 * Copyright (c) 2018-2022, Xilinx, Inc. All rights reserved.
Jay Buddhabhattid517f7b2023-01-23 23:32:35 -08004 * Copyright (C) 2022-2023, Advanced Micro Devices, Inc. All rights reserved.
Michal Simek91794362022-08-31 16:45:14 +02005 *
6 * SPDX-License-Identifier: BSD-3-Clause
7 */
8
9#include <common/debug.h>
10#include <common/interrupt_props.h>
11#include <drivers/arm/gicv3.h>
12#include <lib/utils.h>
13#include <plat/common/platform.h>
14
15#include <plat_private.h>
16#include <platform_def.h>
17
18/******************************************************************************
19 * The following functions are defined as weak to allow a platform to override
20 * the way the GICv3 driver is initialised and used.
21 *****************************************************************************/
22#pragma weak plat_versal_net_gic_driver_init
23#pragma weak plat_versal_net_gic_init
24#pragma weak plat_versal_net_gic_cpuif_enable
Jay Buddhabhattic6daff02022-09-05 02:56:32 -070025#pragma weak plat_versal_net_gic_cpuif_disable
Michal Simek91794362022-08-31 16:45:14 +020026#pragma weak plat_versal_net_gic_pcpu_init
Jay Buddhabhattic6daff02022-09-05 02:56:32 -070027#pragma weak plat_versal_net_gic_redistif_on
28#pragma weak plat_versal_net_gic_redistif_off
Michal Simek91794362022-08-31 16:45:14 +020029
30/* The GICv3 driver only needs to be initialized in EL3 */
31static uintptr_t rdistif_base_addrs[PLATFORM_CORE_COUNT];
32
Michal Simek91794362022-08-31 16:45:14 +020033static const interrupt_prop_t versal_net_interrupt_props[] = {
34 PLAT_VERSAL_NET_G1S_IRQ_PROPS(INTR_GROUP1S),
35 PLAT_VERSAL_NET_G0_IRQ_PROPS(INTR_GROUP0)
36};
37
38/*
Jay Buddhabhattic6daff02022-09-05 02:56:32 -070039 * We save and restore the GICv3 context on system suspend. Allocate the
40 * data in the designated EL3 Secure carve-out memory.
41 */
Chris Kay33bfc5e2023-02-14 11:30:04 +000042static gicv3_redist_ctx_t rdist_ctx __section(".versal_net_el3_tzc_dram");
43static gicv3_dist_ctx_t dist_ctx __section(".versal_net_el3_tzc_dram");
Jay Buddhabhattic6daff02022-09-05 02:56:32 -070044
45/*
Michal Simek91794362022-08-31 16:45:14 +020046 * MPIDR hashing function for translating MPIDRs read from GICR_TYPER register
47 * to core position.
48 *
49 * Calculating core position is dependent on MPIDR_EL1.MT bit. However, affinity
50 * values read from GICR_TYPER don't have an MT field. To reuse the same
51 * translation used for CPUs, we insert MT bit read from the PE's MPIDR into
52 * that read from GICR_TYPER.
53 *
54 * Assumptions:
55 *
56 * - All CPUs implemented in the system have MPIDR_EL1.MT bit set;
57 * - No CPUs implemented in the system use affinity level 3.
58 */
59static uint32_t versal_net_gicv3_mpidr_hash(u_register_t mpidr)
60{
61 mpidr |= (read_mpidr_el1() & MPIDR_MT_MASK);
62 return plat_core_pos_by_mpidr(mpidr);
63}
64
65static const gicv3_driver_data_t versal_net_gic_data __unused = {
66 .gicd_base = PLAT_VERSAL_NET_GICD_BASE,
Jay Buddhabhattid517f7b2023-01-23 23:32:35 -080067 .gicr_base = PLAT_VERSAL_NET_GICR_BASE,
Michal Simek91794362022-08-31 16:45:14 +020068 .interrupt_props = versal_net_interrupt_props,
69 .interrupt_props_num = ARRAY_SIZE(versal_net_interrupt_props),
70 .rdistif_num = PLATFORM_CORE_COUNT,
71 .rdistif_base_addrs = rdistif_base_addrs,
72 .mpidr_to_core_pos = versal_net_gicv3_mpidr_hash
73};
74
75void __init plat_versal_net_gic_driver_init(void)
76{
77 /*
78 * The GICv3 driver is initialized in EL3 and does not need
79 * to be initialized again in SEL1. This is because the S-EL1
80 * can use GIC system registers to manage interrupts and does
81 * not need GIC interface base addresses to be configured.
82 */
83#if IMAGE_BL31
84 gicv3_driver_init(&versal_net_gic_data);
Michal Simek91794362022-08-31 16:45:14 +020085#endif
86}
87
88/******************************************************************************
89 * Versal NET common helper to initialize the GIC. Only invoked by BL31
90 *****************************************************************************/
91void __init plat_versal_net_gic_init(void)
92{
93 gicv3_distif_init();
94 gicv3_rdistif_init(plat_my_core_pos());
95 gicv3_cpuif_enable(plat_my_core_pos());
96}
97
98/******************************************************************************
99 * Versal NET common helper to enable the GIC CPU interface
100 *****************************************************************************/
101void plat_versal_net_gic_cpuif_enable(void)
102{
103 gicv3_cpuif_enable(plat_my_core_pos());
104}
105
106/******************************************************************************
Jay Buddhabhattic6daff02022-09-05 02:56:32 -0700107 * Versal NET common helper to disable the GIC CPU interface
108 *****************************************************************************/
109void plat_versal_net_gic_cpuif_disable(void)
110{
111 gicv3_cpuif_disable(plat_my_core_pos());
112}
113
114/******************************************************************************
Michal Simek91794362022-08-31 16:45:14 +0200115 * Versal NET common helper to initialize the per-cpu redistributor interface in
116 * GICv3
117 *****************************************************************************/
118void plat_versal_net_gic_pcpu_init(void)
119{
Michal Simek91794362022-08-31 16:45:14 +0200120 gicv3_rdistif_init(plat_my_core_pos());
121}
Jay Buddhabhattic6daff02022-09-05 02:56:32 -0700122
123/******************************************************************************
124 * Versal NET common helpers to power GIC redistributor interface
125 *****************************************************************************/
126void plat_versal_net_gic_redistif_on(void)
127{
128 gicv3_rdistif_on(plat_my_core_pos());
129}
130
131void plat_versal_net_gic_redistif_off(void)
132{
133 gicv3_rdistif_off(plat_my_core_pos());
134}
135
136/******************************************************************************
137 * Versal NET common helper to save & restore the GICv3 on resume from system
138 * suspend
139 *****************************************************************************/
140void plat_versal_net_gic_save(void)
141{
142 /*
143 * If an ITS is available, save its context before
144 * the Redistributor using:
145 * gicv3_its_save_disable(gits_base, &its_ctx[i])
146 * Additionnaly, an implementation-defined sequence may
147 * be required to save the whole ITS state.
148 */
149
150 /*
151 * Save the GIC Redistributors and ITS contexts before the
152 * Distributor context. As we only handle SYSTEM SUSPEND API,
153 * we only need to save the context of the CPU that is issuing
154 * the SYSTEM SUSPEND call, i.e. the current CPU.
155 */
156 gicv3_rdistif_save(plat_my_core_pos(), &rdist_ctx);
157
158 /* Save the GIC Distributor context */
159 gicv3_distif_save(&dist_ctx);
160
161 /*
162 * From here, all the components of the GIC can be safely powered down
163 * as long as there is an alternate way to handle wakeup interrupt
164 * sources.
165 */
166}
167
168void plat_versal_net_gic_resume(void)
169{
170 /* Restore the GIC Distributor context */
171 gicv3_distif_init_restore(&dist_ctx);
172
173 /*
174 * Restore the GIC Redistributor and ITS contexts after the
175 * Distributor context. As we only handle SYSTEM SUSPEND API,
176 * we only need to restore the context of the CPU that issued
177 * the SYSTEM SUSPEND call.
178 */
179 gicv3_rdistif_init_restore(plat_my_core_pos(), &rdist_ctx);
180
181 /*
182 * If an ITS is available, restore its context after
183 * the Redistributor using:
184 * gicv3_its_restore(gits_base, &its_ctx[i])
185 * An implementation-defined sequence may be required to
186 * restore the whole ITS state. The ITS must also be
187 * re-enabled after this sequence has been executed.
188 */
189}