blob: bfc116befd1d9e3dc1e34929f203a4d22f83f286 [file] [log] [blame]
Oliver Swedeb51da812019-12-03 14:08:21 +00001/*
2 * Copyright (c) 2020, ARM Limited and Contributors. All rights reserved.
3 *
4 * SPDX-License-Identifier: BSD-3-Clause
5 */
6
Andre Przywarab3514812020-01-24 15:46:05 +00007#include <common/debug.h>
8#include <common/fdt_wrappers.h>
Oliver Swedeb51da812019-12-03 14:08:21 +00009#include <drivers/arm/gicv3.h>
10#include <drivers/arm/gic_common.h>
Andre Przywarab3514812020-01-24 15:46:05 +000011#include <libfdt.h>
Oliver Swedeb51da812019-12-03 14:08:21 +000012
Andre Przywarab3514812020-01-24 15:46:05 +000013#include <platform_def.h>
Oliver Swedeb51da812019-12-03 14:08:21 +000014#include <plat/common/platform.h>
15#include <platform_def.h>
16
17static const interrupt_prop_t fpga_interrupt_props[] = {
18 PLATFORM_G1S_PROPS(INTR_GROUP1S),
19 PLATFORM_G0_PROPS(INTR_GROUP0)
20};
21
22static uintptr_t fpga_rdistif_base_addrs[PLATFORM_CORE_COUNT];
23
24static unsigned int fpga_mpidr_to_core_pos(unsigned long mpidr)
25{
26 return (unsigned int)plat_core_pos_by_mpidr(mpidr);
27}
28
Andre Przywarab3514812020-01-24 15:46:05 +000029static gicv3_driver_data_t fpga_gicv3_driver_data = {
Oliver Swedeb51da812019-12-03 14:08:21 +000030 .interrupt_props = fpga_interrupt_props,
31 .interrupt_props_num = ARRAY_SIZE(fpga_interrupt_props),
32 .rdistif_num = PLATFORM_CORE_COUNT,
33 .rdistif_base_addrs = fpga_rdistif_base_addrs,
34 .mpidr_to_core_pos = fpga_mpidr_to_core_pos
35};
36
37void plat_fpga_gic_init(void)
38{
Andre Przywarab3514812020-01-24 15:46:05 +000039 const void *fdt = (void *)(uintptr_t)FPGA_PRELOADED_DTB_BASE;
40 int node, ret;
41
42 node = fdt_node_offset_by_compatible(fdt, 0, "arm,gic-v3");
43 if (node < 0) {
44 WARN("No \"arm,gic-v3\" compatible node found in DT, no GIC support.\n");
45 return;
46 }
47
48 /* TODO: Assuming only empty "ranges;" properties up the bus path. */
49 ret = fdt_get_reg_props_by_index(fdt, node, 0,
50 &fpga_gicv3_driver_data.gicd_base, NULL);
51 if (ret < 0) {
52 WARN("Could not read GIC distributor address from DT.\n");
53 return;
54 }
55
56 ret = fdt_get_reg_props_by_index(fdt, node, 1,
57 &fpga_gicv3_driver_data.gicr_base, NULL);
58 if (ret < 0) {
59 WARN("Could not read GIC redistributor address from DT.\n");
60 return;
61 }
62
Oliver Swedeb51da812019-12-03 14:08:21 +000063 gicv3_driver_init(&fpga_gicv3_driver_data);
64 gicv3_distif_init();
65 gicv3_rdistif_init(plat_my_core_pos());
66 gicv3_cpuif_enable(plat_my_core_pos());
67}
68
69void fpga_pwr_gic_on_finish(void)
70{
71 gicv3_rdistif_init(plat_my_core_pos());
72 gicv3_cpuif_enable(plat_my_core_pos());
73}
74
75void fpga_pwr_gic_off(void)
76{
77 gicv3_cpuif_disable(plat_my_core_pos());
78 gicv3_rdistif_off(plat_my_core_pos());
79}
Andre Przywara210541b2020-08-24 18:34:50 +010080
81unsigned int fpga_get_nr_gic_cores(void)
82{
83 return gicv3_rdistif_get_number_frames(fpga_gicv3_driver_data.gicr_base);
84}