1 /* 2 * Copyright (c) 2021, 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_fconf_getter.h> 20 #include <stm32mp_io_storage.h> 21 22 #if STM32MP_SDMMC || STM32MP_EMMC 23 static io_block_spec_t gpt_block_spec = { 24 .offset = 0U, 25 .length = 34U * MMC_BLOCK_SIZE, /* Size of GPT table */ 26 }; 27 #endif 28 29 /* By default, STM32 platforms load images from the FIP */ 30 struct plat_io_policy policies[MAX_NUMBER_IDS] = { 31 [FIP_IMAGE_ID] = { 32 &storage_dev_handle, 33 (uintptr_t)&image_block_spec, 34 open_storage 35 }, 36 #if STM32MP_SDMMC || STM32MP_EMMC 37 [GPT_IMAGE_ID] = { 38 &storage_dev_handle, 39 (uintptr_t)&gpt_block_spec, 40 open_storage 41 }, 42 #endif 43 }; 44 45 #define FCONF_ST_IO_UUID_NUMBER U(8) 46 47 static io_uuid_spec_t fconf_stm32mp_uuids[FCONF_ST_IO_UUID_NUMBER]; 48 static OBJECT_POOL_ARRAY(fconf_stm32mp_uuids_pool, fconf_stm32mp_uuids); 49 50 struct policies_load_info { 51 unsigned int image_id; 52 const char *name; 53 }; 54 55 /* image id to property name table */ 56 static const struct policies_load_info load_info[FCONF_ST_IO_UUID_NUMBER] = { 57 {FW_CONFIG_ID, "fw_cfg_uuid"}, 58 {BL32_IMAGE_ID, "bl32_uuid"}, 59 {BL32_EXTRA1_IMAGE_ID, "bl32_extra1_uuid"}, 60 {BL32_EXTRA2_IMAGE_ID, "bl32_extra2_uuid"}, 61 {BL33_IMAGE_ID, "bl33_uuid"}, 62 {HW_CONFIG_ID, "hw_cfg_uuid"}, 63 {TOS_FW_CONFIG_ID, "tos_fw_cfg_uuid"}, 64 {NT_FW_CONFIG_ID, "nt_fw_cfg_uuid"}, 65 }; 66 67 int fconf_populate_stm32mp_io_policies(uintptr_t config) 68 { 69 int node; 70 unsigned int i; 71 72 /* As libfdt uses void *, we can't avoid this cast */ 73 const void *dtb = (void *)config; 74 75 /* Assert the node offset point to "st,io-fip-handle" compatible property */ 76 const char *compatible_str = "st,io-fip-handle"; 77 78 node = fdt_node_offset_by_compatible(dtb, -1, compatible_str); 79 if (node < 0) { 80 ERROR("FCONF: Can't find %s compatible in dtb\n", compatible_str); 81 return node; 82 } 83 84 /* Locate the uuid cells and read the value for all the load info uuid */ 85 for (i = 0U; i < FCONF_ST_IO_UUID_NUMBER; i++) { 86 union uuid_helper_t uuid_helper; 87 io_uuid_spec_t *uuid_ptr; 88 int err; 89 90 uuid_ptr = pool_alloc(&fconf_stm32mp_uuids_pool); 91 err = fdtw_read_uuid(dtb, node, load_info[i].name, 16, 92 (uint8_t *)&uuid_helper); 93 if (err < 0) { 94 WARN("FCONF: Read cell failed for %s\n", load_info[i].name); 95 return err; 96 } 97 98 VERBOSE("FCONF: stm32mp-io_policies.%s cell found with value = " 99 "%02x%02x%02x%02x-%02x%02x-%02x%02x-%02x%02x-%02x%02x%02x%02x%02x%02x\n", 100 load_info[i].name, 101 uuid_helper.uuid_struct.time_low[0], uuid_helper.uuid_struct.time_low[1], 102 uuid_helper.uuid_struct.time_low[2], uuid_helper.uuid_struct.time_low[3], 103 uuid_helper.uuid_struct.time_mid[0], uuid_helper.uuid_struct.time_mid[1], 104 uuid_helper.uuid_struct.time_hi_and_version[0], 105 uuid_helper.uuid_struct.time_hi_and_version[1], 106 uuid_helper.uuid_struct.clock_seq_hi_and_reserved, 107 uuid_helper.uuid_struct.clock_seq_low, 108 uuid_helper.uuid_struct.node[0], uuid_helper.uuid_struct.node[1], 109 uuid_helper.uuid_struct.node[2], uuid_helper.uuid_struct.node[3], 110 uuid_helper.uuid_struct.node[4], uuid_helper.uuid_struct.node[5]); 111 112 uuid_ptr->uuid = uuid_helper.uuid_struct; 113 policies[load_info[i].image_id].image_spec = (uintptr_t)uuid_ptr; 114 policies[load_info[i].image_id].dev_handle = &fip_dev_handle; 115 policies[load_info[i].image_id].check = open_fip; 116 } 117 118 return 0; 119 } 120 121 FCONF_REGISTER_POPULATOR(TB_FW, stm32mp_io, fconf_populate_stm32mp_io_policies); 122