• Home
  • Line#
  • Scopes#
  • Navigate#
  • Raw
  • Download
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