Yann Gautier | ee8f542 | 2019-02-14 11:13:25 +0100 | [diff] [blame] | 1 | /* |
Yann Gautier | 352d863 | 2020-09-17 11:38:09 +0200 | [diff] [blame] | 2 | * Copyright (c) 2015-2022, ARM Limited and Contributors. All rights reserved. |
Yann Gautier | ee8f542 | 2019-02-14 11:13:25 +0100 | [diff] [blame] | 3 | * |
| 4 | * SPDX-License-Identifier: BSD-3-Clause |
| 5 | */ |
| 6 | |
Yann Gautier | e3bf913 | 2019-05-07 18:52:17 +0200 | [diff] [blame] | 7 | #include <assert.h> |
| 8 | |
Yann Gautier | a205a5c | 2021-08-30 15:06:54 +0200 | [diff] [blame] | 9 | #include <drivers/clk.h> |
Yann Gautier | cd16df3 | 2021-06-04 14:04:05 +0200 | [diff] [blame] | 10 | #include <drivers/st/stm32_gpio.h> |
| 11 | #include <drivers/st/stm32_iwdg.h> |
Yann Gautier | 6eef525 | 2021-12-10 17:04:40 +0100 | [diff] [blame] | 12 | #include <lib/mmio.h> |
Yann Gautier | cd16df3 | 2021-06-04 14:04:05 +0200 | [diff] [blame] | 13 | #include <lib/xlat_tables/xlat_tables_v2.h> |
Yann Gautier | 0c81088 | 2021-12-17 09:53:04 +0100 | [diff] [blame] | 14 | #include <libfdt.h> |
Yann Gautier | 35dc077 | 2019-05-13 18:34:48 +0200 | [diff] [blame] | 15 | |
Sughosh Ganu | 03e2f80 | 2021-12-01 15:56:27 +0530 | [diff] [blame] | 16 | #include <plat/common/platform.h> |
Yann Gautier | ee8f542 | 2019-02-14 11:13:25 +0100 | [diff] [blame] | 17 | #include <platform_def.h> |
| 18 | |
Yann Gautier | 35dc077 | 2019-05-13 18:34:48 +0200 | [diff] [blame] | 19 | /* Internal layout of the 32bit OTP word board_id */ |
| 20 | #define BOARD_ID_BOARD_NB_MASK GENMASK(31, 16) |
| 21 | #define BOARD_ID_BOARD_NB_SHIFT 16 |
Patrick Delaunay | 7704f16 | 2020-01-08 10:05:14 +0100 | [diff] [blame] | 22 | #define BOARD_ID_VARCPN_MASK GENMASK(15, 12) |
| 23 | #define BOARD_ID_VARCPN_SHIFT 12 |
Yann Gautier | 35dc077 | 2019-05-13 18:34:48 +0200 | [diff] [blame] | 24 | #define BOARD_ID_REVISION_MASK GENMASK(11, 8) |
| 25 | #define BOARD_ID_REVISION_SHIFT 8 |
Patrick Delaunay | 7704f16 | 2020-01-08 10:05:14 +0100 | [diff] [blame] | 26 | #define BOARD_ID_VARFG_MASK GENMASK(7, 4) |
| 27 | #define BOARD_ID_VARFG_SHIFT 4 |
Yann Gautier | 35dc077 | 2019-05-13 18:34:48 +0200 | [diff] [blame] | 28 | #define BOARD_ID_BOM_MASK GENMASK(3, 0) |
| 29 | |
| 30 | #define BOARD_ID2NB(_id) (((_id) & BOARD_ID_BOARD_NB_MASK) >> \ |
| 31 | BOARD_ID_BOARD_NB_SHIFT) |
Patrick Delaunay | 7704f16 | 2020-01-08 10:05:14 +0100 | [diff] [blame] | 32 | #define BOARD_ID2VARCPN(_id) (((_id) & BOARD_ID_VARCPN_MASK) >> \ |
| 33 | BOARD_ID_VARCPN_SHIFT) |
Yann Gautier | 35dc077 | 2019-05-13 18:34:48 +0200 | [diff] [blame] | 34 | #define BOARD_ID2REV(_id) (((_id) & BOARD_ID_REVISION_MASK) >> \ |
| 35 | BOARD_ID_REVISION_SHIFT) |
Patrick Delaunay | 7704f16 | 2020-01-08 10:05:14 +0100 | [diff] [blame] | 36 | #define BOARD_ID2VARFG(_id) (((_id) & BOARD_ID_VARFG_MASK) >> \ |
| 37 | BOARD_ID_VARFG_SHIFT) |
Yann Gautier | 35dc077 | 2019-05-13 18:34:48 +0200 | [diff] [blame] | 38 | #define BOARD_ID2BOM(_id) ((_id) & BOARD_ID_BOM_MASK) |
| 39 | |
Yann Gautier | 8200047 | 2020-02-05 16:24:21 +0100 | [diff] [blame] | 40 | #if STM32MP13 |
| 41 | #define TAMP_BOOT_MODE_BACKUP_REG_ID U(30) |
| 42 | #endif |
| 43 | #if STM32MP15 |
Yann Gautier | 6eef525 | 2021-12-10 17:04:40 +0100 | [diff] [blame] | 44 | #define TAMP_BOOT_MODE_BACKUP_REG_ID U(20) |
Yann Gautier | 8200047 | 2020-02-05 16:24:21 +0100 | [diff] [blame] | 45 | #endif |
Igor Opaniuk | f07e8f3 | 2022-06-23 21:19:26 +0300 | [diff] [blame] | 46 | #define TAMP_BOOT_MODE_ITF_MASK GENMASK(15, 8) |
Yann Gautier | 6eef525 | 2021-12-10 17:04:40 +0100 | [diff] [blame] | 47 | #define TAMP_BOOT_MODE_ITF_SHIFT 8 |
Igor Opaniuk | f07e8f3 | 2022-06-23 21:19:26 +0300 | [diff] [blame] | 48 | #define TAMP_BOOT_MODE_AUTH_MASK GENMASK(23, 16) |
| 49 | #define TAMP_BOOT_MODE_AUTH_SHIFT 16 |
Yann Gautier | 6eef525 | 2021-12-10 17:04:40 +0100 | [diff] [blame] | 50 | |
Yann Gautier | 9bbd26a | 2022-03-28 17:49:38 +0200 | [diff] [blame] | 51 | /* |
| 52 | * Backup register to store fwu update information. |
| 53 | * It should be writeable only by secure world, but also readable by non secure |
| 54 | * (so it should be in Zone 2). |
| 55 | */ |
| 56 | #define TAMP_BOOT_FWU_INFO_REG_ID U(10) |
Igor Opaniuk | f07e8f3 | 2022-06-23 21:19:26 +0300 | [diff] [blame] | 57 | #define TAMP_BOOT_FWU_INFO_IDX_MSK GENMASK(3, 0) |
Yann Gautier | 9bbd26a | 2022-03-28 17:49:38 +0200 | [diff] [blame] | 58 | #define TAMP_BOOT_FWU_INFO_IDX_OFF U(0) |
Igor Opaniuk | f07e8f3 | 2022-06-23 21:19:26 +0300 | [diff] [blame] | 59 | #define TAMP_BOOT_FWU_INFO_CNT_MSK GENMASK(7, 4) |
Yann Gautier | 9bbd26a | 2022-03-28 17:49:38 +0200 | [diff] [blame] | 60 | #define TAMP_BOOT_FWU_INFO_CNT_OFF U(4) |
Sughosh Ganu | 03e2f80 | 2021-12-01 15:56:27 +0530 | [diff] [blame] | 61 | |
Etienne Carriere | 72369b1 | 2019-12-08 08:17:56 +0100 | [diff] [blame] | 62 | #if defined(IMAGE_BL2) |
| 63 | #define MAP_SEC_SYSRAM MAP_REGION_FLAT(STM32MP_SYSRAM_BASE, \ |
Yann Gautier | a2e2a30 | 2019-02-14 11:13:39 +0100 | [diff] [blame] | 64 | STM32MP_SYSRAM_SIZE, \ |
Yann Gautier | ee8f542 | 2019-02-14 11:13:25 +0100 | [diff] [blame] | 65 | MT_MEMORY | \ |
| 66 | MT_RW | \ |
| 67 | MT_SECURE | \ |
| 68 | MT_EXECUTE_NEVER) |
Etienne Carriere | 72369b1 | 2019-12-08 08:17:56 +0100 | [diff] [blame] | 69 | #elif defined(IMAGE_BL32) |
| 70 | #define MAP_SEC_SYSRAM MAP_REGION_FLAT(STM32MP_SEC_SYSRAM_BASE, \ |
| 71 | STM32MP_SEC_SYSRAM_SIZE, \ |
| 72 | MT_MEMORY | \ |
| 73 | MT_RW | \ |
| 74 | MT_SECURE | \ |
| 75 | MT_EXECUTE_NEVER) |
Yann Gautier | ee8f542 | 2019-02-14 11:13:25 +0100 | [diff] [blame] | 76 | |
Etienne Carriere | 72369b1 | 2019-12-08 08:17:56 +0100 | [diff] [blame] | 77 | /* Non-secure SYSRAM is used a uncached memory for SCMI message transfer */ |
| 78 | #define MAP_NS_SYSRAM MAP_REGION_FLAT(STM32MP_NS_SYSRAM_BASE, \ |
| 79 | STM32MP_NS_SYSRAM_SIZE, \ |
| 80 | MT_DEVICE | \ |
| 81 | MT_RW | \ |
| 82 | MT_NS | \ |
| 83 | MT_EXECUTE_NEVER) |
| 84 | #endif |
| 85 | |
Yann Gautier | 84d994b | 2020-04-14 18:08:50 +0200 | [diff] [blame] | 86 | #if STM32MP13 |
| 87 | #define MAP_SRAM_ALL MAP_REGION_FLAT(SRAMS_BASE, \ |
| 88 | SRAMS_SIZE_2MB_ALIGNED, \ |
| 89 | MT_MEMORY | \ |
| 90 | MT_RW | \ |
| 91 | MT_SECURE | \ |
| 92 | MT_EXECUTE_NEVER) |
| 93 | #endif |
| 94 | |
Yann Gautier | ee8f542 | 2019-02-14 11:13:25 +0100 | [diff] [blame] | 95 | #define MAP_DEVICE1 MAP_REGION_FLAT(STM32MP1_DEVICE1_BASE, \ |
| 96 | STM32MP1_DEVICE1_SIZE, \ |
| 97 | MT_DEVICE | \ |
| 98 | MT_RW | \ |
| 99 | MT_SECURE | \ |
| 100 | MT_EXECUTE_NEVER) |
| 101 | |
| 102 | #define MAP_DEVICE2 MAP_REGION_FLAT(STM32MP1_DEVICE2_BASE, \ |
| 103 | STM32MP1_DEVICE2_SIZE, \ |
| 104 | MT_DEVICE | \ |
| 105 | MT_RW | \ |
| 106 | MT_SECURE | \ |
| 107 | MT_EXECUTE_NEVER) |
| 108 | |
| 109 | #if defined(IMAGE_BL2) |
| 110 | static const mmap_region_t stm32mp1_mmap[] = { |
Etienne Carriere | 72369b1 | 2019-12-08 08:17:56 +0100 | [diff] [blame] | 111 | MAP_SEC_SYSRAM, |
Yann Gautier | 84d994b | 2020-04-14 18:08:50 +0200 | [diff] [blame] | 112 | #if STM32MP13 |
| 113 | MAP_SRAM_ALL, |
| 114 | #endif |
Yann Gautier | ee8f542 | 2019-02-14 11:13:25 +0100 | [diff] [blame] | 115 | MAP_DEVICE1, |
Yann Gautier | 352d863 | 2020-09-17 11:38:09 +0200 | [diff] [blame] | 116 | #if STM32MP_RAW_NAND |
Yann Gautier | ee8f542 | 2019-02-14 11:13:25 +0100 | [diff] [blame] | 117 | MAP_DEVICE2, |
Yann Gautier | 352d863 | 2020-09-17 11:38:09 +0200 | [diff] [blame] | 118 | #endif |
Yann Gautier | ee8f542 | 2019-02-14 11:13:25 +0100 | [diff] [blame] | 119 | {0} |
| 120 | }; |
| 121 | #endif |
| 122 | #if defined(IMAGE_BL32) |
| 123 | static const mmap_region_t stm32mp1_mmap[] = { |
Etienne Carriere | 72369b1 | 2019-12-08 08:17:56 +0100 | [diff] [blame] | 124 | MAP_SEC_SYSRAM, |
| 125 | MAP_NS_SYSRAM, |
Yann Gautier | ee8f542 | 2019-02-14 11:13:25 +0100 | [diff] [blame] | 126 | MAP_DEVICE1, |
| 127 | MAP_DEVICE2, |
| 128 | {0} |
| 129 | }; |
| 130 | #endif |
| 131 | |
| 132 | void configure_mmu(void) |
| 133 | { |
| 134 | mmap_add(stm32mp1_mmap); |
| 135 | init_xlat_tables(); |
| 136 | |
| 137 | enable_mmu_svc_mon(0); |
| 138 | } |
Yann Gautier | e3bf913 | 2019-05-07 18:52:17 +0200 | [diff] [blame] | 139 | |
Etienne Carriere | 66b0452 | 2019-12-02 10:05:02 +0100 | [diff] [blame] | 140 | uintptr_t stm32_get_gpio_bank_base(unsigned int bank) |
| 141 | { |
Yann Gautier | cc5f89a | 2020-02-12 09:36:23 +0100 | [diff] [blame] | 142 | #if STM32MP13 |
| 143 | assert(GPIO_BANK_A == 0 && bank <= GPIO_BANK_I); |
| 144 | #endif |
| 145 | #if STM32MP15 |
Etienne Carriere | 66b0452 | 2019-12-02 10:05:02 +0100 | [diff] [blame] | 146 | if (bank == GPIO_BANK_Z) { |
| 147 | return GPIOZ_BASE; |
| 148 | } |
| 149 | |
| 150 | assert(GPIO_BANK_A == 0 && bank <= GPIO_BANK_K); |
Yann Gautier | cc5f89a | 2020-02-12 09:36:23 +0100 | [diff] [blame] | 151 | #endif |
Etienne Carriere | 66b0452 | 2019-12-02 10:05:02 +0100 | [diff] [blame] | 152 | |
| 153 | return GPIOA_BASE + (bank * GPIO_BANK_OFFSET); |
| 154 | } |
| 155 | |
| 156 | uint32_t stm32_get_gpio_bank_offset(unsigned int bank) |
| 157 | { |
Yann Gautier | cc5f89a | 2020-02-12 09:36:23 +0100 | [diff] [blame] | 158 | #if STM32MP13 |
| 159 | assert(GPIO_BANK_A == 0 && bank <= GPIO_BANK_I); |
| 160 | #endif |
| 161 | #if STM32MP15 |
Etienne Carriere | 66b0452 | 2019-12-02 10:05:02 +0100 | [diff] [blame] | 162 | if (bank == GPIO_BANK_Z) { |
| 163 | return 0; |
| 164 | } |
| 165 | |
| 166 | assert(GPIO_BANK_A == 0 && bank <= GPIO_BANK_K); |
Yann Gautier | cc5f89a | 2020-02-12 09:36:23 +0100 | [diff] [blame] | 167 | #endif |
Etienne Carriere | 66b0452 | 2019-12-02 10:05:02 +0100 | [diff] [blame] | 168 | |
| 169 | return bank * GPIO_BANK_OFFSET; |
| 170 | } |
| 171 | |
Yann Gautier | 2b79c37 | 2021-06-11 10:54:56 +0200 | [diff] [blame] | 172 | bool stm32_gpio_is_secure_at_reset(unsigned int bank) |
| 173 | { |
Yann Gautier | cc5f89a | 2020-02-12 09:36:23 +0100 | [diff] [blame] | 174 | #if STM32MP13 |
| 175 | return true; |
| 176 | #endif |
| 177 | #if STM32MP15 |
Yann Gautier | 2b79c37 | 2021-06-11 10:54:56 +0200 | [diff] [blame] | 178 | if (bank == GPIO_BANK_Z) { |
| 179 | return true; |
| 180 | } |
| 181 | |
| 182 | return false; |
Yann Gautier | cc5f89a | 2020-02-12 09:36:23 +0100 | [diff] [blame] | 183 | #endif |
Yann Gautier | 2b79c37 | 2021-06-11 10:54:56 +0200 | [diff] [blame] | 184 | } |
| 185 | |
Yann Gautier | e3bf913 | 2019-05-07 18:52:17 +0200 | [diff] [blame] | 186 | unsigned long stm32_get_gpio_bank_clock(unsigned int bank) |
| 187 | { |
Yann Gautier | cc5f89a | 2020-02-12 09:36:23 +0100 | [diff] [blame] | 188 | #if STM32MP13 |
| 189 | assert(GPIO_BANK_A == 0 && bank <= GPIO_BANK_I); |
| 190 | #endif |
| 191 | #if STM32MP15 |
Yann Gautier | e3bf913 | 2019-05-07 18:52:17 +0200 | [diff] [blame] | 192 | if (bank == GPIO_BANK_Z) { |
| 193 | return GPIOZ; |
| 194 | } |
| 195 | |
| 196 | assert(GPIO_BANK_A == 0 && bank <= GPIO_BANK_K); |
Yann Gautier | cc5f89a | 2020-02-12 09:36:23 +0100 | [diff] [blame] | 197 | #endif |
Yann Gautier | e3bf913 | 2019-05-07 18:52:17 +0200 | [diff] [blame] | 198 | |
| 199 | return GPIOA + (bank - GPIO_BANK_A); |
| 200 | } |
Yann Gautier | 091eab5 | 2019-06-04 18:06:34 +0200 | [diff] [blame] | 201 | |
Etienne Carriere | d81dadf | 2020-04-25 11:14:45 +0200 | [diff] [blame] | 202 | int stm32_get_gpio_bank_pinctrl_node(void *fdt, unsigned int bank) |
| 203 | { |
Yann Gautier | e78db3b | 2022-03-11 14:18:13 +0100 | [diff] [blame] | 204 | const char *node_compatible = NULL; |
| 205 | |
Etienne Carriere | d81dadf | 2020-04-25 11:14:45 +0200 | [diff] [blame] | 206 | switch (bank) { |
| 207 | case GPIO_BANK_A: |
| 208 | case GPIO_BANK_B: |
| 209 | case GPIO_BANK_C: |
| 210 | case GPIO_BANK_D: |
| 211 | case GPIO_BANK_E: |
| 212 | case GPIO_BANK_F: |
| 213 | case GPIO_BANK_G: |
| 214 | case GPIO_BANK_H: |
| 215 | case GPIO_BANK_I: |
Yann Gautier | e78db3b | 2022-03-11 14:18:13 +0100 | [diff] [blame] | 216 | #if STM32MP13 |
| 217 | node_compatible = "st,stm32mp135-pinctrl"; |
| 218 | break; |
| 219 | #endif |
Yann Gautier | cc5f89a | 2020-02-12 09:36:23 +0100 | [diff] [blame] | 220 | #if STM32MP15 |
Etienne Carriere | d81dadf | 2020-04-25 11:14:45 +0200 | [diff] [blame] | 221 | case GPIO_BANK_J: |
| 222 | case GPIO_BANK_K: |
Yann Gautier | e78db3b | 2022-03-11 14:18:13 +0100 | [diff] [blame] | 223 | node_compatible = "st,stm32mp157-pinctrl"; |
| 224 | break; |
Etienne Carriere | d81dadf | 2020-04-25 11:14:45 +0200 | [diff] [blame] | 225 | case GPIO_BANK_Z: |
Yann Gautier | e78db3b | 2022-03-11 14:18:13 +0100 | [diff] [blame] | 226 | node_compatible = "st,stm32mp157-z-pinctrl"; |
| 227 | break; |
Yann Gautier | cc5f89a | 2020-02-12 09:36:23 +0100 | [diff] [blame] | 228 | #endif |
Etienne Carriere | d81dadf | 2020-04-25 11:14:45 +0200 | [diff] [blame] | 229 | default: |
| 230 | panic(); |
| 231 | } |
Yann Gautier | e78db3b | 2022-03-11 14:18:13 +0100 | [diff] [blame] | 232 | |
| 233 | return fdt_node_offset_by_compatible(fdt, -1, node_compatible); |
Etienne Carriere | d81dadf | 2020-04-25 11:14:45 +0200 | [diff] [blame] | 234 | } |
| 235 | |
Yann Gautier | 3d8497c | 2021-10-18 16:06:22 +0200 | [diff] [blame] | 236 | #if STM32MP_UART_PROGRAMMER || !defined(IMAGE_BL2) |
Patrick Delaunay | e50571b | 2021-10-28 13:48:52 +0200 | [diff] [blame] | 237 | /* |
| 238 | * UART Management |
| 239 | */ |
| 240 | static const uintptr_t stm32mp1_uart_addresses[8] = { |
| 241 | USART1_BASE, |
| 242 | USART2_BASE, |
| 243 | USART3_BASE, |
| 244 | UART4_BASE, |
| 245 | UART5_BASE, |
| 246 | USART6_BASE, |
| 247 | UART7_BASE, |
| 248 | UART8_BASE, |
| 249 | }; |
| 250 | |
| 251 | uintptr_t get_uart_address(uint32_t instance_nb) |
| 252 | { |
| 253 | if ((instance_nb == 0U) || |
| 254 | (instance_nb > ARRAY_SIZE(stm32mp1_uart_addresses))) { |
| 255 | return 0U; |
| 256 | } |
| 257 | |
| 258 | return stm32mp1_uart_addresses[instance_nb - 1U]; |
| 259 | } |
| 260 | #endif |
| 261 | |
Yann Gautier | cd16df3 | 2021-06-04 14:04:05 +0200 | [diff] [blame] | 262 | #if STM32MP_USB_PROGRAMMER |
| 263 | struct gpio_bank_pin_list { |
| 264 | uint32_t bank; |
| 265 | uint32_t pin; |
| 266 | }; |
| 267 | |
| 268 | static const struct gpio_bank_pin_list gpio_list[] = { |
| 269 | { /* USART2_RX: GPIOA3 */ |
| 270 | .bank = 0U, |
| 271 | .pin = 3U, |
| 272 | }, |
| 273 | { /* USART3_RX: GPIOB12 */ |
| 274 | .bank = 1U, |
| 275 | .pin = 12U, |
| 276 | }, |
| 277 | { /* UART4_RX: GPIOB2 */ |
| 278 | .bank = 1U, |
| 279 | .pin = 2U, |
| 280 | }, |
| 281 | { /* UART5_RX: GPIOB4 */ |
| 282 | .bank = 1U, |
| 283 | .pin = 5U, |
| 284 | }, |
| 285 | { /* USART6_RX: GPIOC7 */ |
| 286 | .bank = 2U, |
| 287 | .pin = 7U, |
| 288 | }, |
| 289 | { /* UART7_RX: GPIOF6 */ |
| 290 | .bank = 5U, |
| 291 | .pin = 6U, |
| 292 | }, |
| 293 | { /* UART8_RX: GPIOE0 */ |
| 294 | .bank = 4U, |
| 295 | .pin = 0U, |
| 296 | }, |
| 297 | }; |
| 298 | |
| 299 | void stm32mp1_deconfigure_uart_pins(void) |
| 300 | { |
| 301 | size_t i; |
| 302 | |
| 303 | for (i = 0U; i < ARRAY_SIZE(gpio_list); i++) { |
| 304 | set_gpio_reset_cfg(gpio_list[i].bank, gpio_list[i].pin); |
| 305 | } |
| 306 | } |
| 307 | #endif |
| 308 | |
Yann Gautier | a0a6ff6 | 2021-05-10 16:05:18 +0200 | [diff] [blame] | 309 | uint32_t stm32mp_get_chip_version(void) |
Yann Gautier | c737405 | 2019-06-04 18:02:37 +0200 | [diff] [blame] | 310 | { |
Yann Gautier | f36a1d3 | 2020-04-21 15:03:59 +0200 | [diff] [blame] | 311 | #if STM32MP13 |
| 312 | return stm32mp1_syscfg_get_chip_version(); |
| 313 | #endif |
| 314 | #if STM32MP15 |
Yann Gautier | a0a6ff6 | 2021-05-10 16:05:18 +0200 | [diff] [blame] | 315 | uint32_t version = 0U; |
| 316 | |
| 317 | if (stm32mp1_dbgmcu_get_chip_version(&version) < 0) { |
| 318 | INFO("Cannot get CPU version, debug disabled\n"); |
| 319 | return 0U; |
| 320 | } |
| 321 | |
| 322 | return version; |
Yann Gautier | f36a1d3 | 2020-04-21 15:03:59 +0200 | [diff] [blame] | 323 | #endif |
Yann Gautier | a0a6ff6 | 2021-05-10 16:05:18 +0200 | [diff] [blame] | 324 | } |
Yann Gautier | c737405 | 2019-06-04 18:02:37 +0200 | [diff] [blame] | 325 | |
Yann Gautier | a0a6ff6 | 2021-05-10 16:05:18 +0200 | [diff] [blame] | 326 | uint32_t stm32mp_get_chip_dev_id(void) |
| 327 | { |
Yann Gautier | f36a1d3 | 2020-04-21 15:03:59 +0200 | [diff] [blame] | 328 | #if STM32MP13 |
| 329 | return stm32mp1_syscfg_get_chip_dev_id(); |
| 330 | #endif |
| 331 | #if STM32MP15 |
Yann Gautier | a0a6ff6 | 2021-05-10 16:05:18 +0200 | [diff] [blame] | 332 | uint32_t dev_id; |
Nicolas Le Bayon | 98f4ea0 | 2019-09-23 11:18:32 +0200 | [diff] [blame] | 333 | |
Yann Gautier | c737405 | 2019-06-04 18:02:37 +0200 | [diff] [blame] | 334 | if (stm32mp1_dbgmcu_get_chip_dev_id(&dev_id) < 0) { |
Yann Gautier | a0a6ff6 | 2021-05-10 16:05:18 +0200 | [diff] [blame] | 335 | INFO("Use default chip ID, debug disabled\n"); |
| 336 | dev_id = STM32MP1_CHIP_ID; |
Yann Gautier | c737405 | 2019-06-04 18:02:37 +0200 | [diff] [blame] | 337 | } |
| 338 | |
Yann Gautier | a0a6ff6 | 2021-05-10 16:05:18 +0200 | [diff] [blame] | 339 | return dev_id; |
Yann Gautier | f36a1d3 | 2020-04-21 15:03:59 +0200 | [diff] [blame] | 340 | #endif |
Yann Gautier | a0a6ff6 | 2021-05-10 16:05:18 +0200 | [diff] [blame] | 341 | } |
| 342 | |
| 343 | static uint32_t get_part_number(void) |
| 344 | { |
| 345 | static uint32_t part_number; |
| 346 | |
| 347 | if (part_number != 0U) { |
| 348 | return part_number; |
| 349 | } |
| 350 | |
Lionel Debieve | bc2d88d | 2019-11-04 14:31:38 +0100 | [diff] [blame] | 351 | if (stm32_get_otp_value(PART_NUMBER_OTP, &part_number) != 0) { |
Yann Gautier | a0a6ff6 | 2021-05-10 16:05:18 +0200 | [diff] [blame] | 352 | panic(); |
Yann Gautier | c737405 | 2019-06-04 18:02:37 +0200 | [diff] [blame] | 353 | } |
| 354 | |
| 355 | part_number = (part_number & PART_NUMBER_OTP_PART_MASK) >> |
| 356 | PART_NUMBER_OTP_PART_SHIFT; |
| 357 | |
Yann Gautier | a0a6ff6 | 2021-05-10 16:05:18 +0200 | [diff] [blame] | 358 | part_number |= stm32mp_get_chip_dev_id() << 16; |
Yann Gautier | c737405 | 2019-06-04 18:02:37 +0200 | [diff] [blame] | 359 | |
Yann Gautier | a0a6ff6 | 2021-05-10 16:05:18 +0200 | [diff] [blame] | 360 | return part_number; |
Yann Gautier | c737405 | 2019-06-04 18:02:37 +0200 | [diff] [blame] | 361 | } |
| 362 | |
Yann Gautier | 16188f3 | 2020-02-12 15:38:34 +0100 | [diff] [blame] | 363 | #if STM32MP15 |
Yann Gautier | a0a6ff6 | 2021-05-10 16:05:18 +0200 | [diff] [blame] | 364 | static uint32_t get_cpu_package(void) |
Yann Gautier | c737405 | 2019-06-04 18:02:37 +0200 | [diff] [blame] | 365 | { |
| 366 | uint32_t package; |
| 367 | |
Lionel Debieve | bc2d88d | 2019-11-04 14:31:38 +0100 | [diff] [blame] | 368 | if (stm32_get_otp_value(PACKAGE_OTP, &package) != 0) { |
Yann Gautier | a0a6ff6 | 2021-05-10 16:05:18 +0200 | [diff] [blame] | 369 | panic(); |
Yann Gautier | c737405 | 2019-06-04 18:02:37 +0200 | [diff] [blame] | 370 | } |
| 371 | |
Yann Gautier | a0a6ff6 | 2021-05-10 16:05:18 +0200 | [diff] [blame] | 372 | package = (package & PACKAGE_OTP_PKG_MASK) >> |
Yann Gautier | c737405 | 2019-06-04 18:02:37 +0200 | [diff] [blame] | 373 | PACKAGE_OTP_PKG_SHIFT; |
| 374 | |
Yann Gautier | a0a6ff6 | 2021-05-10 16:05:18 +0200 | [diff] [blame] | 375 | return package; |
Yann Gautier | c737405 | 2019-06-04 18:02:37 +0200 | [diff] [blame] | 376 | } |
Yann Gautier | 16188f3 | 2020-02-12 15:38:34 +0100 | [diff] [blame] | 377 | #endif |
Yann Gautier | c737405 | 2019-06-04 18:02:37 +0200 | [diff] [blame] | 378 | |
Yann Gautier | a0a6ff6 | 2021-05-10 16:05:18 +0200 | [diff] [blame] | 379 | void stm32mp_get_soc_name(char name[STM32_SOC_NAME_SIZE]) |
Yann Gautier | c737405 | 2019-06-04 18:02:37 +0200 | [diff] [blame] | 380 | { |
Yann Gautier | a0a6ff6 | 2021-05-10 16:05:18 +0200 | [diff] [blame] | 381 | char *cpu_s, *cpu_r, *pkg; |
Yann Gautier | c737405 | 2019-06-04 18:02:37 +0200 | [diff] [blame] | 382 | |
| 383 | /* MPUs Part Numbers */ |
Yann Gautier | a0a6ff6 | 2021-05-10 16:05:18 +0200 | [diff] [blame] | 384 | switch (get_part_number()) { |
Yann Gautier | 16188f3 | 2020-02-12 15:38:34 +0100 | [diff] [blame] | 385 | #if STM32MP13 |
| 386 | case STM32MP135F_PART_NB: |
| 387 | cpu_s = "135F"; |
| 388 | break; |
| 389 | case STM32MP135D_PART_NB: |
| 390 | cpu_s = "135D"; |
| 391 | break; |
| 392 | case STM32MP135C_PART_NB: |
| 393 | cpu_s = "135C"; |
| 394 | break; |
| 395 | case STM32MP135A_PART_NB: |
| 396 | cpu_s = "135A"; |
| 397 | break; |
| 398 | case STM32MP133F_PART_NB: |
| 399 | cpu_s = "133F"; |
| 400 | break; |
| 401 | case STM32MP133D_PART_NB: |
| 402 | cpu_s = "133D"; |
| 403 | break; |
| 404 | case STM32MP133C_PART_NB: |
| 405 | cpu_s = "133C"; |
| 406 | break; |
| 407 | case STM32MP133A_PART_NB: |
| 408 | cpu_s = "133A"; |
| 409 | break; |
| 410 | case STM32MP131F_PART_NB: |
| 411 | cpu_s = "131F"; |
| 412 | break; |
| 413 | case STM32MP131D_PART_NB: |
| 414 | cpu_s = "131D"; |
| 415 | break; |
| 416 | case STM32MP131C_PART_NB: |
| 417 | cpu_s = "131C"; |
| 418 | break; |
| 419 | case STM32MP131A_PART_NB: |
| 420 | cpu_s = "131A"; |
| 421 | break; |
| 422 | #endif |
| 423 | #if STM32MP15 |
Yann Gautier | c737405 | 2019-06-04 18:02:37 +0200 | [diff] [blame] | 424 | case STM32MP157C_PART_NB: |
| 425 | cpu_s = "157C"; |
| 426 | break; |
| 427 | case STM32MP157A_PART_NB: |
| 428 | cpu_s = "157A"; |
| 429 | break; |
| 430 | case STM32MP153C_PART_NB: |
| 431 | cpu_s = "153C"; |
| 432 | break; |
| 433 | case STM32MP153A_PART_NB: |
| 434 | cpu_s = "153A"; |
| 435 | break; |
| 436 | case STM32MP151C_PART_NB: |
| 437 | cpu_s = "151C"; |
| 438 | break; |
| 439 | case STM32MP151A_PART_NB: |
| 440 | cpu_s = "151A"; |
| 441 | break; |
Lionel Debieve | 7b64e3e | 2019-05-17 16:01:18 +0200 | [diff] [blame] | 442 | case STM32MP157F_PART_NB: |
| 443 | cpu_s = "157F"; |
| 444 | break; |
| 445 | case STM32MP157D_PART_NB: |
| 446 | cpu_s = "157D"; |
| 447 | break; |
| 448 | case STM32MP153F_PART_NB: |
| 449 | cpu_s = "153F"; |
| 450 | break; |
| 451 | case STM32MP153D_PART_NB: |
| 452 | cpu_s = "153D"; |
| 453 | break; |
| 454 | case STM32MP151F_PART_NB: |
| 455 | cpu_s = "151F"; |
| 456 | break; |
| 457 | case STM32MP151D_PART_NB: |
| 458 | cpu_s = "151D"; |
| 459 | break; |
Yann Gautier | 16188f3 | 2020-02-12 15:38:34 +0100 | [diff] [blame] | 460 | #endif |
Yann Gautier | c737405 | 2019-06-04 18:02:37 +0200 | [diff] [blame] | 461 | default: |
| 462 | cpu_s = "????"; |
| 463 | break; |
| 464 | } |
| 465 | |
| 466 | /* Package */ |
Yann Gautier | 16188f3 | 2020-02-12 15:38:34 +0100 | [diff] [blame] | 467 | #if STM32MP13 |
| 468 | /* On STM32MP13, package is not present in OTP */ |
| 469 | pkg = ""; |
| 470 | #endif |
| 471 | #if STM32MP15 |
Yann Gautier | a0a6ff6 | 2021-05-10 16:05:18 +0200 | [diff] [blame] | 472 | switch (get_cpu_package()) { |
Yann Gautier | c737405 | 2019-06-04 18:02:37 +0200 | [diff] [blame] | 473 | case PKG_AA_LFBGA448: |
| 474 | pkg = "AA"; |
| 475 | break; |
| 476 | case PKG_AB_LFBGA354: |
| 477 | pkg = "AB"; |
| 478 | break; |
| 479 | case PKG_AC_TFBGA361: |
| 480 | pkg = "AC"; |
| 481 | break; |
| 482 | case PKG_AD_TFBGA257: |
| 483 | pkg = "AD"; |
| 484 | break; |
| 485 | default: |
| 486 | pkg = "??"; |
| 487 | break; |
| 488 | } |
Yann Gautier | 16188f3 | 2020-02-12 15:38:34 +0100 | [diff] [blame] | 489 | #endif |
Yann Gautier | c737405 | 2019-06-04 18:02:37 +0200 | [diff] [blame] | 490 | |
| 491 | /* REVISION */ |
Yann Gautier | a0a6ff6 | 2021-05-10 16:05:18 +0200 | [diff] [blame] | 492 | switch (stm32mp_get_chip_version()) { |
Yann Gautier | c737405 | 2019-06-04 18:02:37 +0200 | [diff] [blame] | 493 | case STM32MP1_REV_B: |
| 494 | cpu_r = "B"; |
| 495 | break; |
Yann Gautier | 06cc791 | 2022-05-09 17:01:11 +0200 | [diff] [blame] | 496 | #if STM32MP13 |
| 497 | case STM32MP1_REV_Y: |
| 498 | cpu_r = "Y"; |
| 499 | break; |
| 500 | #endif |
Lionel Debieve | 2d64b53 | 2019-06-25 10:40:37 +0200 | [diff] [blame] | 501 | case STM32MP1_REV_Z: |
| 502 | cpu_r = "Z"; |
| 503 | break; |
Yann Gautier | c737405 | 2019-06-04 18:02:37 +0200 | [diff] [blame] | 504 | default: |
| 505 | cpu_r = "?"; |
| 506 | break; |
| 507 | } |
| 508 | |
Yann Gautier | a0a6ff6 | 2021-05-10 16:05:18 +0200 | [diff] [blame] | 509 | snprintf(name, STM32_SOC_NAME_SIZE, |
| 510 | "STM32MP%s%s Rev.%s", cpu_s, pkg, cpu_r); |
| 511 | } |
| 512 | |
| 513 | void stm32mp_print_cpuinfo(void) |
| 514 | { |
| 515 | char name[STM32_SOC_NAME_SIZE]; |
| 516 | |
| 517 | stm32mp_get_soc_name(name); |
| 518 | NOTICE("CPU: %s\n", name); |
Yann Gautier | c737405 | 2019-06-04 18:02:37 +0200 | [diff] [blame] | 519 | } |
| 520 | |
Yann Gautier | 35dc077 | 2019-05-13 18:34:48 +0200 | [diff] [blame] | 521 | void stm32mp_print_boardinfo(void) |
| 522 | { |
Lionel Debieve | bc2d88d | 2019-11-04 14:31:38 +0100 | [diff] [blame] | 523 | uint32_t board_id = 0; |
Yann Gautier | 35dc077 | 2019-05-13 18:34:48 +0200 | [diff] [blame] | 524 | |
Lionel Debieve | bc2d88d | 2019-11-04 14:31:38 +0100 | [diff] [blame] | 525 | if (stm32_get_otp_value(BOARD_ID_OTP, &board_id) != 0) { |
Yann Gautier | 35dc077 | 2019-05-13 18:34:48 +0200 | [diff] [blame] | 526 | return; |
| 527 | } |
| 528 | |
Yann Gautier | 35dc077 | 2019-05-13 18:34:48 +0200 | [diff] [blame] | 529 | if (board_id != 0U) { |
| 530 | char rev[2]; |
| 531 | |
| 532 | rev[0] = BOARD_ID2REV(board_id) - 1 + 'A'; |
| 533 | rev[1] = '\0'; |
Yann Gautier | 36e9d38 | 2020-10-13 18:03:31 +0200 | [diff] [blame] | 534 | NOTICE("Board: MB%04x Var%u.%u Rev.%s-%02u\n", |
Yann Gautier | 35dc077 | 2019-05-13 18:34:48 +0200 | [diff] [blame] | 535 | BOARD_ID2NB(board_id), |
Patrick Delaunay | 7704f16 | 2020-01-08 10:05:14 +0100 | [diff] [blame] | 536 | BOARD_ID2VARCPN(board_id), |
| 537 | BOARD_ID2VARFG(board_id), |
Yann Gautier | 35dc077 | 2019-05-13 18:34:48 +0200 | [diff] [blame] | 538 | rev, |
| 539 | BOARD_ID2BOM(board_id)); |
| 540 | } |
| 541 | } |
| 542 | |
Yann Gautier | af19ff9 | 2019-06-04 18:23:10 +0200 | [diff] [blame] | 543 | /* Return true when SoC provides a single Cortex-A7 core, and false otherwise */ |
| 544 | bool stm32mp_is_single_core(void) |
| 545 | { |
Yann Gautier | 6bd30e2 | 2020-02-06 15:34:16 +0100 | [diff] [blame] | 546 | #if STM32MP13 |
| 547 | return true; |
| 548 | #endif |
| 549 | #if STM32MP15 |
Yann Gautier | 2f3b560 | 2021-10-19 13:31:06 +0200 | [diff] [blame] | 550 | bool single_core = false; |
| 551 | |
Yann Gautier | a0a6ff6 | 2021-05-10 16:05:18 +0200 | [diff] [blame] | 552 | switch (get_part_number()) { |
Yann Gautier | af19ff9 | 2019-06-04 18:23:10 +0200 | [diff] [blame] | 553 | case STM32MP151A_PART_NB: |
| 554 | case STM32MP151C_PART_NB: |
Lionel Debieve | 7b64e3e | 2019-05-17 16:01:18 +0200 | [diff] [blame] | 555 | case STM32MP151D_PART_NB: |
| 556 | case STM32MP151F_PART_NB: |
Yann Gautier | 2f3b560 | 2021-10-19 13:31:06 +0200 | [diff] [blame] | 557 | single_core = true; |
| 558 | break; |
Yann Gautier | af19ff9 | 2019-06-04 18:23:10 +0200 | [diff] [blame] | 559 | default: |
Yann Gautier | 2f3b560 | 2021-10-19 13:31:06 +0200 | [diff] [blame] | 560 | break; |
Yann Gautier | af19ff9 | 2019-06-04 18:23:10 +0200 | [diff] [blame] | 561 | } |
Yann Gautier | 2f3b560 | 2021-10-19 13:31:06 +0200 | [diff] [blame] | 562 | |
| 563 | return single_core; |
Yann Gautier | 6bd30e2 | 2020-02-06 15:34:16 +0100 | [diff] [blame] | 564 | #endif |
Yann Gautier | af19ff9 | 2019-06-04 18:23:10 +0200 | [diff] [blame] | 565 | } |
| 566 | |
Lionel Debieve | 0e73d73 | 2019-09-16 12:17:09 +0200 | [diff] [blame] | 567 | /* Return true when device is in closed state */ |
| 568 | bool stm32mp_is_closed_device(void) |
| 569 | { |
| 570 | uint32_t value; |
| 571 | |
Lionel Debieve | bc2d88d | 2019-11-04 14:31:38 +0100 | [diff] [blame] | 572 | if (stm32_get_otp_value(CFG0_OTP, &value) != 0) { |
Lionel Debieve | 0e73d73 | 2019-09-16 12:17:09 +0200 | [diff] [blame] | 573 | return true; |
| 574 | } |
| 575 | |
Nicolas Le Bayon | 34cbf23 | 2020-11-26 09:57:09 +0100 | [diff] [blame] | 576 | #if STM32MP13 |
| 577 | value = (value & CFG0_OTP_MODE_MASK) >> CFG0_OTP_MODE_SHIFT; |
| 578 | |
| 579 | switch (value) { |
| 580 | case CFG0_OPEN_DEVICE: |
| 581 | return false; |
| 582 | case CFG0_CLOSED_DEVICE: |
| 583 | case CFG0_CLOSED_DEVICE_NO_BOUNDARY_SCAN: |
| 584 | case CFG0_CLOSED_DEVICE_NO_JTAG: |
| 585 | return true; |
| 586 | default: |
| 587 | panic(); |
| 588 | } |
| 589 | #endif |
| 590 | #if STM32MP15 |
Lionel Debieve | bc2d88d | 2019-11-04 14:31:38 +0100 | [diff] [blame] | 591 | return (value & CFG0_CLOSED_DEVICE) == CFG0_CLOSED_DEVICE; |
Nicolas Le Bayon | 34cbf23 | 2020-11-26 09:57:09 +0100 | [diff] [blame] | 592 | #endif |
Lionel Debieve | 0e73d73 | 2019-09-16 12:17:09 +0200 | [diff] [blame] | 593 | } |
| 594 | |
Lionel Debieve | 06bc62d | 2019-12-06 12:42:20 +0100 | [diff] [blame] | 595 | /* Return true when device supports secure boot */ |
| 596 | bool stm32mp_is_auth_supported(void) |
| 597 | { |
| 598 | bool supported = false; |
| 599 | |
| 600 | switch (get_part_number()) { |
Yann Gautier | 16188f3 | 2020-02-12 15:38:34 +0100 | [diff] [blame] | 601 | #if STM32MP13 |
| 602 | case STM32MP131C_PART_NB: |
| 603 | case STM32MP131F_PART_NB: |
| 604 | case STM32MP133C_PART_NB: |
| 605 | case STM32MP133F_PART_NB: |
| 606 | case STM32MP135C_PART_NB: |
| 607 | case STM32MP135F_PART_NB: |
| 608 | #endif |
| 609 | #if STM32MP15 |
Lionel Debieve | 06bc62d | 2019-12-06 12:42:20 +0100 | [diff] [blame] | 610 | case STM32MP151C_PART_NB: |
| 611 | case STM32MP151F_PART_NB: |
| 612 | case STM32MP153C_PART_NB: |
| 613 | case STM32MP153F_PART_NB: |
| 614 | case STM32MP157C_PART_NB: |
| 615 | case STM32MP157F_PART_NB: |
Yann Gautier | 16188f3 | 2020-02-12 15:38:34 +0100 | [diff] [blame] | 616 | #endif |
Lionel Debieve | 06bc62d | 2019-12-06 12:42:20 +0100 | [diff] [blame] | 617 | supported = true; |
| 618 | break; |
| 619 | default: |
| 620 | break; |
| 621 | } |
| 622 | |
| 623 | return supported; |
| 624 | } |
| 625 | |
Yann Gautier | 091eab5 | 2019-06-04 18:06:34 +0200 | [diff] [blame] | 626 | uint32_t stm32_iwdg_get_instance(uintptr_t base) |
| 627 | { |
| 628 | switch (base) { |
| 629 | case IWDG1_BASE: |
| 630 | return IWDG1_INST; |
| 631 | case IWDG2_BASE: |
| 632 | return IWDG2_INST; |
| 633 | default: |
| 634 | panic(); |
| 635 | } |
| 636 | } |
| 637 | |
| 638 | uint32_t stm32_iwdg_get_otp_config(uint32_t iwdg_inst) |
| 639 | { |
| 640 | uint32_t iwdg_cfg = 0U; |
| 641 | uint32_t otp_value; |
| 642 | |
Lionel Debieve | bc2d88d | 2019-11-04 14:31:38 +0100 | [diff] [blame] | 643 | if (stm32_get_otp_value(HW2_OTP, &otp_value) != 0) { |
Yann Gautier | 091eab5 | 2019-06-04 18:06:34 +0200 | [diff] [blame] | 644 | panic(); |
| 645 | } |
| 646 | |
| 647 | if ((otp_value & BIT(iwdg_inst + HW2_OTP_IWDG_HW_POS)) != 0U) { |
| 648 | iwdg_cfg |= IWDG_HW_ENABLED; |
| 649 | } |
| 650 | |
| 651 | if ((otp_value & BIT(iwdg_inst + HW2_OTP_IWDG_FZ_STOP_POS)) != 0U) { |
| 652 | iwdg_cfg |= IWDG_DISABLE_ON_STOP; |
| 653 | } |
| 654 | |
| 655 | if ((otp_value & BIT(iwdg_inst + HW2_OTP_IWDG_FZ_STANDBY_POS)) != 0U) { |
| 656 | iwdg_cfg |= IWDG_DISABLE_ON_STANDBY; |
| 657 | } |
| 658 | |
| 659 | return iwdg_cfg; |
| 660 | } |
| 661 | |
| 662 | #if defined(IMAGE_BL2) |
| 663 | uint32_t stm32_iwdg_shadow_update(uint32_t iwdg_inst, uint32_t flags) |
| 664 | { |
Lionel Debieve | bc2d88d | 2019-11-04 14:31:38 +0100 | [diff] [blame] | 665 | uint32_t otp_value; |
Yann Gautier | 091eab5 | 2019-06-04 18:06:34 +0200 | [diff] [blame] | 666 | uint32_t otp; |
| 667 | uint32_t result; |
| 668 | |
Lionel Debieve | bc2d88d | 2019-11-04 14:31:38 +0100 | [diff] [blame] | 669 | if (stm32_get_otp_index(HW2_OTP, &otp, NULL) != 0) { |
| 670 | panic(); |
| 671 | } |
| 672 | |
| 673 | if (stm32_get_otp_value(HW2_OTP, &otp_value) != 0) { |
Yann Gautier | 091eab5 | 2019-06-04 18:06:34 +0200 | [diff] [blame] | 674 | panic(); |
| 675 | } |
| 676 | |
Lionel Debieve | bc2d88d | 2019-11-04 14:31:38 +0100 | [diff] [blame] | 677 | if ((flags & IWDG_DISABLE_ON_STOP) != 0) { |
| 678 | otp_value |= BIT(iwdg_inst + HW2_OTP_IWDG_FZ_STOP_POS); |
Yann Gautier | 091eab5 | 2019-06-04 18:06:34 +0200 | [diff] [blame] | 679 | } |
| 680 | |
Lionel Debieve | bc2d88d | 2019-11-04 14:31:38 +0100 | [diff] [blame] | 681 | if ((flags & IWDG_DISABLE_ON_STANDBY) != 0) { |
| 682 | otp_value |= BIT(iwdg_inst + HW2_OTP_IWDG_FZ_STANDBY_POS); |
Yann Gautier | 091eab5 | 2019-06-04 18:06:34 +0200 | [diff] [blame] | 683 | } |
| 684 | |
Lionel Debieve | bc2d88d | 2019-11-04 14:31:38 +0100 | [diff] [blame] | 685 | result = bsec_write_otp(otp_value, otp); |
Yann Gautier | 091eab5 | 2019-06-04 18:06:34 +0200 | [diff] [blame] | 686 | if (result != BSEC_OK) { |
| 687 | return result; |
| 688 | } |
| 689 | |
| 690 | /* Sticky lock OTP_IWDG (read and write) */ |
Lionel Debieve | bc2d88d | 2019-11-04 14:31:38 +0100 | [diff] [blame] | 691 | if ((bsec_set_sr_lock(otp) != BSEC_OK) || |
| 692 | (bsec_set_sw_lock(otp) != BSEC_OK)) { |
Yann Gautier | 091eab5 | 2019-06-04 18:06:34 +0200 | [diff] [blame] | 693 | return BSEC_LOCK_FAIL; |
| 694 | } |
| 695 | |
| 696 | return BSEC_OK; |
| 697 | } |
| 698 | #endif |
Yann Gautier | 8f268c8 | 2020-02-26 13:39:44 +0100 | [diff] [blame] | 699 | |
Lionel Debieve | 1dc5e2e | 2020-09-27 21:13:53 +0200 | [diff] [blame] | 700 | #if STM32MP_USE_STM32IMAGE |
Yann Gautier | 8f268c8 | 2020-02-26 13:39:44 +0100 | [diff] [blame] | 701 | /* Get the non-secure DDR size */ |
| 702 | uint32_t stm32mp_get_ddr_ns_size(void) |
| 703 | { |
| 704 | static uint32_t ddr_ns_size; |
| 705 | uint32_t ddr_size; |
| 706 | |
| 707 | if (ddr_ns_size != 0U) { |
| 708 | return ddr_ns_size; |
| 709 | } |
| 710 | |
| 711 | ddr_size = dt_get_ddr_size(); |
| 712 | if ((ddr_size <= (STM32MP_DDR_S_SIZE + STM32MP_DDR_SHMEM_SIZE)) || |
| 713 | (ddr_size > STM32MP_DDR_MAX_SIZE)) { |
| 714 | panic(); |
| 715 | } |
| 716 | |
| 717 | ddr_ns_size = ddr_size - (STM32MP_DDR_S_SIZE + STM32MP_DDR_SHMEM_SIZE); |
| 718 | |
| 719 | return ddr_ns_size; |
| 720 | } |
Lionel Debieve | 1dc5e2e | 2020-09-27 21:13:53 +0200 | [diff] [blame] | 721 | #endif /* STM32MP_USE_STM32IMAGE */ |
Yann Gautier | 6eef525 | 2021-12-10 17:04:40 +0100 | [diff] [blame] | 722 | |
| 723 | void stm32_save_boot_interface(uint32_t interface, uint32_t instance) |
| 724 | { |
Nicolas Toromanoff | bb82b1b | 2022-02-09 12:26:31 +0100 | [diff] [blame] | 725 | uintptr_t bkpr_itf_idx = tamp_bkpr(TAMP_BOOT_MODE_BACKUP_REG_ID); |
Yann Gautier | 6eef525 | 2021-12-10 17:04:40 +0100 | [diff] [blame] | 726 | |
Yann Gautier | a205a5c | 2021-08-30 15:06:54 +0200 | [diff] [blame] | 727 | clk_enable(RTCAPB); |
Yann Gautier | 6eef525 | 2021-12-10 17:04:40 +0100 | [diff] [blame] | 728 | |
| 729 | mmio_clrsetbits_32(bkpr_itf_idx, |
| 730 | TAMP_BOOT_MODE_ITF_MASK, |
| 731 | ((interface << 4) | (instance & 0xFU)) << |
| 732 | TAMP_BOOT_MODE_ITF_SHIFT); |
| 733 | |
Yann Gautier | a205a5c | 2021-08-30 15:06:54 +0200 | [diff] [blame] | 734 | clk_disable(RTCAPB); |
Yann Gautier | 6eef525 | 2021-12-10 17:04:40 +0100 | [diff] [blame] | 735 | } |
Yann Gautier | aaee061 | 2020-12-16 12:04:06 +0100 | [diff] [blame] | 736 | |
| 737 | void stm32_get_boot_interface(uint32_t *interface, uint32_t *instance) |
| 738 | { |
| 739 | static uint32_t itf; |
| 740 | |
| 741 | if (itf == 0U) { |
Nicolas Toromanoff | bb82b1b | 2022-02-09 12:26:31 +0100 | [diff] [blame] | 742 | uintptr_t bkpr = tamp_bkpr(TAMP_BOOT_MODE_BACKUP_REG_ID); |
Yann Gautier | aaee061 | 2020-12-16 12:04:06 +0100 | [diff] [blame] | 743 | |
Yann Gautier | a205a5c | 2021-08-30 15:06:54 +0200 | [diff] [blame] | 744 | clk_enable(RTCAPB); |
Yann Gautier | aaee061 | 2020-12-16 12:04:06 +0100 | [diff] [blame] | 745 | |
| 746 | itf = (mmio_read_32(bkpr) & TAMP_BOOT_MODE_ITF_MASK) >> |
| 747 | TAMP_BOOT_MODE_ITF_SHIFT; |
| 748 | |
Yann Gautier | a205a5c | 2021-08-30 15:06:54 +0200 | [diff] [blame] | 749 | clk_disable(RTCAPB); |
Yann Gautier | aaee061 | 2020-12-16 12:04:06 +0100 | [diff] [blame] | 750 | } |
| 751 | |
| 752 | *interface = itf >> 4; |
| 753 | *instance = itf & 0xFU; |
| 754 | } |
Sughosh Ganu | 03e2f80 | 2021-12-01 15:56:27 +0530 | [diff] [blame] | 755 | |
Igor Opaniuk | f07e8f3 | 2022-06-23 21:19:26 +0300 | [diff] [blame] | 756 | void stm32_save_boot_auth(uint32_t auth_status, uint32_t boot_partition) |
| 757 | { |
| 758 | uint32_t boot_status = tamp_bkpr(TAMP_BOOT_MODE_BACKUP_REG_ID); |
| 759 | |
| 760 | clk_enable(RTCAPB); |
| 761 | |
| 762 | mmio_clrsetbits_32(boot_status, |
| 763 | TAMP_BOOT_MODE_AUTH_MASK, |
| 764 | ((auth_status << 4) | (boot_partition & 0xFU)) << |
| 765 | TAMP_BOOT_MODE_AUTH_SHIFT); |
| 766 | |
| 767 | clk_disable(RTCAPB); |
| 768 | } |
| 769 | |
Sughosh Ganu | 03e2f80 | 2021-12-01 15:56:27 +0530 | [diff] [blame] | 770 | #if !STM32MP_USE_STM32IMAGE && PSA_FWU_SUPPORT |
| 771 | void stm32mp1_fwu_set_boot_idx(void) |
| 772 | { |
| 773 | clk_enable(RTCAPB); |
Yann Gautier | 9bbd26a | 2022-03-28 17:49:38 +0200 | [diff] [blame] | 774 | mmio_clrsetbits_32(tamp_bkpr(TAMP_BOOT_FWU_INFO_REG_ID), |
| 775 | TAMP_BOOT_FWU_INFO_IDX_MSK, |
| 776 | (plat_fwu_get_boot_idx() << TAMP_BOOT_FWU_INFO_IDX_OFF) & |
| 777 | TAMP_BOOT_FWU_INFO_IDX_MSK); |
Sughosh Ganu | 03e2f80 | 2021-12-01 15:56:27 +0530 | [diff] [blame] | 778 | clk_disable(RTCAPB); |
| 779 | } |
Nicolas Toromanoff | 5a937cd | 2022-02-07 10:12:04 +0100 | [diff] [blame] | 780 | |
| 781 | uint32_t stm32_get_and_dec_fwu_trial_boot_cnt(void) |
| 782 | { |
| 783 | uintptr_t bkpr_fwu_cnt = tamp_bkpr(TAMP_BOOT_FWU_INFO_REG_ID); |
| 784 | uint32_t try_cnt; |
| 785 | |
| 786 | clk_enable(RTCAPB); |
| 787 | try_cnt = (mmio_read_32(bkpr_fwu_cnt) & TAMP_BOOT_FWU_INFO_CNT_MSK) >> |
| 788 | TAMP_BOOT_FWU_INFO_CNT_OFF; |
| 789 | |
| 790 | assert(try_cnt <= FWU_MAX_TRIAL_REBOOT); |
| 791 | |
| 792 | if (try_cnt != 0U) { |
| 793 | mmio_clrsetbits_32(bkpr_fwu_cnt, TAMP_BOOT_FWU_INFO_CNT_MSK, |
| 794 | (try_cnt - 1U) << TAMP_BOOT_FWU_INFO_CNT_OFF); |
| 795 | } |
| 796 | clk_disable(RTCAPB); |
| 797 | |
| 798 | return try_cnt; |
| 799 | } |
| 800 | |
| 801 | void stm32_set_max_fwu_trial_boot_cnt(void) |
| 802 | { |
| 803 | uintptr_t bkpr_fwu_cnt = tamp_bkpr(TAMP_BOOT_FWU_INFO_REG_ID); |
| 804 | |
| 805 | clk_enable(RTCAPB); |
| 806 | mmio_clrsetbits_32(bkpr_fwu_cnt, TAMP_BOOT_FWU_INFO_CNT_MSK, |
| 807 | (FWU_MAX_TRIAL_REBOOT << TAMP_BOOT_FWU_INFO_CNT_OFF) & |
| 808 | TAMP_BOOT_FWU_INFO_CNT_MSK); |
| 809 | clk_disable(RTCAPB); |
| 810 | } |
Sughosh Ganu | 03e2f80 | 2021-12-01 15:56:27 +0530 | [diff] [blame] | 811 | #endif /* !STM32MP_USE_STM32IMAGE && PSA_FWU_SUPPORT */ |