1 /*
2 * Copyright (c) 2020, ARM Limited and Contributors. All rights reserved.
3 *
4 * SPDX-License-Identifier: BSD-3-Clause
5 */
6
7 #include <assert.h>
8
9 #include <common/debug.h>
10 #include <common/desc_image_load.h>
11 #include <common/fdt_wrappers.h>
12 #include <drivers/io/io_storage.h>
13 #include <lib/object_pool.h>
14 #include <libfdt.h>
15 #include <plat/arm/common/arm_fconf_getter.h>
16 #include <plat/arm/common/arm_fconf_io_storage.h>
17 #include <plat/arm/common/fconf_arm_sp_getter.h>
18 #include <platform_def.h>
19 #include <tools_share/firmware_image_package.h>
20
21 #ifdef IMAGE_BL2
22
23 bl_mem_params_node_t sp_mem_params_descs[MAX_SP_IDS];
24
25 struct arm_sp_t arm_sp;
26
fconf_populate_arm_sp(uintptr_t config)27 int fconf_populate_arm_sp(uintptr_t config)
28 {
29 int sp_node, node, err;
30 union uuid_helper_t uuid_helper;
31 unsigned int index = 0;
32 uint32_t val32;
33 bool is_plat_owned = false;
34 const unsigned int sip_start = SP_PKG1_ID;
35 unsigned int sip_index = sip_start;
36 const unsigned int sip_end = sip_start + MAX_SP_IDS / 2;
37 const unsigned int plat_start = SP_PKG5_ID;
38 unsigned int plat_index = plat_start;
39 const unsigned int plat_end = plat_start + MAX_SP_IDS / 2;
40 unsigned int j;
41
42 /* As libfdt use void *, we can't avoid this cast */
43 const void *dtb = (void *)config;
44
45 /* Assert the node offset point to "arm,sp" compatible property */
46 const char *compatible_str = "arm,sp";
47
48 node = fdt_node_offset_by_compatible(dtb, -1, compatible_str);
49 if (node < 0) {
50 ERROR("FCONF: Can't find %s in dtb\n", compatible_str);
51 return node;
52 }
53
54 fdt_for_each_subnode(sp_node, dtb, node) {
55 if ((index == MAX_SP_IDS) || (sip_index == sip_end)
56 || (plat_index == plat_end)) {
57 ERROR("FCONF: Reached max number of SPs\n");
58 return -1;
59 }
60
61 /* Read UUID */
62 err = fdt_read_uint32_array(dtb, sp_node, "uuid", 4,
63 uuid_helper.word);
64 if (err < 0) {
65 ERROR("FCONF: cannot read SP uuid\n");
66 return -1;
67 }
68
69 /* Convert uuid from big endian to little endian */
70 for (j = 0U; j < 4U; j++) {
71 uuid_helper.word[j] =
72 ((uuid_helper.word[j] >> 24U) & 0xff) |
73 ((uuid_helper.word[j] << 8U) & 0xff0000) |
74 ((uuid_helper.word[j] >> 8U) & 0xff00) |
75 ((uuid_helper.word[j] << 24U) & 0xff000000);
76 }
77
78 arm_sp.uuids[index] = uuid_helper;
79 VERBOSE("FCONF: %s UUID %x-%x-%x-%x load_addr=%lx\n",
80 __func__,
81 uuid_helper.word[0],
82 uuid_helper.word[1],
83 uuid_helper.word[2],
84 uuid_helper.word[3],
85 arm_sp.load_addr[index]);
86
87 /* Read Load address */
88 err = fdt_read_uint32(dtb, sp_node, "load-address", &val32);
89 if (err < 0) {
90 ERROR("FCONF: cannot read SP load address\n");
91 return -1;
92 }
93 arm_sp.load_addr[index] = val32;
94
95 /* Read owner field only for dualroot CoT */
96 #if defined(ARM_COT_dualroot)
97 /* Owner is an optional field, no need to catch error */
98 fdtw_read_string(dtb, sp_node, "owner",
99 arm_sp.owner[index], ARM_SP_OWNER_NAME_LEN);
100 #endif
101 /* If owner is empty mark it as SiP owned */
102 if ((strncmp(arm_sp.owner[index], "SiP",
103 ARM_SP_OWNER_NAME_LEN) == 0) ||
104 (strncmp(arm_sp.owner[index], "",
105 ARM_SP_OWNER_NAME_LEN) == 0)) {
106 is_plat_owned = false;
107 } else if (strcmp(arm_sp.owner[index], "Plat") == 0) {
108 is_plat_owned = true;
109 } else {
110 ERROR("FCONF: %s is not a valid SP owner\n",
111 arm_sp.owner[index]);
112 return -1;
113 }
114 /*
115 * Add SP information in mem param descriptor and IO policies
116 * structure.
117 */
118 if (is_plat_owned) {
119 sp_mem_params_descs[index].image_id = plat_index;
120 policies[plat_index].image_spec =
121 (uintptr_t)&arm_sp.uuids[index];
122 policies[plat_index].dev_handle = &fip_dev_handle;
123 policies[plat_index].check = open_fip;
124 plat_index++;
125 } else {
126 sp_mem_params_descs[index].image_id = sip_index;
127 policies[sip_index].image_spec =
128 (uintptr_t)&arm_sp.uuids[index];
129 policies[sip_index].dev_handle = &fip_dev_handle;
130 policies[sip_index].check = open_fip;
131 sip_index++;
132 }
133 SET_PARAM_HEAD(&sp_mem_params_descs[index].image_info,
134 PARAM_IMAGE_BINARY, VERSION_2, 0);
135 sp_mem_params_descs[index].image_info.image_max_size =
136 ARM_SP_MAX_SIZE;
137 sp_mem_params_descs[index].next_handoff_image_id =
138 INVALID_IMAGE_ID;
139 sp_mem_params_descs[index].image_info.image_base =
140 arm_sp.load_addr[index];
141 index++;
142 }
143
144 if ((sp_node < 0) && (sp_node != -FDT_ERR_NOTFOUND)) {
145 ERROR("%u: fdt_for_each_subnode(): %d\n", __LINE__, node);
146 return sp_node;
147 }
148
149 arm_sp.number_of_sp = index;
150 return 0;
151 }
152
153 FCONF_REGISTER_POPULATOR(TB_FW, arm_sp, fconf_populate_arm_sp);
154
155 #endif /* IMAGE_BL2 */
156