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 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 const unsigned int sp_start_index = SP_CONTENT_CERT_ID + 1; 34 35 /* As libfdt use void *, we can't avoid this cast */ 36 const void *dtb = (void *)config; 37 38 /* Assert the node offset point to "arm,sp" compatible property */ 39 const char *compatible_str = "arm,sp"; 40 41 node = fdt_node_offset_by_compatible(dtb, -1, compatible_str); 42 if (node < 0) { 43 ERROR("FCONF: Can't find %s in dtb\n", compatible_str); 44 return node; 45 } 46 47 fdt_for_each_subnode(sp_node, dtb, node) { 48 err = fdt_read_uint32_array(dtb, sp_node, "uuid", 4, 49 uuid_helper.word); 50 if (err < 0) { 51 ERROR("FCONF: cannot read SP uuid\n"); 52 return -1; 53 } 54 55 arm_sp.uuids[index] = uuid_helper; 56 57 err = fdt_read_uint32(dtb, sp_node, "load-address", &val32); 58 if (err < 0) { 59 ERROR("FCONF: cannot read SP load address\n"); 60 return -1; 61 } 62 arm_sp.load_addr[index] = val32; 63 64 VERBOSE("FCONF: %s UUID %x-%x-%x-%x load_addr=%lx\n", 65 __func__, 66 uuid_helper.word[0], 67 uuid_helper.word[1], 68 uuid_helper.word[2], 69 uuid_helper.word[3], 70 arm_sp.load_addr[index]); 71 72 /* Add SP information in mem param descriptor */ 73 sp_mem_params_descs[index].image_id = sp_start_index + index; 74 SET_PARAM_HEAD(&sp_mem_params_descs[index].image_info, 75 PARAM_IMAGE_BINARY, VERSION_2, 0); 76 sp_mem_params_descs[index].image_info.image_max_size = 77 ARM_SP_MAX_SIZE; 78 sp_mem_params_descs[index].next_handoff_image_id = 79 INVALID_IMAGE_ID; 80 sp_mem_params_descs[index].image_info.image_base = 81 arm_sp.load_addr[index]; 82 83 /* Add SP information in IO policies structure */ 84 policies[sp_start_index + index].image_spec = 85 (uintptr_t)&arm_sp.uuids[index]; 86 policies[sp_start_index + index].dev_handle = &fip_dev_handle; 87 policies[sp_start_index + index].check = open_fip; 88 89 index++; 90 91 if (index >= MAX_SP_IDS) { 92 ERROR("FCONF: reached max number of SPs\n"); 93 return -1; 94 } 95 } 96 97 if ((sp_node < 0) && (sp_node != -FDT_ERR_NOTFOUND)) { 98 ERROR("%d: fdt_for_each_subnode(): %d\n", __LINE__, node); 99 return sp_node; 100 } 101 102 arm_sp.number_of_sp = index; 103 return 0; 104 } 105 106 FCONF_REGISTER_POPULATOR(TB_FW, arm_sp, fconf_populate_arm_sp); 107 108 #endif /* IMAGE_BL2 */ 109