You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
90 lines
2.2 KiB
90 lines
2.2 KiB
/*
|
|
* Copyright (c) 2017-2018, ARM Limited and Contributors. All rights reserved.
|
|
*
|
|
* SPDX-License-Identifier: BSD-3-Clause
|
|
*/
|
|
|
|
#include <platform_def.h>
|
|
|
|
#include <assert.h>
|
|
#include <common/bl_common.h>
|
|
#include <common/interrupt_props.h>
|
|
#include <drivers/arm/gicv3.h>
|
|
#include <lib/utils.h>
|
|
#include <lib/mmio.h>
|
|
#include <plat/common/platform.h>
|
|
|
|
#include <k3_gicv3.h>
|
|
|
|
/* The GICv3 driver only needs to be initialized in EL3 */
|
|
uintptr_t rdistif_base_addrs[PLATFORM_CORE_COUNT];
|
|
|
|
static const interrupt_prop_t k3_interrupt_props[] = {
|
|
PLAT_ARM_G1S_IRQ_PROPS(INTR_GROUP1S),
|
|
PLAT_ARM_G0_IRQ_PROPS(INTR_GROUP0)
|
|
};
|
|
|
|
static unsigned int k3_mpidr_to_core_pos(unsigned long mpidr)
|
|
{
|
|
return (unsigned int)plat_core_pos_by_mpidr(mpidr);
|
|
}
|
|
|
|
gicv3_driver_data_t k3_gic_data = {
|
|
.rdistif_num = PLATFORM_CORE_COUNT,
|
|
.rdistif_base_addrs = rdistif_base_addrs,
|
|
.interrupt_props = k3_interrupt_props,
|
|
.interrupt_props_num = ARRAY_SIZE(k3_interrupt_props),
|
|
.mpidr_to_core_pos = k3_mpidr_to_core_pos,
|
|
};
|
|
|
|
void k3_gic_driver_init(uintptr_t gic_base)
|
|
{
|
|
/* GIC Distributor is always at the base of the IP */
|
|
uintptr_t gicd_base = gic_base;
|
|
/* GIC Redistributor base is run-time detected */
|
|
uintptr_t gicr_base = 0;
|
|
|
|
for (unsigned int gicr_shift = 18; gicr_shift < 21; gicr_shift++) {
|
|
uintptr_t gicr_check = gic_base + BIT(gicr_shift);
|
|
uint32_t iidr = mmio_read_32(gicr_check + GICR_IIDR);
|
|
if (iidr != 0) {
|
|
/* Found the GICR base */
|
|
gicr_base = gicr_check;
|
|
break;
|
|
}
|
|
}
|
|
/* Assert if we have not found the GICR base */
|
|
assert(gicr_base != 0);
|
|
|
|
/*
|
|
* The GICv3 driver is initialized in EL3 and does not need
|
|
* to be initialized again in SEL1. This is because the S-EL1
|
|
* can use GIC system registers to manage interrupts and does
|
|
* not need GIC interface base addresses to be configured.
|
|
*/
|
|
k3_gic_data.gicd_base = gicd_base;
|
|
k3_gic_data.gicr_base = gicr_base;
|
|
gicv3_driver_init(&k3_gic_data);
|
|
}
|
|
|
|
void k3_gic_init(void)
|
|
{
|
|
gicv3_distif_init();
|
|
gicv3_rdistif_init(plat_my_core_pos());
|
|
gicv3_cpuif_enable(plat_my_core_pos());
|
|
}
|
|
|
|
void k3_gic_cpuif_enable(void)
|
|
{
|
|
gicv3_cpuif_enable(plat_my_core_pos());
|
|
}
|
|
|
|
void k3_gic_cpuif_disable(void)
|
|
{
|
|
gicv3_cpuif_disable(plat_my_core_pos());
|
|
}
|
|
|
|
void k3_gic_pcpu_init(void)
|
|
{
|
|
gicv3_rdistif_init(plat_my_core_pos());
|
|
}
|
|
|