bl2/bl2_main.c

   1 /*
   2  * Copyright (c) 2013-2019, ARM Limited and Contributors. All rights reserved.
   3  *
   4  * SPDX-License-Identifier: BSD-3-Clause
   5  */
   6
   7 #include <arch_helpers.h>
   8 #include <bl1/bl1.h>
   9 #include <bl2/bl2.h>
  10 #include <common/bl_common.h>
  11 #include <common/debug.h>
  12 #include <drivers/auth/auth_mod.h>
  13 #include <drivers/console.h>
  14 #include <plat/common/platform.h>
  15
  16 #include "bl2_private.h"
  17
  18 #ifdef __aarch64__
  19 #define NEXT_IMAGE      "BL31"
  20 #else
  21 #define NEXT_IMAGE      "BL32"
  22 #endif
  23
  24 #if !BL2_AT_EL3
  25 /*******************************************************************************
  26  * Setup function for BL2.
  27  ******************************************************************************/
  28 void bl2_setup(u_register_t arg0, u_register_t arg1, u_register_t arg2,
  29                u_register_t arg3)
  30 {
  31         /* Perform early platform-specific setup */
  32         bl2_early_platform_setup2(arg0, arg1, arg2, arg3);
  33
  34 #ifdef __aarch64__
  35         /*
  36          * Update pointer authentication key before the MMU is enabled. It is
  37          * saved in the rodata section, that can be writen before enabling the
  38          * MMU. This function must be called after the console is initialized
  39          * in the early platform setup.
  40          */
  41         bl_handle_pauth();
  42 #endif /* __aarch64__ */
  43
  44         /* Perform late platform-specific setup */
  45         bl2_plat_arch_setup();
  46 }
  47
  48 #else /* if BL2_AT_EL3 */
  49 /*******************************************************************************
  50  * Setup function for BL2 when BL2_AT_EL3=1.
  51  ******************************************************************************/
  52 void bl2_el3_setup(u_register_t arg0, u_register_t arg1, u_register_t arg2,
  53                    u_register_t arg3)
  54 {
  55         /* Perform early platform-specific setup */
  56         bl2_el3_early_platform_setup(arg0, arg1, arg2, arg3);
  57
  58 #ifdef __aarch64__
  59         /*
  60          * Update pointer authentication key before the MMU is enabled. It is
  61          * saved in the rodata section, that can be writen before enabling the
  62          * MMU. This function must be called after the console is initialized
  63          * in the early platform setup.
  64          */
  65         bl_handle_pauth();
  66 #endif /* __aarch64__ */
  67
  68         /* Perform late platform-specific setup */
  69         bl2_el3_plat_arch_setup();
  70 }
  71 #endif /* BL2_AT_EL3 */
  72
  73 /*******************************************************************************
  74  * The only thing to do in BL2 is to load further images and pass control to
  75  * next BL. The memory occupied by BL2 will be reclaimed by BL3x stages. BL2
  76  * runs entirely in S-EL1.
  77  ******************************************************************************/
  78 void bl2_main(void)
  79 {
  80         entry_point_info_t *next_bl_ep_info;
  81
  82         NOTICE("BL2: %s\n", version_string);
  83         NOTICE("BL2: %s\n", build_message);
  84
  85         /* Perform remaining generic architectural setup in S-EL1 */
  86         bl2_arch_setup();
  87
  88 #if TRUSTED_BOARD_BOOT
  89         /* Initialize authentication module */
  90         auth_mod_init();
  91 #endif /* TRUSTED_BOARD_BOOT */
  92
  93         /* initialize boot source */
  94         bl2_plat_preload_setup();
  95
  96         /* Load the subsequent bootloader images. */
  97         next_bl_ep_info = bl2_load_images();
  98
  99 #if !BL2_AT_EL3
 100 #ifndef __aarch64__
 101         /*
 102          * For AArch32 state BL1 and BL2 share the MMU setup.
 103          * Given that BL2 does not map BL1 regions, MMU needs
 104          * to be disabled in order to go back to BL1.
 105          */
 106         disable_mmu_icache_secure();
 107 #endif /* !__aarch64__ */
 108
 109         console_flush();
 110
 111         /*
 112          * Run next BL image via an SMC to BL1. Information on how to pass
 113          * control to the BL32 (if present) and BL33 software images will
 114          * be passed to next BL image as an argument.
 115          */
 116         smc(BL1_SMC_RUN_IMAGE, (unsigned long)next_bl_ep_info, 0, 0, 0, 0, 0, 0);
 117 #else /* if BL2_AT_EL3 */
 118         NOTICE("BL2: Booting " NEXT_IMAGE "\n");
 119         print_entry_point_info(next_bl_ep_info);
 120         console_flush();
 121
 122         bl2_run_next_image(next_bl_ep_info);
 123 #endif /* BL2_AT_EL3 */
 124 }