1 /*
2 * Copyright (c) 2017-2020, ARM Limited and Contributors. All rights reserved.
3 *
4 * SPDX-License-Identifier: BSD-3-Clause
5 */
6
7 #include <errno.h>
8
9 #include <platform_def.h>
10
11 #include <common/bl_common.h>
12 #include <common/debug.h>
13 #include <common/desc_image_load.h>
14 #include <common/image_decompress.h>
15 #include <drivers/io/io_storage.h>
16 #include <lib/xlat_tables/xlat_tables_v2.h>
17 #include <plat/common/platform.h>
18 #ifdef UNIPHIER_DECOMPRESS_GZIP
19 #include <tf_gunzip.h>
20 #endif
21
22 #include "uniphier.h"
23
24 #define UNIPHIER_IMAGE_BUF_OFFSET 0x04300000UL
25 #define UNIPHIER_IMAGE_BUF_SIZE 0x00100000UL
26
27 static uintptr_t uniphier_mem_base = UNIPHIER_MEM_BASE;
28 static int uniphier_bl2_kick_scp;
29
bl2_el3_early_platform_setup(u_register_t x0,u_register_t x1,u_register_t x2,u_register_t x3)30 void bl2_el3_early_platform_setup(u_register_t x0, u_register_t x1,
31 u_register_t x2, u_register_t x3)
32 {
33 uniphier_console_setup();
34 }
35
bl2_el3_plat_arch_setup(void)36 void bl2_el3_plat_arch_setup(void)
37 {
38 unsigned int soc;
39 int skip_scp = 0;
40 int ret;
41
42 uniphier_mmap_setup();
43 enable_mmu_el3(0);
44
45 /* add relocation offset (run-time-address - link-address) */
46 uniphier_mem_base += BL_CODE_BASE - BL2_BASE;
47
48 soc = uniphier_get_soc_id();
49 if (soc == UNIPHIER_SOC_UNKNOWN) {
50 ERROR("unsupported SoC\n");
51 plat_error_handler(-ENOTSUP);
52 }
53
54 ret = uniphier_io_setup(soc, uniphier_mem_base);
55 if (ret) {
56 ERROR("failed to setup io devices\n");
57 plat_error_handler(ret);
58 }
59
60 switch (uniphier_get_boot_master(soc)) {
61 case UNIPHIER_BOOT_MASTER_THIS:
62 INFO("Booting from this SoC\n");
63 skip_scp = 1;
64 break;
65 case UNIPHIER_BOOT_MASTER_SCP:
66 INFO("Booting from on-chip SCP\n");
67 if (uniphier_scp_is_running()) {
68 INFO("SCP is already running. SCP_BL2 load will be skipped.\n");
69 skip_scp = 1;
70 }
71
72 /*
73 * SCP must be kicked every time even if it is already running
74 * because it polls this event after the reboot of the backend.
75 */
76 uniphier_bl2_kick_scp = 1;
77 break;
78 case UNIPHIER_BOOT_MASTER_EXT:
79 INFO("Booting from external SCP\n");
80 skip_scp = 1;
81 break;
82 default:
83 plat_error_handler(-ENOTSUP);
84 break;
85 }
86
87 if (skip_scp) {
88 struct image_info *image_info;
89
90 image_info = uniphier_get_image_info(SCP_BL2_IMAGE_ID);
91 image_info->h.attr |= IMAGE_ATTRIB_SKIP_LOADING;
92 }
93 }
94
bl2_platform_setup(void)95 void bl2_platform_setup(void)
96 {
97 }
98
plat_flush_next_bl_params(void)99 void plat_flush_next_bl_params(void)
100 {
101 flush_bl_params_desc();
102 }
103
plat_get_bl_image_load_info(void)104 bl_load_info_t *plat_get_bl_image_load_info(void)
105 {
106 return get_bl_load_info_from_mem_params_desc();
107 }
108
plat_get_next_bl_params(void)109 bl_params_t *plat_get_next_bl_params(void)
110 {
111 return get_next_bl_params_from_mem_params_desc();
112 }
113
bl2_plat_preload_setup(void)114 void bl2_plat_preload_setup(void)
115 {
116 #ifdef UNIPHIER_DECOMPRESS_GZIP
117 uintptr_t buf_base = uniphier_mem_base + UNIPHIER_IMAGE_BUF_OFFSET;
118 int ret;
119
120 ret = mmap_add_dynamic_region(buf_base, buf_base,
121 UNIPHIER_IMAGE_BUF_SIZE,
122 MT_MEMORY | MT_RW | MT_NS);
123 if (ret)
124 plat_error_handler(ret);
125
126 image_decompress_init(buf_base, UNIPHIER_IMAGE_BUF_SIZE, gunzip);
127 #endif
128
129 uniphier_init_image_descs(uniphier_mem_base);
130 }
131
bl2_plat_handle_pre_image_load(unsigned int image_id)132 int bl2_plat_handle_pre_image_load(unsigned int image_id)
133 {
134 struct image_info *image_info;
135 int ret;
136
137 image_info = uniphier_get_image_info(image_id);
138
139 ret = mmap_add_dynamic_region(image_info->image_base,
140 image_info->image_base,
141 image_info->image_max_size,
142 MT_MEMORY | MT_RW | MT_NS);
143 if (ret)
144 return ret;
145
146 #ifdef UNIPHIER_DECOMPRESS_GZIP
147 image_decompress_prepare(image_info);
148 #endif
149 return 0;
150 }
151
bl2_plat_handle_post_image_load(unsigned int image_id)152 int bl2_plat_handle_post_image_load(unsigned int image_id)
153 {
154 struct image_info *image_info = uniphier_get_image_info(image_id);
155 #ifdef UNIPHIER_DECOMPRESS_GZIP
156 int ret;
157
158 if (!(image_info->h.attr & IMAGE_ATTRIB_SKIP_LOADING)) {
159 ret = image_decompress(uniphier_get_image_info(image_id));
160 if (ret)
161 return ret;
162 }
163 #endif
164
165 if (image_id == SCP_BL2_IMAGE_ID && uniphier_bl2_kick_scp)
166 uniphier_scp_start(image_info->image_base);
167
168 return 0;
169 }
170