arm-trusted-firmware/plat/qemu/qemu_sbsa/sbsa_gic.c

/*
 * Copyright (c) 2023, Linaro Limited and Contributors. All rights reserved.
 *
 * SPDX-License-Identifier: BSD-3-Clause
 */

#include <drivers/arm/gicv3.h>
#include <plat/common/platform.h>

static const interrupt_prop_t qemu_interrupt_props[] = {
	PLATFORM_G1S_PROPS(INTR_GROUP1S),
	PLATFORM_G0_PROPS(INTR_GROUP0)
};

static uintptr_t qemu_rdistif_base_addrs[PLATFORM_CORE_COUNT];

static unsigned int qemu_mpidr_to_core_pos(unsigned long mpidr)
{
	return plat_core_pos_by_mpidr(mpidr);
}

static gicv3_driver_data_t sbsa_gic_driver_data = {
	/* we set those two values for compatibility with older QEMU */
	.gicd_base = GICD_BASE,
	.gicr_base = GICR_BASE,
	.interrupt_props = qemu_interrupt_props,
	.interrupt_props_num = ARRAY_SIZE(qemu_interrupt_props),
	.rdistif_num = PLATFORM_CORE_COUNT,
	.rdistif_base_addrs = qemu_rdistif_base_addrs,
	.mpidr_to_core_pos = qemu_mpidr_to_core_pos
};

void sbsa_set_gic_bases(const uintptr_t gicd_base, const uintptr_t gicr_base)
{
	sbsa_gic_driver_data.gicd_base = gicd_base;
	sbsa_gic_driver_data.gicr_base = gicr_base;
}

uintptr_t sbsa_get_gicd(void)
{
	return sbsa_gic_driver_data.gicd_base;
}

uintptr_t sbsa_get_gicr(void)
{
	return sbsa_gic_driver_data.gicr_base;
}

void plat_qemu_gic_init(void)
{
	gicv3_driver_init(&sbsa_gic_driver_data);
	gicv3_distif_init();
	gicv3_rdistif_init(plat_my_core_pos());
	gicv3_cpuif_enable(plat_my_core_pos());
}

void qemu_pwr_gic_on_finish(void)
{
	gicv3_rdistif_init(plat_my_core_pos());
	gicv3_cpuif_enable(plat_my_core_pos());
}

void qemu_pwr_gic_off(void)
{
	gicv3_cpuif_disable(plat_my_core_pos());
	gicv3_rdistif_off(plat_my_core_pos());
}