1*91f16700Schasinglulu /* 2*91f16700Schasinglulu * Copyright (c) 2017-2020, ARM Limited and Contributors. All rights reserved. 3*91f16700Schasinglulu * 4*91f16700Schasinglulu * SPDX-License-Identifier: BSD-3-Clause 5*91f16700Schasinglulu */ 6*91f16700Schasinglulu 7*91f16700Schasinglulu #include <assert.h> 8*91f16700Schasinglulu #include <errno.h> 9*91f16700Schasinglulu 10*91f16700Schasinglulu #include <platform_def.h> 11*91f16700Schasinglulu 12*91f16700Schasinglulu #include <arch.h> 13*91f16700Schasinglulu #include <common/bl_common.h> 14*91f16700Schasinglulu #include <common/debug.h> 15*91f16700Schasinglulu #include <drivers/console.h> 16*91f16700Schasinglulu #include <lib/mmio.h> 17*91f16700Schasinglulu #include <plat/common/platform.h> 18*91f16700Schasinglulu 19*91f16700Schasinglulu #include "uniphier.h" 20*91f16700Schasinglulu 21*91f16700Schasinglulu static entry_point_info_t bl32_image_ep_info; 22*91f16700Schasinglulu static entry_point_info_t bl33_image_ep_info; 23*91f16700Schasinglulu static unsigned int uniphier_soc = UNIPHIER_SOC_UNKNOWN; 24*91f16700Schasinglulu 25*91f16700Schasinglulu entry_point_info_t *bl31_plat_get_next_image_ep_info(uint32_t type) 26*91f16700Schasinglulu { 27*91f16700Schasinglulu assert(sec_state_is_valid(type)); 28*91f16700Schasinglulu return type == NON_SECURE ? &bl33_image_ep_info : &bl32_image_ep_info; 29*91f16700Schasinglulu } 30*91f16700Schasinglulu 31*91f16700Schasinglulu void bl31_early_platform_setup2(u_register_t arg0, u_register_t arg1, 32*91f16700Schasinglulu u_register_t arg2, u_register_t arg3) 33*91f16700Schasinglulu { 34*91f16700Schasinglulu void *from_bl2; 35*91f16700Schasinglulu 36*91f16700Schasinglulu from_bl2 = (void *)arg0; 37*91f16700Schasinglulu 38*91f16700Schasinglulu bl_params_node_t *bl_params = ((bl_params_t *)from_bl2)->head; 39*91f16700Schasinglulu 40*91f16700Schasinglulu uniphier_soc = uniphier_get_soc_id(); 41*91f16700Schasinglulu if (uniphier_soc == UNIPHIER_SOC_UNKNOWN) 42*91f16700Schasinglulu plat_error_handler(-ENOTSUP); 43*91f16700Schasinglulu 44*91f16700Schasinglulu uniphier_console_setup(uniphier_soc); 45*91f16700Schasinglulu 46*91f16700Schasinglulu while (bl_params) { 47*91f16700Schasinglulu if (bl_params->image_id == BL32_IMAGE_ID) 48*91f16700Schasinglulu bl32_image_ep_info = *bl_params->ep_info; 49*91f16700Schasinglulu 50*91f16700Schasinglulu if (bl_params->image_id == BL33_IMAGE_ID) 51*91f16700Schasinglulu bl33_image_ep_info = *bl_params->ep_info; 52*91f16700Schasinglulu 53*91f16700Schasinglulu bl_params = bl_params->next_params_info; 54*91f16700Schasinglulu } 55*91f16700Schasinglulu 56*91f16700Schasinglulu if (bl33_image_ep_info.pc == 0) 57*91f16700Schasinglulu panic(); 58*91f16700Schasinglulu } 59*91f16700Schasinglulu 60*91f16700Schasinglulu static const uintptr_t uniphier_cntctl_base[] = { 61*91f16700Schasinglulu [UNIPHIER_SOC_LD11] = 0x60e00000, 62*91f16700Schasinglulu [UNIPHIER_SOC_LD20] = 0x60e00000, 63*91f16700Schasinglulu [UNIPHIER_SOC_PXS3] = 0x60e00000, 64*91f16700Schasinglulu }; 65*91f16700Schasinglulu 66*91f16700Schasinglulu void bl31_platform_setup(void) 67*91f16700Schasinglulu { 68*91f16700Schasinglulu uintptr_t cntctl_base; 69*91f16700Schasinglulu 70*91f16700Schasinglulu uniphier_cci_init(uniphier_soc); 71*91f16700Schasinglulu uniphier_cci_enable(); 72*91f16700Schasinglulu 73*91f16700Schasinglulu /* Initialize the GIC driver, cpu and distributor interfaces */ 74*91f16700Schasinglulu uniphier_gic_driver_init(uniphier_soc); 75*91f16700Schasinglulu uniphier_gic_init(); 76*91f16700Schasinglulu 77*91f16700Schasinglulu assert(uniphier_soc < ARRAY_SIZE(uniphier_cntctl_base)); 78*91f16700Schasinglulu cntctl_base = uniphier_cntctl_base[uniphier_soc]; 79*91f16700Schasinglulu 80*91f16700Schasinglulu /* Enable and initialize the System level generic timer */ 81*91f16700Schasinglulu mmio_write_32(cntctl_base + CNTCR_OFF, CNTCR_FCREQ(0U) | CNTCR_EN); 82*91f16700Schasinglulu 83*91f16700Schasinglulu uniphier_psci_init(uniphier_soc); 84*91f16700Schasinglulu } 85*91f16700Schasinglulu 86*91f16700Schasinglulu void bl31_plat_arch_setup(void) 87*91f16700Schasinglulu { 88*91f16700Schasinglulu uniphier_mmap_setup(uniphier_soc); 89*91f16700Schasinglulu } 90