2 * Reference to the ARM TF Project,
3 * plat/arm/common/arm_bl2_setup.c
4 * Portions copyright (c) 2013-2016, ARM Limited and Contributors. All rights
6 * Copyright (C) 2016 Rockchip Electronic Co.,Ltd
7 * Written by Kever Yang <kever.yang@rock-chips.com>
8 * Copyright (C) 2017 Theobroma Systems Design und Consulting GmbH
10 * SPDX-License-Identifier: BSD-3-Clause
14 #include <atf_common.h>
18 static struct bl2_to_bl31_params_mem bl31_params_mem
;
19 static struct bl31_params
*bl2_to_bl31_params
;
22 * bl2_plat_get_bl31_params() - prepare params for bl31.
24 * This function assigns a pointer to the memory that the platform has kept
25 * aside to pass platform specific and trusted firmware related information
26 * to BL31. This memory is allocated by allocating memory to
27 * bl2_to_bl31_params_mem structure which is a superset of all the
28 * structure whose information is passed to BL31
29 * NOTE: This function should be called only once and should be done
30 * before generating params to BL31
32 * @return bl31 params structure pointer
34 static struct bl31_params
*bl2_plat_get_bl31_params(uintptr_t bl33_entry
)
36 struct entry_point_info
*bl33_ep_info
;
39 * Initialise the memory for all the arguments that needs to
42 memset(&bl31_params_mem
, 0, sizeof(struct bl2_to_bl31_params_mem
));
44 /* Assign memory for TF related information */
45 bl2_to_bl31_params
= &bl31_params_mem
.bl31_params
;
46 SET_PARAM_HEAD(bl2_to_bl31_params
, ATF_PARAM_BL31
, ATF_VERSION_1
, 0);
48 /* Fill BL31 related information */
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 */
54 bl2_to_bl31_params
->bl32_ep_info
= &bl31_params_mem
.bl32_ep_info
;
55 SET_PARAM_HEAD(bl2_to_bl31_params
->bl32_ep_info
, ATF_PARAM_EP
,
57 bl2_to_bl31_params
->bl32_image_info
= &bl31_params_mem
.bl32_image_info
;
58 SET_PARAM_HEAD(bl2_to_bl31_params
->bl32_image_info
,
59 ATF_PARAM_IMAGE_BINARY
, ATF_VERSION_1
, 0);
60 #endif /* BL32_BASE */
62 /* Fill BL33 related information */
63 bl2_to_bl31_params
->bl33_ep_info
= &bl31_params_mem
.bl33_ep_info
;
64 bl33_ep_info
= &bl31_params_mem
.bl33_ep_info
;
65 SET_PARAM_HEAD(bl33_ep_info
, ATF_PARAM_EP
, ATF_VERSION_1
,
68 /* BL33 expects to receive the primary CPU MPID (through x0) */
69 bl33_ep_info
->args
.arg0
= 0xffff & read_mpidr();
70 bl33_ep_info
->pc
= bl33_entry
;
71 bl33_ep_info
->spsr
= SPSR_64(MODE_EL2
, MODE_SP_ELX
,
72 DISABLE_ALL_EXECPTIONS
);
74 bl2_to_bl31_params
->bl33_image_info
= &bl31_params_mem
.bl33_image_info
;
75 SET_PARAM_HEAD(bl2_to_bl31_params
->bl33_image_info
,
76 ATF_PARAM_IMAGE_BINARY
, ATF_VERSION_1
, 0);
78 return bl2_to_bl31_params
;
81 static inline void raw_write_daif(unsigned int daif
)
83 __asm__
__volatile__("msr DAIF, %0\n\t" : : "r" (daif
) : "memory");
86 typedef void (*atf_entry_t
)(struct bl31_params
*params
, void *plat_params
);
88 static void bl31_entry(uintptr_t bl31_entry
, uintptr_t bl33_entry
,
91 struct bl31_params
*bl31_params
;
92 atf_entry_t atf_entry
= (atf_entry_t
)bl31_entry
;
94 bl31_params
= bl2_plat_get_bl31_params(bl33_entry
);
96 raw_write_daif(SPSR_EXCEPTION_MASK
);
99 atf_entry((void *)bl31_params
, (void *)fdt_addr
);
102 static int spl_fit_images_find_uboot(void *blob
)
104 int parent
, node
, ndepth
;
108 return -FDT_ERR_BADMAGIC
;
110 parent
= fdt_path_offset(blob
, "/fit-images");
112 return -FDT_ERR_NOTFOUND
;
114 for (node
= fdt_next_node(blob
, parent
, &ndepth
);
115 (node
>= 0) && (ndepth
> 0);
116 node
= fdt_next_node(blob
, node
, &ndepth
)) {
120 data
= fdt_getprop(blob
, node
, FIT_OS_PROP
, NULL
);
124 if (genimg_get_os_id(data
) == IH_OS_U_BOOT
)
128 return -FDT_ERR_NOTFOUND
;
131 uintptr_t spl_fit_images_get_entry(void *blob
, int node
)
135 val
= fdt_getprop_u32(blob
, node
, "entry-point");
136 if (val
== FDT_ERROR
)
137 val
= fdt_getprop_u32(blob
, node
, "load-addr");
139 debug("%s: entry point 0x%lx\n", __func__
, val
);
143 void spl_invoke_atf(struct spl_image_info
*spl_image
)
145 uintptr_t bl33_entry
= CONFIG_SYS_TEXT_BASE
;
146 void *blob
= spl_image
->fdt_addr
;
150 * Find the U-Boot binary (in /fit-images) load addreess or
151 * entry point (if different) and pass it as the BL3-3 entry
153 * This will need to be extended to support Falcon mode.
156 node
= spl_fit_images_find_uboot(blob
);
158 bl33_entry
= spl_fit_images_get_entry(blob
, node
);
161 * We don't provide a BL3-2 entry yet, but this will be possible
162 * using similar logic.
164 bl31_entry(spl_image
->entry_point
, bl33_entry
, (uintptr_t)blob
);