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
fconf_populate_sdei_dyn_config(uintptr_t config)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