1 // SPDX-License-Identifier: BSD-3-Clause
3 * Reference to the ARM TF Project,
4 * plat/arm/common/arm_bl2_setup.c
5 * Portions copyright (c) 2013-2016, ARM Limited and Contributors. All rights
7 * Copyright (C) 2016 Rockchip Electronic Co.,Ltd
8 * Written by Kever Yang <kever.yang@rock-chips.com>
9 * Copyright (C) 2017 Theobroma Systems Design und Consulting GmbH
13 #include <atf_common.h>
17 static struct bl2_to_bl31_params_mem bl31_params_mem
;
18 static struct bl31_params
*bl2_to_bl31_params
;
21 * bl2_plat_get_bl31_params() - prepare params for bl31.
23 * This function assigns a pointer to the memory that the platform has kept
24 * aside to pass platform specific and trusted firmware related information
25 * to BL31. This memory is allocated by allocating memory to
26 * bl2_to_bl31_params_mem structure which is a superset of all the
27 * structure whose information is passed to BL31
28 * NOTE: This function should be called only once and should be done
29 * before generating params to BL31
31 * @return bl31 params structure pointer
33 static struct bl31_params
*bl2_plat_get_bl31_params(uintptr_t bl33_entry
)
35 struct entry_point_info
*bl33_ep_info
;
38 * Initialise the memory for all the arguments that needs to
41 memset(&bl31_params_mem
, 0, sizeof(struct bl2_to_bl31_params_mem
));
43 /* Assign memory for TF related information */
44 bl2_to_bl31_params
= &bl31_params_mem
.bl31_params
;
45 SET_PARAM_HEAD(bl2_to_bl31_params
, ATF_PARAM_BL31
, ATF_VERSION_1
, 0);
47 /* Fill BL31 related information */
48 bl2_to_bl31_params
->bl31_image_info
= &bl31_params_mem
.bl31_image_info
;
49 SET_PARAM_HEAD(bl2_to_bl31_params
->bl31_image_info
,
50 ATF_PARAM_IMAGE_BINARY
, ATF_VERSION_1
, 0);
52 /* Fill BL32 related information if it exists */
53 bl2_to_bl31_params
->bl32_ep_info
= &bl31_params_mem
.bl32_ep_info
;
54 SET_PARAM_HEAD(bl2_to_bl31_params
->bl32_ep_info
, ATF_PARAM_EP
,
56 bl2_to_bl31_params
->bl32_image_info
= &bl31_params_mem
.bl32_image_info
;
57 SET_PARAM_HEAD(bl2_to_bl31_params
->bl32_image_info
,
58 ATF_PARAM_IMAGE_BINARY
, ATF_VERSION_1
, 0);
60 bl2_to_bl31_params
->bl32_ep_info
->pc
= 0;
61 #endif /* BL32_BASE */
63 /* Fill BL33 related information */
64 bl2_to_bl31_params
->bl33_ep_info
= &bl31_params_mem
.bl33_ep_info
;
65 bl33_ep_info
= &bl31_params_mem
.bl33_ep_info
;
66 SET_PARAM_HEAD(bl33_ep_info
, ATF_PARAM_EP
, ATF_VERSION_1
,
69 /* BL33 expects to receive the primary CPU MPID (through x0) */
70 bl33_ep_info
->args
.arg0
= 0xffff & read_mpidr();
71 bl33_ep_info
->pc
= bl33_entry
;
72 bl33_ep_info
->spsr
= SPSR_64(MODE_EL2
, MODE_SP_ELX
,
73 DISABLE_ALL_EXECPTIONS
);
75 bl2_to_bl31_params
->bl33_image_info
= &bl31_params_mem
.bl33_image_info
;
76 SET_PARAM_HEAD(bl2_to_bl31_params
->bl33_image_info
,
77 ATF_PARAM_IMAGE_BINARY
, ATF_VERSION_1
, 0);
79 return bl2_to_bl31_params
;
82 static inline void raw_write_daif(unsigned int daif
)
84 __asm__
__volatile__("msr DAIF, %0\n\t" : : "r" (daif
) : "memory");
87 typedef void (*atf_entry_t
)(struct bl31_params
*params
, void *plat_params
);
89 static void bl31_entry(uintptr_t bl31_entry
, uintptr_t bl33_entry
,
92 struct bl31_params
*bl31_params
;
93 atf_entry_t atf_entry
= (atf_entry_t
)bl31_entry
;
95 bl31_params
= bl2_plat_get_bl31_params(bl33_entry
);
97 raw_write_daif(SPSR_EXCEPTION_MASK
);
100 atf_entry((void *)bl31_params
, (void *)fdt_addr
);
103 static int spl_fit_images_find_uboot(void *blob
)
105 int parent
, node
, ndepth
;
109 return -FDT_ERR_BADMAGIC
;
111 parent
= fdt_path_offset(blob
, "/fit-images");
113 return -FDT_ERR_NOTFOUND
;
115 for (node
= fdt_next_node(blob
, parent
, &ndepth
);
116 (node
>= 0) && (ndepth
> 0);
117 node
= fdt_next_node(blob
, node
, &ndepth
)) {
121 data
= fdt_getprop(blob
, node
, FIT_OS_PROP
, NULL
);
125 if (genimg_get_os_id(data
) == IH_OS_U_BOOT
)
129 return -FDT_ERR_NOTFOUND
;
132 uintptr_t spl_fit_images_get_entry(void *blob
, int node
)
136 val
= fdt_getprop_u32(blob
, node
, "entry-point");
137 if (val
== FDT_ERROR
)
138 val
= fdt_getprop_u32(blob
, node
, "load-addr");
140 debug("%s: entry point 0x%lx\n", __func__
, val
);
144 void spl_invoke_atf(struct spl_image_info
*spl_image
)
146 uintptr_t bl33_entry
= CONFIG_SYS_TEXT_BASE
;
147 void *blob
= spl_image
->fdt_addr
;
148 uintptr_t platform_param
= (uintptr_t)blob
;
152 * Find the U-Boot binary (in /fit-images) load addreess or
153 * entry point (if different) and pass it as the BL3-3 entry
155 * This will need to be extended to support Falcon mode.
158 node
= spl_fit_images_find_uboot(blob
);
160 bl33_entry
= spl_fit_images_get_entry(blob
, node
);
163 * If ATF_NO_PLATFORM_PARAM is set, we override the platform
164 * parameter and always pass 0. This is a workaround for
165 * older ATF versions that have insufficiently robust (or
166 * overzealous) argument validation.
168 if (CONFIG_IS_ENABLED(ATF_NO_PLATFORM_PARAM
))
172 * We don't provide a BL3-2 entry yet, but this will be possible
173 * using similar logic.
175 bl31_entry(spl_image
->entry_point
, bl33_entry
, platform_param
);