Dan Handley | 9df4804 | 2015-03-19 18:58:55 +0000 | [diff] [blame] | 1 | /* |
Antonio Nino Diaz | 719bf85 | 2017-02-23 17:22:58 +0000 | [diff] [blame] | 2 | * Copyright (c) 2015-2017, 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> |
Antonio Nino Diaz | f09d003 | 2017-04-11 14:04:56 +0100 | [diff] [blame] | 9 | #include <arm_xlat_tables.h> |
Dan Handley | 9df4804 | 2015-03-19 18:58:55 +0000 | [diff] [blame] | 10 | #include <bl_common.h> |
Dan Handley | 9df4804 | 2015-03-19 18:58:55 +0000 | [diff] [blame] | 11 | #include <console.h> |
| 12 | #include <platform_def.h> |
| 13 | #include <plat_arm.h> |
Juan Castillo | b6132f1 | 2015-10-06 14:01:35 +0100 | [diff] [blame] | 14 | #include <sp805.h> |
Sandrine Bailleux | 28ee10f | 2016-06-15 15:44:27 +0100 | [diff] [blame] | 15 | #include <utils.h> |
Sandrine Bailleux | d7c4750 | 2015-10-02 09:32:35 +0100 | [diff] [blame] | 16 | #include "../../../bl1/bl1_private.h" |
Dan Handley | 9df4804 | 2015-03-19 18:58:55 +0000 | [diff] [blame] | 17 | |
Dan Handley | 9df4804 | 2015-03-19 18:58:55 +0000 | [diff] [blame] | 18 | /* Weak definitions may be overridden in specific ARM standard platform */ |
| 19 | #pragma weak bl1_early_platform_setup |
| 20 | #pragma weak bl1_plat_arch_setup |
| 21 | #pragma weak bl1_platform_setup |
| 22 | #pragma weak bl1_plat_sec_mem_layout |
Yatharth Kochar | ede39cb | 2016-11-14 12:01:04 +0000 | [diff] [blame] | 23 | #pragma weak bl1_plat_prepare_exit |
Dan Handley | 9df4804 | 2015-03-19 18:58:55 +0000 | [diff] [blame] | 24 | |
| 25 | |
| 26 | /* Data structure which holds the extents of the trusted SRAM for BL1*/ |
| 27 | static meminfo_t bl1_tzram_layout; |
| 28 | |
| 29 | meminfo_t *bl1_plat_sec_mem_layout(void) |
| 30 | { |
| 31 | return &bl1_tzram_layout; |
| 32 | } |
| 33 | |
| 34 | /******************************************************************************* |
| 35 | * BL1 specific platform actions shared between ARM standard platforms. |
| 36 | ******************************************************************************/ |
| 37 | void arm_bl1_early_platform_setup(void) |
| 38 | { |
Dan Handley | 9df4804 | 2015-03-19 18:58:55 +0000 | [diff] [blame] | 39 | |
Juan Castillo | b6132f1 | 2015-10-06 14:01:35 +0100 | [diff] [blame] | 40 | #if !ARM_DISABLE_TRUSTED_WDOG |
| 41 | /* Enable watchdog */ |
| 42 | sp805_start(ARM_SP805_TWDG_BASE, ARM_TWDG_LOAD_VAL); |
| 43 | #endif |
| 44 | |
Dan Handley | 9df4804 | 2015-03-19 18:58:55 +0000 | [diff] [blame] | 45 | /* Initialize the console to provide early debug support */ |
| 46 | console_init(PLAT_ARM_BOOT_UART_BASE, PLAT_ARM_BOOT_UART_CLK_IN_HZ, |
| 47 | ARM_CONSOLE_BAUDRATE); |
| 48 | |
| 49 | /* Allow BL1 to see the whole Trusted RAM */ |
| 50 | bl1_tzram_layout.total_base = ARM_BL_RAM_BASE; |
| 51 | bl1_tzram_layout.total_size = ARM_BL_RAM_SIZE; |
| 52 | |
Yatharth Kochar | f9a0f16 | 2016-09-13 17:07:57 +0100 | [diff] [blame] | 53 | #if !LOAD_IMAGE_V2 |
Dan Handley | 9df4804 | 2015-03-19 18:58:55 +0000 | [diff] [blame] | 54 | /* Calculate how much RAM BL1 is using and how much remains free */ |
| 55 | bl1_tzram_layout.free_base = ARM_BL_RAM_BASE; |
| 56 | bl1_tzram_layout.free_size = ARM_BL_RAM_SIZE; |
| 57 | reserve_mem(&bl1_tzram_layout.free_base, |
| 58 | &bl1_tzram_layout.free_size, |
| 59 | BL1_RAM_BASE, |
Yatharth Kochar | f9a0f16 | 2016-09-13 17:07:57 +0100 | [diff] [blame] | 60 | BL1_RAM_LIMIT - BL1_RAM_BASE); |
| 61 | #endif /* LOAD_IMAGE_V2 */ |
Dan Handley | 9df4804 | 2015-03-19 18:58:55 +0000 | [diff] [blame] | 62 | } |
| 63 | |
| 64 | void bl1_early_platform_setup(void) |
| 65 | { |
| 66 | arm_bl1_early_platform_setup(); |
| 67 | |
| 68 | /* |
Vikram Kanigiri | fbb1301 | 2016-02-15 11:54:14 +0000 | [diff] [blame] | 69 | * Initialize Interconnect for this cluster during cold boot. |
Dan Handley | 9df4804 | 2015-03-19 18:58:55 +0000 | [diff] [blame] | 70 | * No need for locks as no other CPU is active. |
| 71 | */ |
Vikram Kanigiri | fbb1301 | 2016-02-15 11:54:14 +0000 | [diff] [blame] | 72 | plat_arm_interconnect_init(); |
Dan Handley | 9df4804 | 2015-03-19 18:58:55 +0000 | [diff] [blame] | 73 | /* |
Vikram Kanigiri | fbb1301 | 2016-02-15 11:54:14 +0000 | [diff] [blame] | 74 | * Enable Interconnect coherency for the primary CPU's cluster. |
Dan Handley | 9df4804 | 2015-03-19 18:58:55 +0000 | [diff] [blame] | 75 | */ |
Vikram Kanigiri | fbb1301 | 2016-02-15 11:54:14 +0000 | [diff] [blame] | 76 | plat_arm_interconnect_enter_coherency(); |
Dan Handley | 9df4804 | 2015-03-19 18:58:55 +0000 | [diff] [blame] | 77 | } |
| 78 | |
| 79 | /****************************************************************************** |
| 80 | * Perform the very early platform specific architecture setup shared between |
| 81 | * ARM standard platforms. This only does basic initialization. Later |
| 82 | * architectural setup (bl1_arch_setup()) does not do anything platform |
| 83 | * specific. |
| 84 | *****************************************************************************/ |
| 85 | void arm_bl1_plat_arch_setup(void) |
| 86 | { |
Sandrine Bailleux | 4a1267a | 2016-05-18 16:11:47 +0100 | [diff] [blame] | 87 | arm_setup_page_tables(bl1_tzram_layout.total_base, |
Dan Handley | 9df4804 | 2015-03-19 18:58:55 +0000 | [diff] [blame] | 88 | bl1_tzram_layout.total_size, |
Sandrine Bailleux | ecdc4d3 | 2016-07-08 14:38:16 +0100 | [diff] [blame] | 89 | BL_CODE_BASE, |
Masahiro Yamada | 51bef61 | 2017-01-18 02:10:08 +0900 | [diff] [blame] | 90 | BL1_CODE_END, |
Sandrine Bailleux | ecdc4d3 | 2016-07-08 14:38:16 +0100 | [diff] [blame] | 91 | BL1_RO_DATA_BASE, |
Masahiro Yamada | 51bef61 | 2017-01-18 02:10:08 +0900 | [diff] [blame] | 92 | BL1_RO_DATA_END |
Dan Handley | 9df4804 | 2015-03-19 18:58:55 +0000 | [diff] [blame] | 93 | #if USE_COHERENT_MEM |
Masahiro Yamada | 0fac5af | 2016-12-28 16:11:41 +0900 | [diff] [blame] | 94 | , BL_COHERENT_RAM_BASE, |
| 95 | BL_COHERENT_RAM_END |
Dan Handley | 9df4804 | 2015-03-19 18:58:55 +0000 | [diff] [blame] | 96 | #endif |
| 97 | ); |
Yatharth Kochar | 88ac53b | 2016-07-04 11:03:49 +0100 | [diff] [blame] | 98 | #ifdef AARCH32 |
| 99 | enable_mmu_secure(0); |
| 100 | #else |
Sandrine Bailleux | 4a1267a | 2016-05-18 16:11:47 +0100 | [diff] [blame] | 101 | enable_mmu_el3(0); |
Yatharth Kochar | 88ac53b | 2016-07-04 11:03:49 +0100 | [diff] [blame] | 102 | #endif /* AARCH32 */ |
Dan Handley | 9df4804 | 2015-03-19 18:58:55 +0000 | [diff] [blame] | 103 | } |
| 104 | |
| 105 | void bl1_plat_arch_setup(void) |
| 106 | { |
| 107 | arm_bl1_plat_arch_setup(); |
| 108 | } |
| 109 | |
| 110 | /* |
| 111 | * Perform the platform specific architecture setup shared between |
| 112 | * ARM standard platforms. |
| 113 | */ |
| 114 | void arm_bl1_platform_setup(void) |
| 115 | { |
| 116 | /* Initialise the IO layer and register platform IO devices */ |
| 117 | plat_arm_io_setup(); |
| 118 | } |
| 119 | |
| 120 | void bl1_platform_setup(void) |
| 121 | { |
| 122 | arm_bl1_platform_setup(); |
| 123 | } |
| 124 | |
Sandrine Bailleux | 03897bb | 2015-11-26 16:31:34 +0000 | [diff] [blame] | 125 | void bl1_plat_prepare_exit(entry_point_info_t *ep_info) |
| 126 | { |
Juan Castillo | b6132f1 | 2015-10-06 14:01:35 +0100 | [diff] [blame] | 127 | #if !ARM_DISABLE_TRUSTED_WDOG |
| 128 | /* Disable watchdog before leaving BL1 */ |
| 129 | sp805_stop(ARM_SP805_TWDG_BASE); |
| 130 | #endif |
| 131 | |
Sandrine Bailleux | 03897bb | 2015-11-26 16:31:34 +0000 | [diff] [blame] | 132 | #ifdef EL3_PAYLOAD_BASE |
| 133 | /* |
| 134 | * Program the EL3 payload's entry point address into the CPUs mailbox |
| 135 | * in order to release secondary CPUs from their holding pen and make |
| 136 | * them jump there. |
| 137 | */ |
| 138 | arm_program_trusted_mailbox(ep_info->pc); |
| 139 | dsbsy(); |
| 140 | sev(); |
| 141 | #endif |
| 142 | } |