1*cbf9e84aSBalint Dobszay /* 2*cbf9e84aSBalint Dobszay * Copyright (c) 2019-2020, ARM Limited and Contributors. All rights reserved. 3*cbf9e84aSBalint Dobszay * 4*cbf9e84aSBalint Dobszay * SPDX-License-Identifier: BSD-3-Clause 5*cbf9e84aSBalint Dobszay */ 6*cbf9e84aSBalint Dobszay #include <assert.h> 7*cbf9e84aSBalint Dobszay 8*cbf9e84aSBalint Dobszay #include <common/debug.h> 9*cbf9e84aSBalint Dobszay #include <common/fdt_wrappers.h> 10*cbf9e84aSBalint Dobszay #include <libfdt.h> 11*cbf9e84aSBalint Dobszay #include <plat/arm/common/fconf_sdei_getter.h> 12*cbf9e84aSBalint Dobszay 13*cbf9e84aSBalint Dobszay #define PRIVATE_EVENT_NUM(i) private_events[3 * (i)] 14*cbf9e84aSBalint Dobszay #define PRIVATE_EVENT_INTR(i) private_events[3 * (i) + 1] 15*cbf9e84aSBalint Dobszay #define PRIVATE_EVENT_FLAGS(i) private_events[3 * (i) + 2] 16*cbf9e84aSBalint Dobszay 17*cbf9e84aSBalint Dobszay #define SHARED_EVENT_NUM(i) shared_events[3 * (i)] 18*cbf9e84aSBalint Dobszay #define SHARED_EVENT_INTR(i) shared_events[3 * (i) + 1] 19*cbf9e84aSBalint Dobszay #define SHARED_EVENT_FLAGS(i) shared_events[3 * (i) + 2] 20*cbf9e84aSBalint Dobszay 21*cbf9e84aSBalint Dobszay struct sdei_dyn_config_t sdei_dyn_config; 22*cbf9e84aSBalint Dobszay 23*cbf9e84aSBalint Dobszay int fconf_populate_sdei_dyn_config(uintptr_t config) 24*cbf9e84aSBalint Dobszay { 25*cbf9e84aSBalint Dobszay uint32_t i; 26*cbf9e84aSBalint Dobszay int node, err; 27*cbf9e84aSBalint Dobszay uint32_t private_events[PLAT_SDEI_DP_EVENT_MAX_CNT * 3]; 28*cbf9e84aSBalint Dobszay uint32_t shared_events[PLAT_SDEI_DS_EVENT_MAX_CNT * 3]; 29*cbf9e84aSBalint Dobszay 30*cbf9e84aSBalint Dobszay const void *dtb = (void *)config; 31*cbf9e84aSBalint Dobszay 32*cbf9e84aSBalint Dobszay /* Check that the node offset points to compatible property */ 33*cbf9e84aSBalint Dobszay node = fdt_node_offset_by_compatible(dtb, -1, "arm,sdei-1.0"); 34*cbf9e84aSBalint Dobszay if (node < 0) { 35*cbf9e84aSBalint Dobszay ERROR("FCONF: Can't find 'arm,sdei-1.0' compatible node in dtb\n"); 36*cbf9e84aSBalint Dobszay return node; 37*cbf9e84aSBalint Dobszay } 38*cbf9e84aSBalint Dobszay 39*cbf9e84aSBalint Dobszay /* Read number of private mappings */ 40*cbf9e84aSBalint Dobszay err = fdt_read_uint32(dtb, node, "private_event_count", 41*cbf9e84aSBalint Dobszay &sdei_dyn_config.private_ev_cnt); 42*cbf9e84aSBalint Dobszay if (err < 0) { 43*cbf9e84aSBalint Dobszay ERROR("FCONF: Read cell failed for 'private_event_count': %u\n", 44*cbf9e84aSBalint Dobszay sdei_dyn_config.private_ev_cnt); 45*cbf9e84aSBalint Dobszay return err; 46*cbf9e84aSBalint Dobszay } 47*cbf9e84aSBalint Dobszay 48*cbf9e84aSBalint Dobszay /* Check if the value is in range */ 49*cbf9e84aSBalint Dobszay if (sdei_dyn_config.private_ev_cnt > PLAT_SDEI_DP_EVENT_MAX_CNT) { 50*cbf9e84aSBalint Dobszay ERROR("FCONF: Invalid value for 'private_event_count': %u\n", 51*cbf9e84aSBalint Dobszay sdei_dyn_config.private_ev_cnt); 52*cbf9e84aSBalint Dobszay return -1; 53*cbf9e84aSBalint Dobszay } 54*cbf9e84aSBalint Dobszay 55*cbf9e84aSBalint Dobszay /* Read private mappings */ 56*cbf9e84aSBalint Dobszay err = fdt_read_uint32_array(dtb, node, "private_events", 57*cbf9e84aSBalint Dobszay sdei_dyn_config.private_ev_cnt * 3, private_events); 58*cbf9e84aSBalint Dobszay if (err < 0) { 59*cbf9e84aSBalint Dobszay ERROR("FCONF: Read cell failed for 'private_events': %d\n", err); 60*cbf9e84aSBalint Dobszay return err; 61*cbf9e84aSBalint Dobszay } 62*cbf9e84aSBalint Dobszay 63*cbf9e84aSBalint Dobszay /* Move data to fconf struct */ 64*cbf9e84aSBalint Dobszay for (i = 0; i < sdei_dyn_config.private_ev_cnt; i++) { 65*cbf9e84aSBalint Dobszay sdei_dyn_config.private_ev_nums[i] = PRIVATE_EVENT_NUM(i); 66*cbf9e84aSBalint Dobszay sdei_dyn_config.private_ev_intrs[i] = PRIVATE_EVENT_INTR(i); 67*cbf9e84aSBalint Dobszay sdei_dyn_config.private_ev_flags[i] = PRIVATE_EVENT_FLAGS(i); 68*cbf9e84aSBalint Dobszay } 69*cbf9e84aSBalint Dobszay 70*cbf9e84aSBalint Dobszay /* Read number of shared mappings */ 71*cbf9e84aSBalint Dobszay err = fdt_read_uint32(dtb, node, "shared_event_count", 72*cbf9e84aSBalint Dobszay &sdei_dyn_config.shared_ev_cnt); 73*cbf9e84aSBalint Dobszay if (err < 0) { 74*cbf9e84aSBalint Dobszay ERROR("FCONF: Read cell failed for 'shared_event_count'\n"); 75*cbf9e84aSBalint Dobszay return err; 76*cbf9e84aSBalint Dobszay } 77*cbf9e84aSBalint Dobszay 78*cbf9e84aSBalint Dobszay /* Check if the value is in range */ 79*cbf9e84aSBalint Dobszay if (sdei_dyn_config.shared_ev_cnt > PLAT_SDEI_DS_EVENT_MAX_CNT) { 80*cbf9e84aSBalint Dobszay ERROR("FCONF: Invalid value for 'shared_event_count': %u\n", 81*cbf9e84aSBalint Dobszay sdei_dyn_config.shared_ev_cnt); 82*cbf9e84aSBalint Dobszay return -1; 83*cbf9e84aSBalint Dobszay } 84*cbf9e84aSBalint Dobszay 85*cbf9e84aSBalint Dobszay /* Read shared mappings */ 86*cbf9e84aSBalint Dobszay err = fdt_read_uint32_array(dtb, node, "shared_events", 87*cbf9e84aSBalint Dobszay sdei_dyn_config.shared_ev_cnt * 3, shared_events); 88*cbf9e84aSBalint Dobszay if (err < 0) { 89*cbf9e84aSBalint Dobszay ERROR("FCONF: Read cell failed for 'shared_events': %d\n", err); 90*cbf9e84aSBalint Dobszay return err; 91*cbf9e84aSBalint Dobszay } 92*cbf9e84aSBalint Dobszay 93*cbf9e84aSBalint Dobszay /* Move data to fconf struct */ 94*cbf9e84aSBalint Dobszay for (i = 0; i < sdei_dyn_config.shared_ev_cnt; i++) { 95*cbf9e84aSBalint Dobszay sdei_dyn_config.shared_ev_nums[i] = SHARED_EVENT_NUM(i); 96*cbf9e84aSBalint Dobszay sdei_dyn_config.shared_ev_intrs[i] = SHARED_EVENT_INTR(i); 97*cbf9e84aSBalint Dobszay sdei_dyn_config.shared_ev_flags[i] = SHARED_EVENT_FLAGS(i); 98*cbf9e84aSBalint Dobszay } 99*cbf9e84aSBalint Dobszay 100*cbf9e84aSBalint Dobszay return 0; 101*cbf9e84aSBalint Dobszay } 102*cbf9e84aSBalint Dobszay 103*cbf9e84aSBalint Dobszay FCONF_REGISTER_POPULATOR(HW_CONFIG, sdei, fconf_populate_sdei_dyn_config); 104