123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319 |
- #include <assert.h>
- #include <platform_def.h>
- #include <arch.h>
- #include <bl1/bl1.h>
- #include <common/bl_common.h>
- #include <common/debug.h>
- #include <lib/fconf/fconf.h>
- #include <lib/fconf/fconf_dyn_cfg_getter.h>
- #if TRANSFER_LIST
- #include <lib/transfer_list.h>
- #endif
- #include <lib/utils.h>
- #include <lib/xlat_tables/xlat_tables_compat.h>
- #include <plat/arm/common/plat_arm.h>
- #include <plat/common/platform.h>
- #pragma weak bl1_early_platform_setup
- #pragma weak bl1_plat_arch_setup
- #pragma weak bl1_plat_sec_mem_layout
- #pragma weak arm_bl1_early_platform_setup
- #pragma weak bl1_plat_prepare_exit
- #pragma weak bl1_plat_get_next_image_id
- #pragma weak plat_arm_bl1_fwu_needed
- #pragma weak arm_bl1_plat_arch_setup
- #pragma weak arm_bl1_platform_setup
- #define MAP_BL1_TOTAL MAP_REGION_FLAT( \
- bl1_tzram_layout.total_base, \
- bl1_tzram_layout.total_size, \
- MT_MEMORY | MT_RW | EL3_PAS)
- #if SEPARATE_CODE_AND_RODATA
- #define MAP_BL1_RO MAP_REGION_FLAT( \
- BL_CODE_BASE, \
- BL1_CODE_END - BL_CODE_BASE, \
- MT_CODE | EL3_PAS), \
- MAP_REGION_FLAT( \
- BL1_RO_DATA_BASE, \
- BL1_RO_DATA_END \
- - BL_RO_DATA_BASE, \
- MT_RO_DATA | EL3_PAS)
- #else
- #define MAP_BL1_RO MAP_REGION_FLAT( \
- BL_CODE_BASE, \
- BL1_CODE_END - BL_CODE_BASE, \
- MT_CODE | EL3_PAS)
- #endif
- static meminfo_t bl1_tzram_layout;
- static bool is_fwu_needed;
- struct transfer_list_header *secure_tl;
- struct meminfo *bl1_plat_sec_mem_layout(void)
- {
- return &bl1_tzram_layout;
- }
- void arm_bl1_early_platform_setup(void)
- {
- #if !ARM_DISABLE_TRUSTED_WDOG
-
- plat_arm_secure_wdt_start();
- #endif
-
- arm_console_boot_init();
-
- bl1_tzram_layout.total_base = ARM_BL_RAM_BASE;
- bl1_tzram_layout.total_size = ARM_BL_RAM_SIZE;
- #if TRANSFER_LIST
- secure_tl = transfer_list_ensure((void *)PLAT_ARM_EL3_FW_HANDOFF_BASE,
- PLAT_ARM_FW_HANDOFF_SIZE);
- assert(secure_tl != NULL);
- #endif
- }
- void bl1_early_platform_setup(void)
- {
- arm_bl1_early_platform_setup();
-
- plat_arm_interconnect_init();
-
- plat_arm_interconnect_enter_coherency();
- }
- void arm_bl1_plat_arch_setup(void)
- {
- #if USE_COHERENT_MEM
-
- assert((BL_COHERENT_RAM_END - BL_COHERENT_RAM_BASE) == 0U);
- #endif
- const mmap_region_t bl_regions[] = {
- MAP_BL1_TOTAL,
- MAP_BL1_RO,
- #if USE_ROMLIB
- ARM_MAP_ROMLIB_CODE,
- ARM_MAP_ROMLIB_DATA,
- #endif
- {0}
- };
- setup_page_tables(bl_regions, plat_arm_get_mmap());
- #ifdef __aarch64__
- enable_mmu_el3(0);
- #else
- enable_mmu_svc_mon(0);
- #endif
- arm_setup_romlib();
- }
- void bl1_plat_arch_setup(void)
- {
- arm_bl1_plat_arch_setup();
- }
- void arm_bl1_platform_setup(void)
- {
- const struct dyn_cfg_dtb_info_t *config_info __unused;
- uint32_t fw_config_max_size __unused;
- image_info_t config_image_info __unused;
- struct transfer_list_entry *te __unused;
- image_desc_t *desc;
- int err __unused = 1;
-
- plat_arm_io_setup();
-
- is_fwu_needed = plat_arm_bl1_fwu_needed();
- if (is_fwu_needed) {
- ERROR("Skip platform setup as FWU detected\n");
- return;
- }
- #if TRANSFER_LIST
- #if CRYPTO_SUPPORT
- te = transfer_list_add(secure_tl, TL_TAG_MBEDTLS_HEAP_INFO,
- sizeof(struct crypto_heap_info), NULL);
- assert(te != NULL);
- struct crypto_heap_info *heap_info =
- (struct crypto_heap_info *)transfer_list_entry_data(te);
- arm_get_mbedtls_heap(&heap_info->addr, &heap_info->size);
- #endif
- desc = bl1_plat_get_image_desc(BL2_IMAGE_ID);
-
- transfer_list_update_checksum(secure_tl);
- transfer_list_set_handoff_args(secure_tl, &desc->ep_info);
- #else
-
- fw_config_max_size = ARM_FW_CONFIG_LIMIT - ARM_FW_CONFIG_BASE;
- set_config_info(ARM_FW_CONFIG_BASE, ~0UL, fw_config_max_size, FW_CONFIG_ID);
-
- err = fconf_load_config(FW_CONFIG_ID);
- if (err < 0) {
- ERROR("Loading of FW_CONFIG failed %d\n", err);
- plat_error_handler(err);
- }
-
- config_info = FCONF_GET_PROPERTY(dyn_cfg, dtb, FW_CONFIG_ID);
- if (config_info != NULL) {
- err = fconf_populate_dtb_registry(config_info->config_addr);
- if (err < 0) {
- ERROR("Parsing of FW_CONFIG failed %d\n", err);
- plat_error_handler(err);
- }
-
- err = fconf_load_config(TB_FW_CONFIG_ID);
- if (err < 0) {
- ERROR("Loading of TB_FW_CONFIG failed %d\n", err);
- plat_error_handler(err);
- }
- } else {
- ERROR("Invalid FW_CONFIG address\n");
- plat_error_handler(err);
- }
- desc = bl1_plat_get_image_desc(BL2_IMAGE_ID);
-
- assert(desc != NULL);
- desc->ep_info.args.arg0 = config_info->config_addr;
- #if CRYPTO_SUPPORT
-
- arm_bl1_set_mbedtls_heap();
- #endif
- #endif
-
- #ifdef ARM_SYS_TIMCTL_BASE
- arm_configure_sys_timer();
- #endif
- #if (ARM_ARCH_MAJOR > 7) || defined(ARMV7_SUPPORTS_GENERIC_TIMER)
- write_cntfrq_el0(plat_get_syscnt_freq2());
- #endif
- }
- void bl1_plat_prepare_exit(entry_point_info_t *ep_info)
- {
- #if !ARM_DISABLE_TRUSTED_WDOG
-
- plat_arm_secure_wdt_stop();
- #endif
- #ifdef EL3_PAYLOAD_BASE
-
- plat_arm_program_trusted_mailbox(ep_info->pc);
- dsbsy();
- sev();
- #endif
- }
- bool plat_arm_bl1_fwu_needed(void)
- {
- return !arm_io_is_toc_valid();
- }
- unsigned int bl1_plat_get_next_image_id(void)
- {
- return is_fwu_needed ? NS_BL1U_IMAGE_ID : BL2_IMAGE_ID;
- }
- #if TRANSFER_LIST
- int bl1_plat_handle_post_image_load(unsigned int image_id)
- {
- image_desc_t *image_desc __unused;
- assert(image_id == BL2_IMAGE_ID);
- struct transfer_list_entry *te;
-
- te = transfer_list_add(secure_tl, TL_TAG_SRAM_LAYOUT64,
- sizeof(meminfo_t), NULL);
- assert(te != NULL);
- bl1_plat_calc_bl2_layout(&bl1_tzram_layout,
- (meminfo_t *)transfer_list_entry_data(te));
- transfer_list_update_checksum(secure_tl);
-
- flush_dcache_range((uintptr_t)secure_tl, secure_tl->size);
- return 0;
- }
- #endif
|