1*bcc1726aSKever Yang /* 2*bcc1726aSKever Yang * Reference to the ARM TF Project, 3*bcc1726aSKever Yang * plat/arm/common/arm_bl2_setup.c 4*bcc1726aSKever Yang * Portions copyright (c) 2013-2016, ARM Limited and Contributors. All rights 5*bcc1726aSKever Yang * reserved. 6*bcc1726aSKever Yang * Copyright (C) 2016 Rockchip Electronic Co.,Ltd 7*bcc1726aSKever Yang * Written by Kever Yang <kever.yang@rock-chips.com> 8*bcc1726aSKever Yang * 9*bcc1726aSKever Yang * SPDX-License-Identifier: BSD-3-Clause 10*bcc1726aSKever Yang */ 11*bcc1726aSKever Yang 12*bcc1726aSKever Yang #include <common.h> 13*bcc1726aSKever Yang #include <atf_common.h> 14*bcc1726aSKever Yang #include <errno.h> 15*bcc1726aSKever Yang #include <spl.h> 16*bcc1726aSKever Yang 17*bcc1726aSKever Yang static struct bl2_to_bl31_params_mem bl31_params_mem; 18*bcc1726aSKever Yang static struct bl31_params *bl2_to_bl31_params; 19*bcc1726aSKever Yang 20*bcc1726aSKever Yang /** 21*bcc1726aSKever Yang * bl2_plat_get_bl31_params() - prepare params for bl31. 22*bcc1726aSKever Yang * 23*bcc1726aSKever Yang * This function assigns a pointer to the memory that the platform has kept 24*bcc1726aSKever Yang * aside to pass platform specific and trusted firmware related information 25*bcc1726aSKever Yang * to BL31. This memory is allocated by allocating memory to 26*bcc1726aSKever Yang * bl2_to_bl31_params_mem structure which is a superset of all the 27*bcc1726aSKever Yang * structure whose information is passed to BL31 28*bcc1726aSKever Yang * NOTE: This function should be called only once and should be done 29*bcc1726aSKever Yang * before generating params to BL31 30*bcc1726aSKever Yang * 31*bcc1726aSKever Yang * @return bl31 params structure pointer 32*bcc1726aSKever Yang */ 33*bcc1726aSKever Yang struct bl31_params *bl2_plat_get_bl31_params(void) 34*bcc1726aSKever Yang { 35*bcc1726aSKever Yang struct entry_point_info *bl33_ep_info; 36*bcc1726aSKever Yang 37*bcc1726aSKever Yang /* 38*bcc1726aSKever Yang * Initialise the memory for all the arguments that needs to 39*bcc1726aSKever Yang * be passed to BL31 40*bcc1726aSKever Yang */ 41*bcc1726aSKever Yang memset(&bl31_params_mem, 0, sizeof(struct bl2_to_bl31_params_mem)); 42*bcc1726aSKever Yang 43*bcc1726aSKever Yang /* Assign memory for TF related information */ 44*bcc1726aSKever Yang bl2_to_bl31_params = &bl31_params_mem.bl31_params; 45*bcc1726aSKever Yang SET_PARAM_HEAD(bl2_to_bl31_params, ATF_PARAM_BL31, ATF_VERSION_1, 0); 46*bcc1726aSKever Yang 47*bcc1726aSKever Yang /* Fill BL31 related information */ 48*bcc1726aSKever Yang SET_PARAM_HEAD(bl2_to_bl31_params->bl31_image_info, 49*bcc1726aSKever Yang ATF_PARAM_IMAGE_BINARY, ATF_VERSION_1, 0); 50*bcc1726aSKever Yang 51*bcc1726aSKever Yang /* Fill BL32 related information if it exists */ 52*bcc1726aSKever Yang #ifdef BL32_BASE 53*bcc1726aSKever Yang bl2_to_bl31_params->bl32_ep_info = &bl31_params_mem.bl32_ep_info; 54*bcc1726aSKever Yang SET_PARAM_HEAD(bl2_to_bl31_params->bl32_ep_info, ATF_PARAM_EP, 55*bcc1726aSKever Yang ATF_VERSION_1, 0); 56*bcc1726aSKever Yang bl2_to_bl31_params->bl32_image_info = &bl31_params_mem.bl32_image_info; 57*bcc1726aSKever Yang SET_PARAM_HEAD(bl2_to_bl31_params->bl32_image_info, 58*bcc1726aSKever Yang ATF_PARAM_IMAGE_BINARY, ATF_VERSION_1, 0); 59*bcc1726aSKever Yang #endif /* BL32_BASE */ 60*bcc1726aSKever Yang 61*bcc1726aSKever Yang /* Fill BL33 related information */ 62*bcc1726aSKever Yang bl2_to_bl31_params->bl33_ep_info = &bl31_params_mem.bl33_ep_info; 63*bcc1726aSKever Yang bl33_ep_info = &bl31_params_mem.bl33_ep_info; 64*bcc1726aSKever Yang SET_PARAM_HEAD(bl33_ep_info, ATF_PARAM_EP, ATF_VERSION_1, 65*bcc1726aSKever Yang ATF_EP_NON_SECURE); 66*bcc1726aSKever Yang 67*bcc1726aSKever Yang /* BL33 expects to receive the primary CPU MPID (through x0) */ 68*bcc1726aSKever Yang bl33_ep_info->args.arg0 = 0xffff & read_mpidr(); 69*bcc1726aSKever Yang bl33_ep_info->pc = CONFIG_SYS_TEXT_BASE; 70*bcc1726aSKever Yang bl33_ep_info->spsr = SPSR_64(MODE_EL2, MODE_SP_ELX, 71*bcc1726aSKever Yang DISABLE_ALL_EXECPTIONS); 72*bcc1726aSKever Yang 73*bcc1726aSKever Yang bl2_to_bl31_params->bl33_image_info = &bl31_params_mem.bl33_image_info; 74*bcc1726aSKever Yang SET_PARAM_HEAD(bl2_to_bl31_params->bl33_image_info, 75*bcc1726aSKever Yang ATF_PARAM_IMAGE_BINARY, ATF_VERSION_1, 0); 76*bcc1726aSKever Yang 77*bcc1726aSKever Yang return bl2_to_bl31_params; 78*bcc1726aSKever Yang } 79*bcc1726aSKever Yang 80*bcc1726aSKever Yang void raw_write_daif(unsigned int daif) 81*bcc1726aSKever Yang { 82*bcc1726aSKever Yang __asm__ __volatile__("msr DAIF, %0\n\t" : : "r" (daif) : "memory"); 83*bcc1726aSKever Yang } 84*bcc1726aSKever Yang 85*bcc1726aSKever Yang void bl31_entry(void) 86*bcc1726aSKever Yang { 87*bcc1726aSKever Yang struct bl31_params *bl31_params; 88*bcc1726aSKever Yang void (*entry)(struct bl31_params *params, void *plat_params) = NULL; 89*bcc1726aSKever Yang 90*bcc1726aSKever Yang bl31_params = bl2_plat_get_bl31_params(); 91*bcc1726aSKever Yang entry = (void *)CONFIG_SPL_ATF_TEXT_BASE; 92*bcc1726aSKever Yang 93*bcc1726aSKever Yang raw_write_daif(SPSR_EXCEPTION_MASK); 94*bcc1726aSKever Yang dcache_disable(); 95*bcc1726aSKever Yang 96*bcc1726aSKever Yang entry(bl31_params, NULL); 97*bcc1726aSKever Yang } 98