1 /* 2 * Copyright (c) 2021-2024, STMicroelectronics - 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/fdt_wrappers.h> 11 #include <drivers/io/io_storage.h> 12 #include <drivers/mmc.h> 13 #include <lib/fconf/fconf.h> 14 #include <lib/object_pool.h> 15 #include <libfdt.h> 16 #include <tools_share/firmware_image_package.h> 17 18 #include <platform_def.h> 19 #include <stm32mp_efi.h> 20 #include <stm32mp_fconf_getter.h> 21 #include <stm32mp_io_storage.h> 22 23 #if STM32MP_SDMMC || STM32MP_EMMC 24 static io_block_spec_t gpt_block_spec = { 25 .offset = 0U, 26 .length = 34U * MMC_BLOCK_SIZE, /* Size of GPT table */ 27 }; 28 #endif 29 30 #if PSA_FWU_SUPPORT 31 static io_block_spec_t metadata_block_spec = { 32 .offset = 0, /* To be filled at runtime */ 33 .length = 0, /* To be filled at runtime */ 34 }; 35 #endif /* PSA_FWU_SUPPORT */ 36 37 /* By default, STM32 platforms load images from the FIP */ 38 struct plat_io_policy policies[MAX_NUMBER_IDS] = { 39 [FIP_IMAGE_ID] = { 40 .dev_handle = &storage_dev_handle, 41 .image_spec = (uintptr_t)&image_block_spec, 42 .img_type_guid = STM32MP_FIP_GUID, 43 .check = open_storage 44 }, 45 #ifndef DECRYPTION_SUPPORT_none 46 [ENC_IMAGE_ID] = { 47 .dev_handle = &fip_dev_handle, 48 .image_spec = (uintptr_t)NULL, 49 .img_type_guid = NULL_GUID, 50 .check = open_fip 51 }, 52 #endif 53 #if STM32MP_SDMMC || STM32MP_EMMC 54 [GPT_IMAGE_ID] = { 55 .dev_handle = &storage_dev_handle, 56 .image_spec = (uintptr_t)&gpt_block_spec, 57 .img_type_guid = NULL_GUID, 58 .check = open_storage 59 }, 60 #endif 61 #if PSA_FWU_SUPPORT 62 [FWU_METADATA_IMAGE_ID] = { 63 .dev_handle = &storage_dev_handle, 64 .image_spec = (uintptr_t)&metadata_block_spec, 65 .img_type_guid = NULL_GUID, 66 .check = open_storage 67 }, 68 [BKUP_FWU_METADATA_IMAGE_ID] = { 69 .dev_handle = &storage_dev_handle, 70 .image_spec = (uintptr_t)&metadata_block_spec, 71 .img_type_guid = NULL_GUID, 72 .check = open_storage 73 }, 74 #endif /* PSA_FWU_SUPPORT */ 75 }; 76 77 #define DEFAULT_UUID_NUMBER U(7) 78 79 #ifdef __aarch64__ 80 #define BL31_UUID_NUMBER U(2) 81 #else 82 #define BL31_UUID_NUMBER U(0) 83 #endif 84 85 #if TRUSTED_BOARD_BOOT 86 #define TBBR_UUID_NUMBER U(6) 87 #else 88 #define TBBR_UUID_NUMBER U(0) 89 #endif 90 91 #if STM32MP_DDR_FIP_IO_STORAGE 92 #define DDR_FW_UUID_NUMBER U(1) 93 #else 94 #define DDR_FW_UUID_NUMBER U(0) 95 #endif 96 97 #define FCONF_ST_IO_UUID_NUMBER (DEFAULT_UUID_NUMBER + \ 98 BL31_UUID_NUMBER + \ 99 TBBR_UUID_NUMBER + \ 100 DDR_FW_UUID_NUMBER) 101 102 static io_uuid_spec_t fconf_stm32mp_uuids[FCONF_ST_IO_UUID_NUMBER]; 103 static OBJECT_POOL_ARRAY(fconf_stm32mp_uuids_pool, fconf_stm32mp_uuids); 104 105 struct policies_load_info { 106 unsigned int image_id; 107 const char *name; 108 }; 109 110 /* image id to property name table */ 111 static const struct policies_load_info load_info[FCONF_ST_IO_UUID_NUMBER] = { 112 #if STM32MP_DDR_FIP_IO_STORAGE 113 {DDR_FW_ID, "ddr_fw_uuid"}, 114 #endif 115 {FW_CONFIG_ID, "fw_cfg_uuid"}, 116 #ifdef __aarch64__ 117 {BL31_IMAGE_ID, "bl31_uuid"}, 118 {SOC_FW_CONFIG_ID, "soc_fw_cfg_uuid"}, 119 #endif 120 {BL32_IMAGE_ID, "bl32_uuid"}, 121 {BL32_EXTRA1_IMAGE_ID, "bl32_extra1_uuid"}, 122 {BL32_EXTRA2_IMAGE_ID, "bl32_extra2_uuid"}, 123 {BL33_IMAGE_ID, "bl33_uuid"}, 124 {HW_CONFIG_ID, "hw_cfg_uuid"}, 125 {TOS_FW_CONFIG_ID, "tos_fw_cfg_uuid"}, 126 #if TRUSTED_BOARD_BOOT 127 {STM32MP_CONFIG_CERT_ID, "stm32mp_cfg_cert_uuid"}, 128 {TRUSTED_KEY_CERT_ID, "t_key_cert_uuid"}, 129 {TRUSTED_OS_FW_KEY_CERT_ID, "tos_fw_key_cert_uuid"}, 130 {NON_TRUSTED_FW_KEY_CERT_ID, "nt_fw_key_cert_uuid"}, 131 {TRUSTED_OS_FW_CONTENT_CERT_ID, "tos_fw_content_cert_uuid"}, 132 {NON_TRUSTED_FW_CONTENT_CERT_ID, "nt_fw_content_cert_uuid"}, 133 #endif /* TRUSTED_BOARD_BOOT */ 134 }; 135 136 int fconf_populate_stm32mp_io_policies(uintptr_t config) 137 { 138 int node; 139 unsigned int i; 140 141 /* As libfdt uses void *, we can't avoid this cast */ 142 const void *dtb = (void *)config; 143 144 /* Assert the node offset point to "st,io-fip-handle" compatible property */ 145 const char *compatible_str = "st,io-fip-handle"; 146 147 node = fdt_node_offset_by_compatible(dtb, -1, compatible_str); 148 if (node < 0) { 149 ERROR("FCONF: Can't find %s compatible in dtb\n", compatible_str); 150 return node; 151 } 152 153 /* Locate the uuid cells and read the value for all the load info uuid */ 154 for (i = 0U; i < FCONF_ST_IO_UUID_NUMBER; i++) { 155 union uuid_helper_t uuid_helper; 156 io_uuid_spec_t *uuid_ptr; 157 int err; 158 159 uuid_ptr = pool_alloc(&fconf_stm32mp_uuids_pool); 160 err = fdtw_read_uuid(dtb, node, load_info[i].name, 16, 161 (uint8_t *)&uuid_helper); 162 if (err < 0) { 163 WARN("FCONF: Read cell failed for %s\n", load_info[i].name); 164 return err; 165 } 166 167 VERBOSE("FCONF: stm32mp-io_policies.%s cell found with value = " 168 "%02x%02x%02x%02x-%02x%02x-%02x%02x-%02x%02x-%02x%02x%02x%02x%02x%02x\n", 169 load_info[i].name, 170 uuid_helper.uuid_struct.time_low[0], uuid_helper.uuid_struct.time_low[1], 171 uuid_helper.uuid_struct.time_low[2], uuid_helper.uuid_struct.time_low[3], 172 uuid_helper.uuid_struct.time_mid[0], uuid_helper.uuid_struct.time_mid[1], 173 uuid_helper.uuid_struct.time_hi_and_version[0], 174 uuid_helper.uuid_struct.time_hi_and_version[1], 175 uuid_helper.uuid_struct.clock_seq_hi_and_reserved, 176 uuid_helper.uuid_struct.clock_seq_low, 177 uuid_helper.uuid_struct.node[0], uuid_helper.uuid_struct.node[1], 178 uuid_helper.uuid_struct.node[2], uuid_helper.uuid_struct.node[3], 179 uuid_helper.uuid_struct.node[4], uuid_helper.uuid_struct.node[5]); 180 181 uuid_ptr->uuid = uuid_helper.uuid_struct; 182 policies[load_info[i].image_id].image_spec = (uintptr_t)uuid_ptr; 183 switch (load_info[i].image_id) { 184 #if ENCRYPT_BL32 && !defined(DECRYPTION_SUPPORT_none) 185 case BL32_IMAGE_ID: 186 case BL32_EXTRA1_IMAGE_ID: 187 case BL32_EXTRA2_IMAGE_ID: 188 policies[load_info[i].image_id].dev_handle = &enc_dev_handle; 189 policies[load_info[i].image_id].check = open_enc_fip; 190 break; 191 #endif 192 default: 193 policies[load_info[i].image_id].dev_handle = &fip_dev_handle; 194 policies[load_info[i].image_id].check = open_fip; 195 break; 196 } 197 } 198 199 return 0; 200 } 201 202 FCONF_REGISTER_POPULATOR(TB_FW, stm32mp_io, fconf_populate_stm32mp_io_policies); 203