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

#include <assert.h>
#include <string.h>

#include <bl31/interrupt_mgmt.h>
#include <plat/common/platform.h>
#include <platform_def.h>

#include <sgi_ras.h>

static struct plat_sgi_ras_config *sgi_ras_config;

/*
 * Find event map for a given interrupt number. On success, returns pointer to
 * the event map. On error, returns NULL.
 */
struct sgi_ras_ev_map *sgi_find_ras_event_map_by_intr(uint32_t intr_num)
{
	struct sgi_ras_ev_map *map;
	int size;
	int i;

	if (sgi_ras_config == NULL) {
		ERROR("RAS config is NULL\n");
		return NULL;
	}

	map = sgi_ras_config->ev_map;
	size = sgi_ras_config->ev_map_size;

	for (i = 0; i < size; i++) {
		if (map->intr == intr_num)
			return map;

		map++;
	}

	return NULL;
}

/*
 * Programs GIC registers and configures interrupt ID's as Group0 EL3
 * interrupts. Current support is to register PPI and SPI interrupts.
 */
static void sgi_ras_intr_configure(int intr, int intr_type)
{
	plat_ic_set_interrupt_type(intr, INTR_TYPE_EL3);
	plat_ic_set_interrupt_priority(intr, PLAT_RAS_PRI);
	plat_ic_clear_interrupt_pending(intr);

	/* Routing mode option available only for SPI interrupts */
	if (intr_type == SGI_RAS_INTR_TYPE_SPI) {
		plat_ic_set_spi_routing(intr, INTR_ROUTING_MODE_ANY,
					(u_register_t)read_mpidr_el1());
	}
	plat_ic_enable_interrupt(intr);
}

/*
 * Initialization function for the framework.
 *
 * Registers RAS config provided by the platform and then configures and
 * enables interrupt for each registered error. On success, return 0.
 */
int sgi_ras_platform_setup(struct plat_sgi_ras_config *config)
{
	struct sgi_ras_ev_map *map;
	int size;
	int i;

	/* Check if parameter is valid. */
	if (config == NULL) {
		ERROR("SGI: Failed to register RAS config\n");
		return -1;
	}

	/*
	 * Maintain a reference to the platform RAS config data for later
	 * use.
	 */
	sgi_ras_config = config;

	map = sgi_ras_config->ev_map;
	size = sgi_ras_config->ev_map_size;

	for (i = 0; i < size; i++) {
		sgi_ras_intr_configure(map->intr, map->intr_type);
		map++;
	}

	INFO("SGI: Platform RAS setup successful\n");

	return 0;
}