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