xref: /rk3399_ARM-atf/bl2/bl2_image_load_v2.c (revision a416325bc135fde6c38ef5b2433ee60c20ef6278)
1 /*
2  * Copyright (c) 2016-2018, 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  ******************************************************************************/
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);
39 	assert(bl2_load_info->head);
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) {
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 & IMAGE_ATTRIB_PLAT_SETUP) {
51 			if (plat_setup_done) {
52 				WARN("BL2: Platform setup already done!!\n");
53 			} else {
54 				INFO("BL2: Doing platform setup\n");
55 				bl2_platform_setup();
56 				plat_setup_done = 1;
57 			}
58 		}
59 
60 		err = bl2_plat_handle_pre_image_load(bl2_node_info->image_id);
61 		if (err) {
62 			ERROR("BL2: Failure in pre image load handling (%i)\n", err);
63 			plat_error_handler(err);
64 		}
65 
66 		if (!(bl2_node_info->image_info->h.attr & IMAGE_ATTRIB_SKIP_LOADING)) {
67 			INFO("BL2: Loading image id %d\n", bl2_node_info->image_id);
68 			err = load_auth_image(bl2_node_info->image_id,
69 				bl2_node_info->image_info);
70 			if (err) {
71 				ERROR("BL2: Failed to load image id %d (%i)\n",
72 				      bl2_node_info->image_id, err);
73 				plat_error_handler(err);
74 			}
75 		} else {
76 			INFO("BL2: Skip loading image id %d\n", bl2_node_info->image_id);
77 		}
78 
79 		/* Allow platform to handle image information. */
80 		err = bl2_plat_handle_post_image_load(bl2_node_info->image_id);
81 		if (err) {
82 			ERROR("BL2: Failure in post image load handling (%i)\n", err);
83 			plat_error_handler(err);
84 		}
85 
86 		/* Go to next image */
87 		bl2_node_info = bl2_node_info->next_load_info;
88 	}
89 
90 	/*
91 	 * Get information to pass to the next image.
92 	 */
93 	bl2_to_next_bl_params = plat_get_next_bl_params();
94 	assert(bl2_to_next_bl_params);
95 	assert(bl2_to_next_bl_params->head);
96 	assert(bl2_to_next_bl_params->h.type == PARAM_BL_PARAMS);
97 	assert(bl2_to_next_bl_params->h.version >= VERSION_2);
98 	assert(bl2_to_next_bl_params->head->ep_info);
99 
100 	/* Populate arg0 for the next BL image if not already provided */
101 	if (bl2_to_next_bl_params->head->ep_info->args.arg0 == (u_register_t)0)
102 		bl2_to_next_bl_params->head->ep_info->args.arg0 =
103 					(u_register_t)bl2_to_next_bl_params;
104 
105 	/* Flush the parameters to be passed to next image */
106 	plat_flush_next_bl_params();
107 
108 	return bl2_to_next_bl_params->head->ep_info;
109 }
110