Dan Handley | 9df4804 | 2015-03-19 18:58:55 +0000 | [diff] [blame] | 1 | /* |
Soby Mathew | 7c6df5b | 2018-01-15 14:43:42 +0000 | [diff] [blame] | 2 | * Copyright (c) 2015-2018, ARM Limited and Contributors. All rights reserved. |
Dan Handley | 9df4804 | 2015-03-19 18:58:55 +0000 | [diff] [blame] | 3 | * |
dp-arm | fa3cf0b | 2017-05-03 09:38:09 +0100 | [diff] [blame] | 4 | * SPDX-License-Identifier: BSD-3-Clause |
Dan Handley | 9df4804 | 2015-03-19 18:58:55 +0000 | [diff] [blame] | 5 | */ |
| 6 | |
| 7 | #include <arch.h> |
| 8 | #include <arm_def.h> |
Daniel Boulby | 45a2c9e | 2018-07-06 16:54:44 +0100 | [diff] [blame] | 9 | #include <assert.h> |
Roberto Vargas | 2ca18d9 | 2018-02-12 12:36:17 +0000 | [diff] [blame] | 10 | #include <bl1.h> |
Dan Handley | 9df4804 | 2015-03-19 18:58:55 +0000 | [diff] [blame] | 11 | #include <bl_common.h> |
Dan Handley | 9df4804 | 2015-03-19 18:58:55 +0000 | [diff] [blame] | 12 | #include <plat_arm.h> |
Roberto Vargas | 2ca18d9 | 2018-02-12 12:36:17 +0000 | [diff] [blame] | 13 | #include <platform.h> |
Isla Mitchell | d254879 | 2017-07-14 10:48:25 +0100 | [diff] [blame] | 14 | #include <platform_def.h> |
Juan Castillo | b6132f1 | 2015-10-06 14:01:35 +0100 | [diff] [blame] | 15 | #include <sp805.h> |
Sandrine Bailleux | 28ee10f | 2016-06-15 15:44:27 +0100 | [diff] [blame] | 16 | #include <utils.h> |
Antonio Nino Diaz | 61aff00 | 2018-10-19 16:52:22 +0100 | [diff] [blame] | 17 | #include <xlat_tables_compat.h> |
| 18 | |
Sandrine Bailleux | d7c4750 | 2015-10-02 09:32:35 +0100 | [diff] [blame] | 19 | #include "../../../bl1/bl1_private.h" |
Dan Handley | 9df4804 | 2015-03-19 18:58:55 +0000 | [diff] [blame] | 20 | |
Dan Handley | 9df4804 | 2015-03-19 18:58:55 +0000 | [diff] [blame] | 21 | /* Weak definitions may be overridden in specific ARM standard platform */ |
| 22 | #pragma weak bl1_early_platform_setup |
| 23 | #pragma weak bl1_plat_arch_setup |
| 24 | #pragma weak bl1_platform_setup |
| 25 | #pragma weak bl1_plat_sec_mem_layout |
Yatharth Kochar | ede39cb | 2016-11-14 12:01:04 +0000 | [diff] [blame] | 26 | #pragma weak bl1_plat_prepare_exit |
Sathees Balya | 2257607 | 2018-09-03 17:41:13 +0100 | [diff] [blame] | 27 | #pragma weak bl1_plat_get_next_image_id |
| 28 | #pragma weak plat_arm_bl1_fwu_needed |
Dan Handley | 9df4804 | 2015-03-19 18:58:55 +0000 | [diff] [blame] | 29 | |
Daniel Boulby | 45a2c9e | 2018-07-06 16:54:44 +0100 | [diff] [blame] | 30 | #define MAP_BL1_TOTAL MAP_REGION_FLAT( \ |
| 31 | bl1_tzram_layout.total_base, \ |
| 32 | bl1_tzram_layout.total_size, \ |
| 33 | MT_MEMORY | MT_RW | MT_SECURE) |
Daniel Boulby | 4e97abd | 2018-07-16 14:09:15 +0100 | [diff] [blame] | 34 | /* |
| 35 | * If SEPARATE_CODE_AND_RODATA=1 we define a region for each section |
| 36 | * otherwise one region is defined containing both |
| 37 | */ |
| 38 | #if SEPARATE_CODE_AND_RODATA |
| 39 | #define MAP_BL1_RO MAP_REGION_FLAT( \ |
Daniel Boulby | 45a2c9e | 2018-07-06 16:54:44 +0100 | [diff] [blame] | 40 | BL_CODE_BASE, \ |
| 41 | BL1_CODE_END - BL_CODE_BASE, \ |
Daniel Boulby | 4e97abd | 2018-07-16 14:09:15 +0100 | [diff] [blame] | 42 | MT_CODE | MT_SECURE), \ |
| 43 | MAP_REGION_FLAT( \ |
Daniel Boulby | 45a2c9e | 2018-07-06 16:54:44 +0100 | [diff] [blame] | 44 | BL1_RO_DATA_BASE, \ |
| 45 | BL1_RO_DATA_END \ |
| 46 | - BL_RO_DATA_BASE, \ |
| 47 | MT_RO_DATA | MT_SECURE) |
Daniel Boulby | 4e97abd | 2018-07-16 14:09:15 +0100 | [diff] [blame] | 48 | #else |
| 49 | #define MAP_BL1_RO MAP_REGION_FLAT( \ |
| 50 | BL_CODE_BASE, \ |
| 51 | BL1_CODE_END - BL_CODE_BASE, \ |
| 52 | MT_CODE | MT_SECURE) |
| 53 | #endif |
Dan Handley | 9df4804 | 2015-03-19 18:58:55 +0000 | [diff] [blame] | 54 | |
| 55 | /* Data structure which holds the extents of the trusted SRAM for BL1*/ |
| 56 | static meminfo_t bl1_tzram_layout; |
| 57 | |
Sandrine Bailleux | b3b6e22 | 2018-07-11 12:44:22 +0200 | [diff] [blame] | 58 | struct meminfo *bl1_plat_sec_mem_layout(void) |
Dan Handley | 9df4804 | 2015-03-19 18:58:55 +0000 | [diff] [blame] | 59 | { |
| 60 | return &bl1_tzram_layout; |
| 61 | } |
| 62 | |
| 63 | /******************************************************************************* |
| 64 | * BL1 specific platform actions shared between ARM standard platforms. |
| 65 | ******************************************************************************/ |
| 66 | void arm_bl1_early_platform_setup(void) |
| 67 | { |
Dan Handley | 9df4804 | 2015-03-19 18:58:55 +0000 | [diff] [blame] | 68 | |
Juan Castillo | b6132f1 | 2015-10-06 14:01:35 +0100 | [diff] [blame] | 69 | #if !ARM_DISABLE_TRUSTED_WDOG |
| 70 | /* Enable watchdog */ |
| 71 | sp805_start(ARM_SP805_TWDG_BASE, ARM_TWDG_LOAD_VAL); |
| 72 | #endif |
| 73 | |
Dan Handley | 9df4804 | 2015-03-19 18:58:55 +0000 | [diff] [blame] | 74 | /* Initialize the console to provide early debug support */ |
Antonio Nino Diaz | 23ede6a | 2018-06-19 09:29:36 +0100 | [diff] [blame] | 75 | arm_console_boot_init(); |
Dan Handley | 9df4804 | 2015-03-19 18:58:55 +0000 | [diff] [blame] | 76 | |
| 77 | /* Allow BL1 to see the whole Trusted RAM */ |
| 78 | bl1_tzram_layout.total_base = ARM_BL_RAM_BASE; |
| 79 | bl1_tzram_layout.total_size = ARM_BL_RAM_SIZE; |
Dan Handley | 9df4804 | 2015-03-19 18:58:55 +0000 | [diff] [blame] | 80 | } |
| 81 | |
| 82 | void bl1_early_platform_setup(void) |
| 83 | { |
| 84 | arm_bl1_early_platform_setup(); |
| 85 | |
| 86 | /* |
Vikram Kanigiri | fbb1301 | 2016-02-15 11:54:14 +0000 | [diff] [blame] | 87 | * Initialize Interconnect for this cluster during cold boot. |
Dan Handley | 9df4804 | 2015-03-19 18:58:55 +0000 | [diff] [blame] | 88 | * No need for locks as no other CPU is active. |
| 89 | */ |
Vikram Kanigiri | fbb1301 | 2016-02-15 11:54:14 +0000 | [diff] [blame] | 90 | plat_arm_interconnect_init(); |
Dan Handley | 9df4804 | 2015-03-19 18:58:55 +0000 | [diff] [blame] | 91 | /* |
Vikram Kanigiri | fbb1301 | 2016-02-15 11:54:14 +0000 | [diff] [blame] | 92 | * Enable Interconnect coherency for the primary CPU's cluster. |
Dan Handley | 9df4804 | 2015-03-19 18:58:55 +0000 | [diff] [blame] | 93 | */ |
Vikram Kanigiri | fbb1301 | 2016-02-15 11:54:14 +0000 | [diff] [blame] | 94 | plat_arm_interconnect_enter_coherency(); |
Dan Handley | 9df4804 | 2015-03-19 18:58:55 +0000 | [diff] [blame] | 95 | } |
| 96 | |
| 97 | /****************************************************************************** |
| 98 | * Perform the very early platform specific architecture setup shared between |
| 99 | * ARM standard platforms. This only does basic initialization. Later |
| 100 | * architectural setup (bl1_arch_setup()) does not do anything platform |
| 101 | * specific. |
| 102 | *****************************************************************************/ |
| 103 | void arm_bl1_plat_arch_setup(void) |
| 104 | { |
Soby Mathew | b985648 | 2018-09-18 11:42:42 +0100 | [diff] [blame] | 105 | #if USE_COHERENT_MEM && !ARM_CRYPTOCELL_INTEG |
| 106 | /* |
| 107 | * Ensure ARM platforms don't use coherent memory in BL1 unless |
| 108 | * cryptocell integration is enabled. |
| 109 | */ |
Daniel Boulby | 45a2c9e | 2018-07-06 16:54:44 +0100 | [diff] [blame] | 110 | assert((BL_COHERENT_RAM_END - BL_COHERENT_RAM_BASE) == 0U); |
Dan Handley | 9df4804 | 2015-03-19 18:58:55 +0000 | [diff] [blame] | 111 | #endif |
Daniel Boulby | 45a2c9e | 2018-07-06 16:54:44 +0100 | [diff] [blame] | 112 | |
| 113 | const mmap_region_t bl_regions[] = { |
| 114 | MAP_BL1_TOTAL, |
Daniel Boulby | 4e97abd | 2018-07-16 14:09:15 +0100 | [diff] [blame] | 115 | MAP_BL1_RO, |
Roberto Vargas | e3adc37 | 2018-05-23 09:27:06 +0100 | [diff] [blame] | 116 | #if USE_ROMLIB |
| 117 | ARM_MAP_ROMLIB_CODE, |
| 118 | ARM_MAP_ROMLIB_DATA, |
Soby Mathew | b985648 | 2018-09-18 11:42:42 +0100 | [diff] [blame] | 119 | #endif |
| 120 | #if ARM_CRYPTOCELL_INTEG |
| 121 | ARM_MAP_BL_COHERENT_RAM, |
| 122 | #endif |
Daniel Boulby | 45a2c9e | 2018-07-06 16:54:44 +0100 | [diff] [blame] | 123 | {0} |
| 124 | }; |
| 125 | |
Roberto Vargas | 344ff02 | 2018-10-19 16:44:18 +0100 | [diff] [blame] | 126 | setup_page_tables(bl_regions, plat_arm_get_mmap()); |
Yatharth Kochar | 88ac53b | 2016-07-04 11:03:49 +0100 | [diff] [blame] | 127 | #ifdef AARCH32 |
Antonio Nino Diaz | 533d3a8 | 2018-08-07 16:35:19 +0100 | [diff] [blame] | 128 | enable_mmu_svc_mon(0); |
Yatharth Kochar | 88ac53b | 2016-07-04 11:03:49 +0100 | [diff] [blame] | 129 | #else |
Sandrine Bailleux | 4a1267a | 2016-05-18 16:11:47 +0100 | [diff] [blame] | 130 | enable_mmu_el3(0); |
Yatharth Kochar | 88ac53b | 2016-07-04 11:03:49 +0100 | [diff] [blame] | 131 | #endif /* AARCH32 */ |
Roberto Vargas | e3adc37 | 2018-05-23 09:27:06 +0100 | [diff] [blame] | 132 | |
| 133 | arm_setup_romlib(); |
Dan Handley | 9df4804 | 2015-03-19 18:58:55 +0000 | [diff] [blame] | 134 | } |
| 135 | |
| 136 | void bl1_plat_arch_setup(void) |
| 137 | { |
| 138 | arm_bl1_plat_arch_setup(); |
| 139 | } |
| 140 | |
| 141 | /* |
| 142 | * Perform the platform specific architecture setup shared between |
| 143 | * ARM standard platforms. |
| 144 | */ |
| 145 | void arm_bl1_platform_setup(void) |
| 146 | { |
| 147 | /* Initialise the IO layer and register platform IO devices */ |
| 148 | plat_arm_io_setup(); |
Soby Mathew | 7c6df5b | 2018-01-15 14:43:42 +0000 | [diff] [blame] | 149 | arm_load_tb_fw_config(); |
John Tsichritzis | c34341a | 2018-07-30 13:41:52 +0100 | [diff] [blame] | 150 | #if TRUSTED_BOARD_BOOT |
| 151 | /* Share the Mbed TLS heap info with other images */ |
| 152 | arm_bl1_set_mbedtls_heap(); |
| 153 | #endif /* TRUSTED_BOARD_BOOT */ |
Antonio Nino Diaz | 05f4957 | 2018-09-25 11:37:23 +0100 | [diff] [blame] | 154 | |
Soby Mathew | d969a7e | 2018-06-11 16:40:36 +0100 | [diff] [blame] | 155 | /* |
| 156 | * Allow access to the System counter timer module and program |
| 157 | * counter frequency for non secure images during FWU |
| 158 | */ |
| 159 | arm_configure_sys_timer(); |
| 160 | write_cntfrq_el0(plat_get_syscnt_freq2()); |
Dan Handley | 9df4804 | 2015-03-19 18:58:55 +0000 | [diff] [blame] | 161 | } |
| 162 | |
| 163 | void bl1_platform_setup(void) |
| 164 | { |
| 165 | arm_bl1_platform_setup(); |
| 166 | } |
| 167 | |
Sandrine Bailleux | 03897bb | 2015-11-26 16:31:34 +0000 | [diff] [blame] | 168 | void bl1_plat_prepare_exit(entry_point_info_t *ep_info) |
| 169 | { |
Juan Castillo | b6132f1 | 2015-10-06 14:01:35 +0100 | [diff] [blame] | 170 | #if !ARM_DISABLE_TRUSTED_WDOG |
| 171 | /* Disable watchdog before leaving BL1 */ |
| 172 | sp805_stop(ARM_SP805_TWDG_BASE); |
| 173 | #endif |
| 174 | |
Sandrine Bailleux | 03897bb | 2015-11-26 16:31:34 +0000 | [diff] [blame] | 175 | #ifdef EL3_PAYLOAD_BASE |
| 176 | /* |
| 177 | * Program the EL3 payload's entry point address into the CPUs mailbox |
| 178 | * in order to release secondary CPUs from their holding pen and make |
| 179 | * them jump there. |
| 180 | */ |
Dimitris Papastamos | d7a3651 | 2018-06-18 13:01:06 +0100 | [diff] [blame] | 181 | plat_arm_program_trusted_mailbox(ep_info->pc); |
Sandrine Bailleux | 03897bb | 2015-11-26 16:31:34 +0000 | [diff] [blame] | 182 | dsbsy(); |
| 183 | sev(); |
| 184 | #endif |
| 185 | } |
Soby Mathew | 9427357 | 2018-03-07 11:32:04 +0000 | [diff] [blame] | 186 | |
Sathees Balya | 2257607 | 2018-09-03 17:41:13 +0100 | [diff] [blame] | 187 | /* |
| 188 | * On Arm platforms, the FWU process is triggered when the FIP image has |
| 189 | * been tampered with. |
| 190 | */ |
| 191 | int plat_arm_bl1_fwu_needed(void) |
| 192 | { |
| 193 | return (arm_io_is_toc_valid() != 1); |
| 194 | } |
| 195 | |
Soby Mathew | 9427357 | 2018-03-07 11:32:04 +0000 | [diff] [blame] | 196 | /******************************************************************************* |
| 197 | * The following function checks if Firmware update is needed, |
| 198 | * by checking if TOC in FIP image is valid or not. |
| 199 | ******************************************************************************/ |
| 200 | unsigned int bl1_plat_get_next_image_id(void) |
| 201 | { |
Sathees Balya | 2257607 | 2018-09-03 17:41:13 +0100 | [diff] [blame] | 202 | if (plat_arm_bl1_fwu_needed() != 0) |
Soby Mathew | 9427357 | 2018-03-07 11:32:04 +0000 | [diff] [blame] | 203 | return NS_BL1U_IMAGE_ID; |
| 204 | |
| 205 | return BL2_IMAGE_ID; |
| 206 | } |