Yann Gautier | 4b0c72a | 2018-07-16 10:54:09 +0200 | [diff] [blame] | 1 | /* |
Yann Gautier | dca6154 | 2021-02-10 18:19:23 +0100 | [diff] [blame] | 2 | * Copyright (c) 2015-2021, ARM Limited and Contributors. All rights reserved. |
Yann Gautier | 4b0c72a | 2018-07-16 10:54:09 +0200 | [diff] [blame] | 3 | * |
| 4 | * SPDX-License-Identifier: BSD-3-Clause |
| 5 | */ |
| 6 | |
Yann Gautier | 4b0c72a | 2018-07-16 10:54:09 +0200 | [diff] [blame] | 7 | #include <assert.h> |
Yann Gautier | 658775c | 2021-07-06 10:00:44 +0200 | [diff] [blame] | 8 | #include <errno.h> |
Antonio Nino Diaz | e0f9063 | 2018-12-14 00:18:21 +0000 | [diff] [blame] | 9 | #include <string.h> |
| 10 | |
Antonio Nino Diaz | e0f9063 | 2018-12-14 00:18:21 +0000 | [diff] [blame] | 11 | #include <arch_helpers.h> |
| 12 | #include <common/bl_common.h> |
| 13 | #include <common/debug.h> |
| 14 | #include <common/desc_image_load.h> |
Antonio Nino Diaz | e0f9063 | 2018-12-14 00:18:21 +0000 | [diff] [blame] | 15 | #include <drivers/generic_delay_timer.h> |
Yann Gautier | a3bd8d1 | 2021-06-18 11:33:26 +0200 | [diff] [blame] | 16 | #include <drivers/mmc.h> |
Yann Gautier | 3edc7c3 | 2019-05-20 19:17:08 +0200 | [diff] [blame] | 17 | #include <drivers/st/bsec.h> |
Yann Gautier | 091eab5 | 2019-06-04 18:06:34 +0200 | [diff] [blame] | 18 | #include <drivers/st/stm32_iwdg.h> |
Yann Gautier | 3d8497c | 2021-10-18 16:06:22 +0200 | [diff] [blame] | 19 | #include <drivers/st/stm32_uart.h> |
Antonio Nino Diaz | e0f9063 | 2018-12-14 00:18:21 +0000 | [diff] [blame] | 20 | #include <drivers/st/stm32mp1_clk.h> |
Antonio Nino Diaz | e0f9063 | 2018-12-14 00:18:21 +0000 | [diff] [blame] | 21 | #include <drivers/st/stm32mp1_pwr.h> |
| 22 | #include <drivers/st/stm32mp1_ram.h> |
Yann Gautier | 0c81088 | 2021-12-17 09:53:04 +0100 | [diff] [blame] | 23 | #include <drivers/st/stm32mp_pmic.h> |
Yann Gautier | 658775c | 2021-07-06 10:00:44 +0200 | [diff] [blame] | 24 | #include <lib/fconf/fconf.h> |
| 25 | #include <lib/fconf/fconf_dyn_cfg_getter.h> |
Antonio Nino Diaz | e0f9063 | 2018-12-14 00:18:21 +0000 | [diff] [blame] | 26 | #include <lib/mmio.h> |
Yann Gautier | b3386f7 | 2019-04-19 09:41:01 +0200 | [diff] [blame] | 27 | #include <lib/optee_utils.h> |
Antonio Nino Diaz | e0f9063 | 2018-12-14 00:18:21 +0000 | [diff] [blame] | 28 | #include <lib/xlat_tables/xlat_tables_v2.h> |
| 29 | #include <plat/common/platform.h> |
| 30 | |
Yann Gautier | 0c81088 | 2021-12-17 09:53:04 +0100 | [diff] [blame] | 31 | #include <platform_def.h> |
Yann Gautier | 091eab5 | 2019-06-04 18:06:34 +0200 | [diff] [blame] | 32 | #include <stm32mp1_dbgmcu.h> |
Yann Gautier | 4b0c72a | 2018-07-16 10:54:09 +0200 | [diff] [blame] | 33 | |
Lionel Debieve | 7bd96f4 | 2019-09-03 12:22:23 +0200 | [diff] [blame] | 34 | static struct stm32mp_auth_ops stm32mp1_auth_ops; |
Yann Gautier | 8593e44 | 2018-11-14 18:46:15 +0100 | [diff] [blame] | 35 | |
Yann Gautier | f9d40d5 | 2019-01-17 14:41:46 +0100 | [diff] [blame] | 36 | static void print_reset_reason(void) |
| 37 | { |
Yann Gautier | 3d78a2e | 2019-02-14 11:01:20 +0100 | [diff] [blame] | 38 | uint32_t rstsr = mmio_read_32(stm32mp_rcc_base() + RCC_MP_RSTSCLRR); |
Yann Gautier | f9d40d5 | 2019-01-17 14:41:46 +0100 | [diff] [blame] | 39 | |
| 40 | if (rstsr == 0U) { |
| 41 | WARN("Reset reason unknown\n"); |
| 42 | return; |
| 43 | } |
| 44 | |
| 45 | INFO("Reset reason (0x%x):\n", rstsr); |
| 46 | |
| 47 | if ((rstsr & RCC_MP_RSTSCLRR_PADRSTF) == 0U) { |
| 48 | if ((rstsr & RCC_MP_RSTSCLRR_STDBYRSTF) != 0U) { |
| 49 | INFO("System exits from STANDBY\n"); |
| 50 | return; |
| 51 | } |
| 52 | |
| 53 | if ((rstsr & RCC_MP_RSTSCLRR_CSTDBYRSTF) != 0U) { |
| 54 | INFO("MPU exits from CSTANDBY\n"); |
| 55 | return; |
| 56 | } |
| 57 | } |
| 58 | |
| 59 | if ((rstsr & RCC_MP_RSTSCLRR_PORRSTF) != 0U) { |
| 60 | INFO(" Power-on Reset (rst_por)\n"); |
| 61 | return; |
| 62 | } |
| 63 | |
| 64 | if ((rstsr & RCC_MP_RSTSCLRR_BORRSTF) != 0U) { |
| 65 | INFO(" Brownout Reset (rst_bor)\n"); |
| 66 | return; |
| 67 | } |
| 68 | |
| 69 | if ((rstsr & RCC_MP_RSTSCLRR_MCSYSRSTF) != 0U) { |
| 70 | if ((rstsr & RCC_MP_RSTSCLRR_PADRSTF) != 0U) { |
| 71 | INFO(" System reset generated by MCU (MCSYSRST)\n"); |
| 72 | } else { |
| 73 | INFO(" Local reset generated by MCU (MCSYSRST)\n"); |
| 74 | } |
| 75 | return; |
| 76 | } |
| 77 | |
| 78 | if ((rstsr & RCC_MP_RSTSCLRR_MPSYSRSTF) != 0U) { |
| 79 | INFO(" System reset generated by MPU (MPSYSRST)\n"); |
| 80 | return; |
| 81 | } |
| 82 | |
| 83 | if ((rstsr & RCC_MP_RSTSCLRR_HCSSRSTF) != 0U) { |
| 84 | INFO(" Reset due to a clock failure on HSE\n"); |
| 85 | return; |
| 86 | } |
| 87 | |
| 88 | if ((rstsr & RCC_MP_RSTSCLRR_IWDG1RSTF) != 0U) { |
| 89 | INFO(" IWDG1 Reset (rst_iwdg1)\n"); |
| 90 | return; |
| 91 | } |
| 92 | |
| 93 | if ((rstsr & RCC_MP_RSTSCLRR_IWDG2RSTF) != 0U) { |
| 94 | INFO(" IWDG2 Reset (rst_iwdg2)\n"); |
| 95 | return; |
| 96 | } |
| 97 | |
| 98 | if ((rstsr & RCC_MP_RSTSCLRR_MPUP0RSTF) != 0U) { |
| 99 | INFO(" MPU Processor 0 Reset\n"); |
| 100 | return; |
| 101 | } |
| 102 | |
| 103 | if ((rstsr & RCC_MP_RSTSCLRR_MPUP1RSTF) != 0U) { |
| 104 | INFO(" MPU Processor 1 Reset\n"); |
| 105 | return; |
| 106 | } |
| 107 | |
| 108 | if ((rstsr & RCC_MP_RSTSCLRR_PADRSTF) != 0U) { |
| 109 | INFO(" Pad Reset from NRST\n"); |
| 110 | return; |
| 111 | } |
| 112 | |
| 113 | if ((rstsr & RCC_MP_RSTSCLRR_VCORERSTF) != 0U) { |
| 114 | INFO(" Reset due to a failure of VDD_CORE\n"); |
| 115 | return; |
| 116 | } |
| 117 | |
| 118 | ERROR(" Unidentified reset reason\n"); |
| 119 | } |
| 120 | |
| 121 | void bl2_el3_early_platform_setup(u_register_t arg0, |
| 122 | u_register_t arg1 __unused, |
| 123 | u_register_t arg2 __unused, |
| 124 | u_register_t arg3 __unused) |
Yann Gautier | 4b0c72a | 2018-07-16 10:54:09 +0200 | [diff] [blame] | 125 | { |
Yann Gautier | a2e2a30 | 2019-02-14 11:13:39 +0100 | [diff] [blame] | 126 | stm32mp_save_boot_ctx_address(arg0); |
Yann Gautier | 4b0c72a | 2018-07-16 10:54:09 +0200 | [diff] [blame] | 127 | } |
| 128 | |
| 129 | void bl2_platform_setup(void) |
| 130 | { |
Yann Gautier | caf575b | 2018-07-24 17:18:19 +0200 | [diff] [blame] | 131 | int ret; |
| 132 | |
Yann Gautier | f3928f6 | 2019-02-14 11:15:03 +0100 | [diff] [blame] | 133 | if (dt_pmic_status() > 0) { |
Yann Gautier | bb836ee | 2018-07-16 17:55:07 +0200 | [diff] [blame] | 134 | initialize_pmic(); |
| 135 | } |
| 136 | |
Yann Gautier | caf575b | 2018-07-24 17:18:19 +0200 | [diff] [blame] | 137 | ret = stm32mp1_ddr_probe(); |
| 138 | if (ret < 0) { |
| 139 | ERROR("Invalid DDR init: error %d\n", ret); |
| 140 | panic(); |
| 141 | } |
| 142 | |
Yann Gautier | f3bd87e | 2020-09-04 15:55:53 +0200 | [diff] [blame] | 143 | /* Map DDR for binary load, now with cacheable attribute */ |
Yann Gautier | a55169b | 2020-01-10 18:18:59 +0100 | [diff] [blame] | 144 | ret = mmap_add_dynamic_region(STM32MP_DDR_BASE, STM32MP_DDR_BASE, |
Yann Gautier | f3bd87e | 2020-09-04 15:55:53 +0200 | [diff] [blame] | 145 | STM32MP_DDR_MAX_SIZE, MT_MEMORY | MT_RW | MT_SECURE); |
| 146 | if (ret < 0) { |
| 147 | ERROR("DDR mapping: error %d\n", ret); |
| 148 | panic(); |
| 149 | } |
Yann Gautier | a55169b | 2020-01-10 18:18:59 +0100 | [diff] [blame] | 150 | |
Yann Gautier | 0ed7b2a | 2021-05-19 18:48:16 +0200 | [diff] [blame] | 151 | #if STM32MP_USE_STM32IMAGE |
Yann Gautier | b3386f7 | 2019-04-19 09:41:01 +0200 | [diff] [blame] | 152 | #ifdef AARCH32_SP_OPTEE |
| 153 | INFO("BL2 runs OP-TEE setup\n"); |
Yann Gautier | b3386f7 | 2019-04-19 09:41:01 +0200 | [diff] [blame] | 154 | #else |
Yann Gautier | 4b0c72a | 2018-07-16 10:54:09 +0200 | [diff] [blame] | 155 | INFO("BL2 runs SP_MIN setup\n"); |
Yann Gautier | b3386f7 | 2019-04-19 09:41:01 +0200 | [diff] [blame] | 156 | #endif |
Yann Gautier | 0ed7b2a | 2021-05-19 18:48:16 +0200 | [diff] [blame] | 157 | #endif /* STM32MP_USE_STM32IMAGE */ |
Yann Gautier | 4b0c72a | 2018-07-16 10:54:09 +0200 | [diff] [blame] | 158 | } |
| 159 | |
| 160 | void bl2_el3_plat_arch_setup(void) |
| 161 | { |
Yann Gautier | 69035a8 | 2018-07-05 16:48:16 +0200 | [diff] [blame] | 162 | int32_t result; |
Yann Gautier | 69035a8 | 2018-07-05 16:48:16 +0200 | [diff] [blame] | 163 | const char *board_model; |
Yann Gautier | 4193466 | 2018-07-20 11:36:05 +0200 | [diff] [blame] | 164 | boot_api_context_t *boot_context = |
Yann Gautier | a2e2a30 | 2019-02-14 11:13:39 +0100 | [diff] [blame] | 165 | (boot_api_context_t *)stm32mp_get_boot_ctx_address(); |
Yann Gautier | 3d78a2e | 2019-02-14 11:01:20 +0100 | [diff] [blame] | 166 | uintptr_t pwr_base; |
| 167 | uintptr_t rcc_base; |
Yann Gautier | 4193466 | 2018-07-20 11:36:05 +0200 | [diff] [blame] | 168 | |
Yann Gautier | f9d40d5 | 2019-01-17 14:41:46 +0100 | [diff] [blame] | 169 | mmap_add_region(BL_CODE_BASE, BL_CODE_BASE, |
| 170 | BL_CODE_END - BL_CODE_BASE, |
| 171 | MT_CODE | MT_SECURE); |
| 172 | |
Yann Gautier | 0ed7b2a | 2021-05-19 18:48:16 +0200 | [diff] [blame] | 173 | #if STM32MP_USE_STM32IMAGE |
Yann Gautier | b3386f7 | 2019-04-19 09:41:01 +0200 | [diff] [blame] | 174 | #ifdef AARCH32_SP_OPTEE |
Yann Gautier | b3386f7 | 2019-04-19 09:41:01 +0200 | [diff] [blame] | 175 | mmap_add_region(STM32MP_OPTEE_BASE, STM32MP_OPTEE_BASE, |
| 176 | STM32MP_OPTEE_SIZE, |
| 177 | MT_MEMORY | MT_RW | MT_SECURE); |
Yann Gautier | 90f84d7 | 2021-07-13 14:44:09 +0200 | [diff] [blame] | 178 | #else |
| 179 | /* Prevent corruption of preloaded BL32 */ |
| 180 | mmap_add_region(BL32_BASE, BL32_BASE, |
| 181 | BL32_LIMIT - BL32_BASE, |
| 182 | MT_RO_DATA | MT_SECURE); |
Yann Gautier | b3386f7 | 2019-04-19 09:41:01 +0200 | [diff] [blame] | 183 | #endif |
Yann Gautier | 0ed7b2a | 2021-05-19 18:48:16 +0200 | [diff] [blame] | 184 | #endif /* STM32MP_USE_STM32IMAGE */ |
| 185 | |
Yann Gautier | f9d40d5 | 2019-01-17 14:41:46 +0100 | [diff] [blame] | 186 | /* Prevent corruption of preloaded Device Tree */ |
| 187 | mmap_add_region(DTB_BASE, DTB_BASE, |
| 188 | DTB_LIMIT - DTB_BASE, |
Yann Gautier | 3d33df6 | 2019-12-17 17:11:10 +0100 | [diff] [blame] | 189 | MT_RO_DATA | MT_SECURE); |
Yann Gautier | f9d40d5 | 2019-01-17 14:41:46 +0100 | [diff] [blame] | 190 | |
| 191 | configure_mmu(); |
| 192 | |
Yann Gautier | 05773eb | 2020-08-24 11:51:50 +0200 | [diff] [blame] | 193 | if (dt_open_and_check(STM32MP_DTB_BASE) < 0) { |
Yann Gautier | f9d40d5 | 2019-01-17 14:41:46 +0100 | [diff] [blame] | 194 | panic(); |
| 195 | } |
| 196 | |
Yann Gautier | 3d78a2e | 2019-02-14 11:01:20 +0100 | [diff] [blame] | 197 | pwr_base = stm32mp_pwr_base(); |
| 198 | rcc_base = stm32mp_rcc_base(); |
| 199 | |
Yann Gautier | 4b0c72a | 2018-07-16 10:54:09 +0200 | [diff] [blame] | 200 | /* |
| 201 | * Disable the backup domain write protection. |
| 202 | * The protection is enable at each reset by hardware |
| 203 | * and must be disabled by software. |
| 204 | */ |
Yann Gautier | 3d78a2e | 2019-02-14 11:01:20 +0100 | [diff] [blame] | 205 | mmio_setbits_32(pwr_base + PWR_CR1, PWR_CR1_DBP); |
Yann Gautier | 4b0c72a | 2018-07-16 10:54:09 +0200 | [diff] [blame] | 206 | |
Yann Gautier | 3d78a2e | 2019-02-14 11:01:20 +0100 | [diff] [blame] | 207 | while ((mmio_read_32(pwr_base + PWR_CR1) & PWR_CR1_DBP) == 0U) { |
Yann Gautier | 4b0c72a | 2018-07-16 10:54:09 +0200 | [diff] [blame] | 208 | ; |
| 209 | } |
| 210 | |
Yann Gautier | 3edc7c3 | 2019-05-20 19:17:08 +0200 | [diff] [blame] | 211 | if (bsec_probe() != 0) { |
| 212 | panic(); |
| 213 | } |
| 214 | |
Yann Gautier | 4b0c72a | 2018-07-16 10:54:09 +0200 | [diff] [blame] | 215 | /* Reset backup domain on cold boot cases */ |
Yann Gautier | 3d78a2e | 2019-02-14 11:01:20 +0100 | [diff] [blame] | 216 | if ((mmio_read_32(rcc_base + RCC_BDCR) & RCC_BDCR_RTCSRC_MASK) == 0U) { |
| 217 | mmio_setbits_32(rcc_base + RCC_BDCR, RCC_BDCR_VSWRST); |
Yann Gautier | 4b0c72a | 2018-07-16 10:54:09 +0200 | [diff] [blame] | 218 | |
Yann Gautier | 3d78a2e | 2019-02-14 11:01:20 +0100 | [diff] [blame] | 219 | while ((mmio_read_32(rcc_base + RCC_BDCR) & RCC_BDCR_VSWRST) == |
Yann Gautier | 4b0c72a | 2018-07-16 10:54:09 +0200 | [diff] [blame] | 220 | 0U) { |
| 221 | ; |
| 222 | } |
| 223 | |
Yann Gautier | 3d78a2e | 2019-02-14 11:01:20 +0100 | [diff] [blame] | 224 | mmio_clrbits_32(rcc_base + RCC_BDCR, RCC_BDCR_VSWRST); |
Yann Gautier | 4b0c72a | 2018-07-16 10:54:09 +0200 | [diff] [blame] | 225 | } |
| 226 | |
Yann Gautier | ed34232 | 2019-02-15 17:33:27 +0100 | [diff] [blame] | 227 | /* Disable MCKPROT */ |
| 228 | mmio_clrbits_32(rcc_base + RCC_TZCR, RCC_TZCR_MCKPROT); |
| 229 | |
Yann Gautier | 4b0c72a | 2018-07-16 10:54:09 +0200 | [diff] [blame] | 230 | generic_delay_timer_init(); |
| 231 | |
Yann Gautier | 3d8497c | 2021-10-18 16:06:22 +0200 | [diff] [blame] | 232 | #if STM32MP_UART_PROGRAMMER |
| 233 | /* Disable programmer UART before changing clock tree */ |
| 234 | if (boot_context->boot_interface_selected == |
| 235 | BOOT_API_CTX_BOOT_INTERFACE_SEL_SERIAL_UART) { |
| 236 | uintptr_t uart_prog_addr = |
| 237 | get_uart_address(boot_context->boot_interface_instance); |
| 238 | |
| 239 | stm32_uart_stop(uart_prog_addr); |
| 240 | } |
| 241 | #endif |
Yann Gautier | 9aea69e | 2018-07-24 17:13:36 +0200 | [diff] [blame] | 242 | if (stm32mp1_clk_probe() < 0) { |
| 243 | panic(); |
| 244 | } |
| 245 | |
| 246 | if (stm32mp1_clk_init() < 0) { |
| 247 | panic(); |
| 248 | } |
| 249 | |
Yann Gautier | 3edc7c3 | 2019-05-20 19:17:08 +0200 | [diff] [blame] | 250 | stm32mp1_syscfg_init(); |
| 251 | |
Yann Gautier | 6eef525 | 2021-12-10 17:04:40 +0100 | [diff] [blame] | 252 | stm32_save_boot_interface(boot_context->boot_interface_selected, |
| 253 | boot_context->boot_interface_instance); |
| 254 | |
Yann Gautier | cd16df3 | 2021-06-04 14:04:05 +0200 | [diff] [blame] | 255 | #if STM32MP_USB_PROGRAMMER |
| 256 | /* Deconfigure all UART RX pins configured by ROM code */ |
| 257 | stm32mp1_deconfigure_uart_pins(); |
| 258 | #endif |
| 259 | |
Yann Gautier | 66baa96 | 2021-10-18 14:01:00 +0200 | [diff] [blame] | 260 | if (stm32mp_uart_console_setup() != 0) { |
Yann Gautier | 69035a8 | 2018-07-05 16:48:16 +0200 | [diff] [blame] | 261 | goto skip_console_init; |
| 262 | } |
| 263 | |
Yann Gautier | c737405 | 2019-06-04 18:02:37 +0200 | [diff] [blame] | 264 | stm32mp_print_cpuinfo(); |
| 265 | |
Yann Gautier | 69035a8 | 2018-07-05 16:48:16 +0200 | [diff] [blame] | 266 | board_model = dt_get_board_model(); |
| 267 | if (board_model != NULL) { |
Yann Gautier | f9d40d5 | 2019-01-17 14:41:46 +0100 | [diff] [blame] | 268 | NOTICE("Model: %s\n", board_model); |
Yann Gautier | 69035a8 | 2018-07-05 16:48:16 +0200 | [diff] [blame] | 269 | } |
| 270 | |
Yann Gautier | 35dc077 | 2019-05-13 18:34:48 +0200 | [diff] [blame] | 271 | stm32mp_print_boardinfo(); |
| 272 | |
Lionel Debieve | 7bd96f4 | 2019-09-03 12:22:23 +0200 | [diff] [blame] | 273 | if (boot_context->auth_status != BOOT_API_CTX_AUTH_NO) { |
| 274 | NOTICE("Bootrom authentication %s\n", |
| 275 | (boot_context->auth_status == BOOT_API_CTX_AUTH_FAILED) ? |
| 276 | "failed" : "succeeded"); |
| 277 | } |
| 278 | |
Yann Gautier | 69035a8 | 2018-07-05 16:48:16 +0200 | [diff] [blame] | 279 | skip_console_init: |
Yann Gautier | 091eab5 | 2019-06-04 18:06:34 +0200 | [diff] [blame] | 280 | if (stm32_iwdg_init() < 0) { |
| 281 | panic(); |
| 282 | } |
| 283 | |
| 284 | stm32_iwdg_refresh(); |
| 285 | |
| 286 | result = stm32mp1_dbgmcu_freeze_iwdg2(); |
| 287 | if (result != 0) { |
| 288 | INFO("IWDG2 freeze error : %i\n", result); |
| 289 | } |
Yann Gautier | 69035a8 | 2018-07-05 16:48:16 +0200 | [diff] [blame] | 290 | |
Lionel Debieve | 7bd96f4 | 2019-09-03 12:22:23 +0200 | [diff] [blame] | 291 | stm32mp1_auth_ops.check_key = boot_context->bootrom_ecdsa_check_key; |
| 292 | stm32mp1_auth_ops.verify_signature = |
| 293 | boot_context->bootrom_ecdsa_verify_signature; |
| 294 | |
| 295 | stm32mp_init_auth(&stm32mp1_auth_ops); |
| 296 | |
Yann Gautier | caf575b | 2018-07-24 17:18:19 +0200 | [diff] [blame] | 297 | stm32mp1_arch_security_setup(); |
| 298 | |
Yann Gautier | f9d40d5 | 2019-01-17 14:41:46 +0100 | [diff] [blame] | 299 | print_reset_reason(); |
| 300 | |
Yann Gautier | 29f1f94 | 2021-07-13 18:07:41 +0200 | [diff] [blame] | 301 | #if !STM32MP_USE_STM32IMAGE |
| 302 | fconf_populate("TB_FW", STM32MP_DTB_BASE); |
| 303 | #endif /* !STM32MP_USE_STM32IMAGE */ |
| 304 | |
Yann Gautier | a2e2a30 | 2019-02-14 11:13:39 +0100 | [diff] [blame] | 305 | stm32mp_io_setup(); |
Yann Gautier | 4b0c72a | 2018-07-16 10:54:09 +0200 | [diff] [blame] | 306 | } |
Yann Gautier | b3386f7 | 2019-04-19 09:41:01 +0200 | [diff] [blame] | 307 | |
Yann Gautier | b3386f7 | 2019-04-19 09:41:01 +0200 | [diff] [blame] | 308 | /******************************************************************************* |
| 309 | * This function can be used by the platforms to update/use image |
| 310 | * information for given `image_id`. |
| 311 | ******************************************************************************/ |
| 312 | int bl2_plat_handle_post_image_load(unsigned int image_id) |
| 313 | { |
| 314 | int err = 0; |
| 315 | bl_mem_params_node_t *bl_mem_params = get_bl_mem_params_node(image_id); |
| 316 | bl_mem_params_node_t *bl32_mem_params; |
Yann Gautier | 0ed7b2a | 2021-05-19 18:48:16 +0200 | [diff] [blame] | 317 | bl_mem_params_node_t *pager_mem_params __unused; |
| 318 | bl_mem_params_node_t *paged_mem_params __unused; |
Yann Gautier | 658775c | 2021-07-06 10:00:44 +0200 | [diff] [blame] | 319 | #if !STM32MP_USE_STM32IMAGE |
| 320 | const struct dyn_cfg_dtb_info_t *config_info; |
| 321 | bl_mem_params_node_t *tos_fw_mem_params; |
| 322 | unsigned int i; |
Yann Gautier | fd64835 | 2021-12-13 15:24:41 +0100 | [diff] [blame] | 323 | unsigned int idx; |
Yann Gautier | 658775c | 2021-07-06 10:00:44 +0200 | [diff] [blame] | 324 | unsigned long long ddr_top __unused; |
| 325 | const unsigned int image_ids[] = { |
| 326 | BL32_IMAGE_ID, |
| 327 | BL33_IMAGE_ID, |
| 328 | HW_CONFIG_ID, |
| 329 | TOS_FW_CONFIG_ID, |
| 330 | }; |
| 331 | #endif /* !STM32MP_USE_STM32IMAGE */ |
Yann Gautier | b3386f7 | 2019-04-19 09:41:01 +0200 | [diff] [blame] | 332 | |
| 333 | assert(bl_mem_params != NULL); |
| 334 | |
| 335 | switch (image_id) { |
Yann Gautier | 658775c | 2021-07-06 10:00:44 +0200 | [diff] [blame] | 336 | #if !STM32MP_USE_STM32IMAGE |
| 337 | case FW_CONFIG_ID: |
| 338 | /* Set global DTB info for fixed fw_config information */ |
| 339 | set_config_info(STM32MP_FW_CONFIG_BASE, STM32MP_FW_CONFIG_MAX_SIZE, FW_CONFIG_ID); |
| 340 | fconf_populate("FW_CONFIG", STM32MP_FW_CONFIG_BASE); |
| 341 | |
Yann Gautier | fd64835 | 2021-12-13 15:24:41 +0100 | [diff] [blame] | 342 | idx = dyn_cfg_dtb_info_get_index(TOS_FW_CONFIG_ID); |
| 343 | |
Yann Gautier | 658775c | 2021-07-06 10:00:44 +0200 | [diff] [blame] | 344 | /* Iterate through all the fw config IDs */ |
| 345 | for (i = 0U; i < ARRAY_SIZE(image_ids); i++) { |
Yann Gautier | fd64835 | 2021-12-13 15:24:41 +0100 | [diff] [blame] | 346 | if ((image_ids[i] == TOS_FW_CONFIG_ID) && (idx == FCONF_INVALID_IDX)) { |
| 347 | continue; |
| 348 | } |
| 349 | |
Yann Gautier | 658775c | 2021-07-06 10:00:44 +0200 | [diff] [blame] | 350 | bl_mem_params = get_bl_mem_params_node(image_ids[i]); |
| 351 | assert(bl_mem_params != NULL); |
| 352 | |
| 353 | config_info = FCONF_GET_PROPERTY(dyn_cfg, dtb, image_ids[i]); |
| 354 | if (config_info == NULL) { |
| 355 | continue; |
| 356 | } |
| 357 | |
| 358 | bl_mem_params->image_info.image_base = config_info->config_addr; |
| 359 | bl_mem_params->image_info.image_max_size = config_info->config_max_size; |
| 360 | |
| 361 | bl_mem_params->image_info.h.attr &= ~IMAGE_ATTRIB_SKIP_LOADING; |
| 362 | |
| 363 | switch (image_ids[i]) { |
| 364 | case BL32_IMAGE_ID: |
| 365 | bl_mem_params->ep_info.pc = config_info->config_addr; |
| 366 | |
| 367 | /* In case of OPTEE, initialize address space with tos_fw addr */ |
| 368 | pager_mem_params = get_bl_mem_params_node(BL32_EXTRA1_IMAGE_ID); |
| 369 | pager_mem_params->image_info.image_base = config_info->config_addr; |
| 370 | pager_mem_params->image_info.image_max_size = |
| 371 | config_info->config_max_size; |
| 372 | |
| 373 | /* Init base and size for pager if exist */ |
| 374 | paged_mem_params = get_bl_mem_params_node(BL32_EXTRA2_IMAGE_ID); |
| 375 | paged_mem_params->image_info.image_base = STM32MP_DDR_BASE + |
| 376 | (dt_get_ddr_size() - STM32MP_DDR_S_SIZE - |
| 377 | STM32MP_DDR_SHMEM_SIZE); |
| 378 | paged_mem_params->image_info.image_max_size = STM32MP_DDR_S_SIZE; |
| 379 | break; |
| 380 | |
| 381 | case BL33_IMAGE_ID: |
| 382 | bl_mem_params->ep_info.pc = config_info->config_addr; |
| 383 | break; |
| 384 | |
| 385 | case HW_CONFIG_ID: |
| 386 | case TOS_FW_CONFIG_ID: |
| 387 | break; |
| 388 | |
| 389 | default: |
| 390 | return -EINVAL; |
| 391 | } |
| 392 | } |
| 393 | break; |
| 394 | #endif /* !STM32MP_USE_STM32IMAGE */ |
| 395 | |
Yann Gautier | b3386f7 | 2019-04-19 09:41:01 +0200 | [diff] [blame] | 396 | case BL32_IMAGE_ID: |
Yann Gautier | 90f84d7 | 2021-07-13 14:44:09 +0200 | [diff] [blame] | 397 | if (optee_header_is_valid(bl_mem_params->image_info.image_base)) { |
| 398 | /* BL32 is OP-TEE header */ |
| 399 | bl_mem_params->ep_info.pc = bl_mem_params->image_info.image_base; |
| 400 | pager_mem_params = get_bl_mem_params_node(BL32_EXTRA1_IMAGE_ID); |
| 401 | paged_mem_params = get_bl_mem_params_node(BL32_EXTRA2_IMAGE_ID); |
| 402 | assert((pager_mem_params != NULL) && (paged_mem_params != NULL)); |
Yann Gautier | b3386f7 | 2019-04-19 09:41:01 +0200 | [diff] [blame] | 403 | |
Yann Gautier | 0ed7b2a | 2021-05-19 18:48:16 +0200 | [diff] [blame] | 404 | #if STM32MP_USE_STM32IMAGE && defined(AARCH32_SP_OPTEE) |
Yann Gautier | 90f84d7 | 2021-07-13 14:44:09 +0200 | [diff] [blame] | 405 | /* Set OP-TEE extra image load areas at run-time */ |
| 406 | pager_mem_params->image_info.image_base = STM32MP_OPTEE_BASE; |
| 407 | pager_mem_params->image_info.image_max_size = STM32MP_OPTEE_SIZE; |
Yann Gautier | b3386f7 | 2019-04-19 09:41:01 +0200 | [diff] [blame] | 408 | |
Yann Gautier | 90f84d7 | 2021-07-13 14:44:09 +0200 | [diff] [blame] | 409 | paged_mem_params->image_info.image_base = STM32MP_DDR_BASE + |
| 410 | dt_get_ddr_size() - |
| 411 | STM32MP_DDR_S_SIZE - |
| 412 | STM32MP_DDR_SHMEM_SIZE; |
| 413 | paged_mem_params->image_info.image_max_size = STM32MP_DDR_S_SIZE; |
Yann Gautier | 0ed7b2a | 2021-05-19 18:48:16 +0200 | [diff] [blame] | 414 | #endif /* STM32MP_USE_STM32IMAGE && defined(AARCH32_SP_OPTEE) */ |
Yann Gautier | b3386f7 | 2019-04-19 09:41:01 +0200 | [diff] [blame] | 415 | |
Yann Gautier | 90f84d7 | 2021-07-13 14:44:09 +0200 | [diff] [blame] | 416 | err = parse_optee_header(&bl_mem_params->ep_info, |
| 417 | &pager_mem_params->image_info, |
| 418 | &paged_mem_params->image_info); |
| 419 | if (err) { |
| 420 | ERROR("OPTEE header parse error.\n"); |
| 421 | panic(); |
| 422 | } |
Yann Gautier | b3386f7 | 2019-04-19 09:41:01 +0200 | [diff] [blame] | 423 | |
Yann Gautier | 90f84d7 | 2021-07-13 14:44:09 +0200 | [diff] [blame] | 424 | /* Set optee boot info from parsed header data */ |
| 425 | bl_mem_params->ep_info.args.arg0 = paged_mem_params->image_info.image_base; |
| 426 | bl_mem_params->ep_info.args.arg1 = 0; /* Unused */ |
| 427 | bl_mem_params->ep_info.args.arg2 = 0; /* No DT supported */ |
Yann Gautier | 0ed7b2a | 2021-05-19 18:48:16 +0200 | [diff] [blame] | 428 | } else { |
| 429 | #if !STM32MP_USE_STM32IMAGE |
| 430 | bl_mem_params->ep_info.pc = bl_mem_params->image_info.image_base; |
Yann Gautier | 658775c | 2021-07-06 10:00:44 +0200 | [diff] [blame] | 431 | tos_fw_mem_params = get_bl_mem_params_node(TOS_FW_CONFIG_ID); |
| 432 | bl_mem_params->image_info.image_max_size += |
| 433 | tos_fw_mem_params->image_info.image_max_size; |
Yann Gautier | 0ed7b2a | 2021-05-19 18:48:16 +0200 | [diff] [blame] | 434 | #endif /* !STM32MP_USE_STM32IMAGE */ |
| 435 | bl_mem_params->ep_info.args.arg0 = 0; |
Yann Gautier | 90f84d7 | 2021-07-13 14:44:09 +0200 | [diff] [blame] | 436 | } |
Yann Gautier | b3386f7 | 2019-04-19 09:41:01 +0200 | [diff] [blame] | 437 | break; |
| 438 | |
| 439 | case BL33_IMAGE_ID: |
| 440 | bl32_mem_params = get_bl_mem_params_node(BL32_IMAGE_ID); |
| 441 | assert(bl32_mem_params != NULL); |
| 442 | bl32_mem_params->ep_info.lr_svc = bl_mem_params->ep_info.pc; |
| 443 | break; |
| 444 | |
| 445 | default: |
| 446 | /* Do nothing in default case */ |
| 447 | break; |
| 448 | } |
| 449 | |
Yann Gautier | a3bd8d1 | 2021-06-18 11:33:26 +0200 | [diff] [blame] | 450 | #if STM32MP_SDMMC || STM32MP_EMMC |
| 451 | /* |
| 452 | * Invalidate remaining data read from MMC but not flushed by load_image_flush(). |
| 453 | * We take the worst case which is 2 MMC blocks. |
| 454 | */ |
| 455 | if ((image_id != FW_CONFIG_ID) && |
| 456 | ((bl_mem_params->image_info.h.attr & IMAGE_ATTRIB_SKIP_LOADING) == 0U)) { |
| 457 | inv_dcache_range(bl_mem_params->image_info.image_base + |
| 458 | bl_mem_params->image_info.image_size, |
| 459 | 2U * MMC_BLOCK_SIZE); |
| 460 | } |
| 461 | #endif /* STM32MP_SDMMC || STM32MP_EMMC */ |
| 462 | |
Yann Gautier | b3386f7 | 2019-04-19 09:41:01 +0200 | [diff] [blame] | 463 | return err; |
| 464 | } |
Yann Gautier | d2d9b96 | 2021-08-16 11:58:01 +0200 | [diff] [blame] | 465 | |
| 466 | void bl2_el3_plat_prepare_exit(void) |
| 467 | { |
Patrick Delaunay | 9c5ee78 | 2021-07-06 14:07:56 +0200 | [diff] [blame] | 468 | uint16_t boot_itf = stm32mp_get_boot_itf_selected(); |
| 469 | |
| 470 | switch (boot_itf) { |
Patrick Delaunay | e50571b | 2021-10-28 13:48:52 +0200 | [diff] [blame] | 471 | #if STM32MP_UART_PROGRAMMER || STM32MP_USB_PROGRAMMER |
| 472 | case BOOT_API_CTX_BOOT_INTERFACE_SEL_SERIAL_UART: |
Patrick Delaunay | 9c5ee78 | 2021-07-06 14:07:56 +0200 | [diff] [blame] | 473 | case BOOT_API_CTX_BOOT_INTERFACE_SEL_SERIAL_USB: |
| 474 | /* Invalidate the downloaded buffer used with io_memmap */ |
| 475 | inv_dcache_range(DWL_BUFFER_BASE, DWL_BUFFER_SIZE); |
| 476 | break; |
Patrick Delaunay | e50571b | 2021-10-28 13:48:52 +0200 | [diff] [blame] | 477 | #endif /* STM32MP_UART_PROGRAMMER || STM32MP_USB_PROGRAMMER */ |
Patrick Delaunay | 9c5ee78 | 2021-07-06 14:07:56 +0200 | [diff] [blame] | 478 | default: |
| 479 | /* Do nothing in default case */ |
| 480 | break; |
| 481 | } |
| 482 | |
Yann Gautier | d2d9b96 | 2021-08-16 11:58:01 +0200 | [diff] [blame] | 483 | stm32mp1_security_setup(); |
| 484 | } |