1 /*
2  * Copyright (c) 2016-2020, ARM Limited and Contributors. All rights reserved.
3  *
4  * SPDX-License-Identifier: BSD-3-Clause
5  */
6 
7 #include <assert.h>
8 #include <stdint.h>
9 
10 #include <platform_def.h>
11 
12 #include <arch.h>
13 #include <arch_helpers.h>
14 #include <common/bl_common.h>
15 #include <common/debug.h>
16 #include <common/desc_image_load.h>
17 #include <drivers/auth/auth_mod.h>
18 #include <plat/common/platform.h>
19 
20 #include "bl2_private.h"
21 
22 /*******************************************************************************
23  * This function loads SCP_BL2/BL3x images and returns the ep_info for
24  * the next executable image.
25  ******************************************************************************/
bl2_load_images(void)26 struct entry_point_info *bl2_load_images(void)
27 {
28 	bl_params_t *bl2_to_next_bl_params;
29 	bl_load_info_t *bl2_load_info;
30 	const bl_load_info_node_t *bl2_node_info;
31 	int plat_setup_done = 0;
32 	int err;
33 
34 	/*
35 	 * Get information about the images to load.
36 	 */
37 	bl2_load_info = plat_get_bl_image_load_info();
38 	assert(bl2_load_info != NULL);
39 	assert(bl2_load_info->head != NULL);
40 	assert(bl2_load_info->h.type == PARAM_BL_LOAD_INFO);
41 	assert(bl2_load_info->h.version >= VERSION_2);
42 	bl2_node_info = bl2_load_info->head;
43 
44 	while (bl2_node_info != NULL) {
45 		/*
46 		 * Perform platform setup before loading the image,
47 		 * if indicated in the image attributes AND if NOT
48 		 * already done before.
49 		 */
50 		if ((bl2_node_info->image_info->h.attr &
51 		    IMAGE_ATTRIB_PLAT_SETUP) != 0U) {
52 			if (plat_setup_done != 0) {
53 				WARN("BL2: Platform setup already done!!\n");
54 			} else {
55 				INFO("BL2: Doing platform setup\n");
56 				bl2_platform_setup();
57 				plat_setup_done = 1;
58 			}
59 		}
60 
61 		err = bl2_plat_handle_pre_image_load(bl2_node_info->image_id);
62 		if (err != 0) {
63 			ERROR("BL2: Failure in pre image load handling (%i)\n", err);
64 			plat_error_handler(err);
65 		}
66 
67 		if ((bl2_node_info->image_info->h.attr &
68 		    IMAGE_ATTRIB_SKIP_LOADING) == 0U) {
69 			INFO("BL2: Loading image id %d\n", bl2_node_info->image_id);
70 			err = load_auth_image(bl2_node_info->image_id,
71 				bl2_node_info->image_info);
72 			if (err != 0) {
73 				ERROR("BL2: Failed to load image id %d (%i)\n",
74 				      bl2_node_info->image_id, err);
75 				plat_error_handler(err);
76 			}
77 		} else {
78 			INFO("BL2: Skip loading image id %d\n", bl2_node_info->image_id);
79 		}
80 
81 		/* Allow platform to handle image information. */
82 		err = bl2_plat_handle_post_image_load(bl2_node_info->image_id);
83 		if (err != 0) {
84 			ERROR("BL2: Failure in post image load handling (%i)\n", err);
85 			plat_error_handler(err);
86 		}
87 
88 		/* Go to next image */
89 		bl2_node_info = bl2_node_info->next_load_info;
90 	}
91 
92 	/*
93 	 * Get information to pass to the next image.
94 	 */
95 	bl2_to_next_bl_params = plat_get_next_bl_params();
96 	assert(bl2_to_next_bl_params != NULL);
97 	assert(bl2_to_next_bl_params->head != NULL);
98 	assert(bl2_to_next_bl_params->h.type == PARAM_BL_PARAMS);
99 	assert(bl2_to_next_bl_params->h.version >= VERSION_2);
100 	assert(bl2_to_next_bl_params->head->ep_info != NULL);
101 
102 	/* Populate arg0 for the next BL image if not already provided */
103 	if (bl2_to_next_bl_params->head->ep_info->args.arg0 == (u_register_t)0)
104 		bl2_to_next_bl_params->head->ep_info->args.arg0 =
105 					(u_register_t)bl2_to_next_bl_params;
106 
107 	/* Flush the parameters to be passed to next image */
108 	plat_flush_next_bl_params();
109 
110 	return bl2_to_next_bl_params->head->ep_info;
111 }
112