Omkar Anand Kulkarni | aa8abf0 | 2023-05-31 11:29:17 +0530 | [diff] [blame] | 1 | /* |
| 2 | * Copyright (c) 2018-2023, ARM Limited and Contributors. All rights reserved. |
| 3 | * |
| 4 | * SPDX-License-Identifier: BSD-3-Clause |
| 5 | */ |
| 6 | |
| 7 | #include <assert.h> |
| 8 | #include <string.h> |
| 9 | |
| 10 | #include <bl31/interrupt_mgmt.h> |
| 11 | #include <plat/common/platform.h> |
| 12 | #include <platform_def.h> |
| 13 | |
| 14 | #include <sgi_ras.h> |
| 15 | |
| 16 | static struct plat_sgi_ras_config *sgi_ras_config; |
| 17 | |
| 18 | /* |
| 19 | * Find event map for a given interrupt number. On success, returns pointer to |
| 20 | * the event map. On error, returns NULL. |
| 21 | */ |
| 22 | struct sgi_ras_ev_map *sgi_find_ras_event_map_by_intr(uint32_t intr_num) |
| 23 | { |
| 24 | struct sgi_ras_ev_map *map; |
| 25 | int size; |
| 26 | int i; |
| 27 | |
| 28 | if (sgi_ras_config == NULL) { |
| 29 | ERROR("RAS config is NULL\n"); |
| 30 | return NULL; |
| 31 | } |
| 32 | |
| 33 | map = sgi_ras_config->ev_map; |
| 34 | size = sgi_ras_config->ev_map_size; |
| 35 | |
| 36 | for (i = 0; i < size; i++) { |
| 37 | if (map->intr == intr_num) |
| 38 | return map; |
| 39 | |
| 40 | map++; |
| 41 | } |
| 42 | |
| 43 | return NULL; |
| 44 | } |
| 45 | |
| 46 | /* |
| 47 | * Programs GIC registers and configures interrupt ID's as Group0 EL3 |
| 48 | * interrupts. Current support is to register PPI and SPI interrupts. |
| 49 | */ |
| 50 | static void sgi_ras_intr_configure(int intr, int intr_type) |
| 51 | { |
| 52 | plat_ic_set_interrupt_type(intr, INTR_TYPE_EL3); |
| 53 | plat_ic_set_interrupt_priority(intr, PLAT_RAS_PRI); |
| 54 | plat_ic_clear_interrupt_pending(intr); |
| 55 | |
| 56 | /* Routing mode option available only for SPI interrupts */ |
| 57 | if (intr_type == SGI_RAS_INTR_TYPE_SPI) { |
| 58 | plat_ic_set_spi_routing(intr, INTR_ROUTING_MODE_ANY, |
| 59 | (u_register_t)read_mpidr_el1()); |
| 60 | } |
| 61 | plat_ic_enable_interrupt(intr); |
| 62 | } |
| 63 | |
| 64 | /* |
| 65 | * Initialization function for the framework. |
| 66 | * |
| 67 | * Registers RAS config provided by the platform and then configures and |
| 68 | * enables interrupt for each registered error. On success, return 0. |
| 69 | */ |
| 70 | int sgi_ras_platform_setup(struct plat_sgi_ras_config *config) |
| 71 | { |
| 72 | struct sgi_ras_ev_map *map; |
| 73 | int size; |
| 74 | int i; |
| 75 | |
| 76 | /* Check if parameter is valid. */ |
| 77 | if (config == NULL) { |
| 78 | ERROR("SGI: Failed to register RAS config\n"); |
| 79 | return -1; |
| 80 | } |
| 81 | |
| 82 | /* |
| 83 | * Maintain a reference to the platform RAS config data for later |
| 84 | * use. |
| 85 | */ |
| 86 | sgi_ras_config = config; |
| 87 | |
| 88 | map = sgi_ras_config->ev_map; |
| 89 | size = sgi_ras_config->ev_map_size; |
| 90 | |
| 91 | for (i = 0; i < size; i++) { |
| 92 | sgi_ras_intr_configure(map->intr, map->intr_type); |
| 93 | map++; |
| 94 | } |
| 95 | |
| 96 | INFO("SGI: Platform RAS setup successful\n"); |
| 97 | |
| 98 | return 0; |
| 99 | } |