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