1d8e919c7SMasahiro Yamada /* 2c64873abSMasahiro Yamada * Copyright (c) 2017-2020, ARM Limited and Contributors. All rights reserved. 3d8e919c7SMasahiro Yamada * 4d8e919c7SMasahiro Yamada * SPDX-License-Identifier: BSD-3-Clause 5d8e919c7SMasahiro Yamada */ 6d8e919c7SMasahiro Yamada 7d8e919c7SMasahiro Yamada #include <assert.h> 8d8e919c7SMasahiro Yamada #include <errno.h> 909d40e0eSAntonio Nino Diaz 10d8e919c7SMasahiro Yamada #include <platform_def.h> 1109d40e0eSAntonio Nino Diaz 1209d40e0eSAntonio Nino Diaz #include <arch.h> 1309d40e0eSAntonio Nino Diaz #include <common/bl_common.h> 1409d40e0eSAntonio Nino Diaz #include <common/debug.h> 1509d40e0eSAntonio Nino Diaz #include <drivers/console.h> 1609d40e0eSAntonio Nino Diaz #include <lib/mmio.h> 1709d40e0eSAntonio Nino Diaz #include <lib/xlat_tables/xlat_mmu_helpers.h> 1809d40e0eSAntonio Nino Diaz #include <plat/common/platform.h> 19d8e919c7SMasahiro Yamada 20d8e919c7SMasahiro Yamada #include "uniphier.h" 21d8e919c7SMasahiro Yamada 22d8e919c7SMasahiro Yamada static entry_point_info_t bl32_image_ep_info; 23d8e919c7SMasahiro Yamada static entry_point_info_t bl33_image_ep_info; 244511322fSMasahiro Yamada static unsigned int uniphier_soc = UNIPHIER_SOC_UNKNOWN; 25d8e919c7SMasahiro Yamada 26d8e919c7SMasahiro Yamada entry_point_info_t *bl31_plat_get_next_image_ep_info(uint32_t type) 27d8e919c7SMasahiro Yamada { 28d8e919c7SMasahiro Yamada assert(sec_state_is_valid(type)); 29d8e919c7SMasahiro Yamada return type == NON_SECURE ? &bl33_image_ep_info : &bl32_image_ep_info; 30d8e919c7SMasahiro Yamada } 31d8e919c7SMasahiro Yamada 32991f1f4dSAntonio Nino Diaz void bl31_early_platform_setup2(u_register_t arg0, u_register_t arg1, 33991f1f4dSAntonio Nino Diaz u_register_t arg2, u_register_t arg3) 34d8e919c7SMasahiro Yamada { 35991f1f4dSAntonio Nino Diaz void *from_bl2; 36991f1f4dSAntonio Nino Diaz 37991f1f4dSAntonio Nino Diaz from_bl2 = (void *)arg0; 38991f1f4dSAntonio Nino Diaz 39d8e919c7SMasahiro Yamada bl_params_node_t *bl_params = ((bl_params_t *)from_bl2)->head; 40d8e919c7SMasahiro Yamada 414511322fSMasahiro Yamada uniphier_soc = uniphier_get_soc_id(); 424511322fSMasahiro Yamada if (uniphier_soc == UNIPHIER_SOC_UNKNOWN) 434511322fSMasahiro Yamada plat_error_handler(-ENOTSUP); 444511322fSMasahiro Yamada 454511322fSMasahiro Yamada uniphier_console_setup(uniphier_soc); 46d8e919c7SMasahiro Yamada 47d8e919c7SMasahiro Yamada while (bl_params) { 48d8e919c7SMasahiro Yamada if (bl_params->image_id == BL32_IMAGE_ID) 49d8e919c7SMasahiro Yamada bl32_image_ep_info = *bl_params->ep_info; 50d8e919c7SMasahiro Yamada 51d8e919c7SMasahiro Yamada if (bl_params->image_id == BL33_IMAGE_ID) 52d8e919c7SMasahiro Yamada bl33_image_ep_info = *bl_params->ep_info; 53d8e919c7SMasahiro Yamada 54d8e919c7SMasahiro Yamada bl_params = bl_params->next_params_info; 55d8e919c7SMasahiro Yamada } 56d8e919c7SMasahiro Yamada 57d8e919c7SMasahiro Yamada if (bl33_image_ep_info.pc == 0) 58d8e919c7SMasahiro Yamada panic(); 59d8e919c7SMasahiro Yamada } 60d8e919c7SMasahiro Yamada 61*8d538f3dSMasahiro Yamada static const uintptr_t uniphier_cntctl_base[] = { 62*8d538f3dSMasahiro Yamada [UNIPHIER_SOC_LD11] = 0x60e00000, 63*8d538f3dSMasahiro Yamada [UNIPHIER_SOC_LD20] = 0x60e00000, 64*8d538f3dSMasahiro Yamada [UNIPHIER_SOC_PXS3] = 0x60e00000, 65*8d538f3dSMasahiro Yamada }; 66d8e919c7SMasahiro Yamada 67d8e919c7SMasahiro Yamada void bl31_platform_setup(void) 68d8e919c7SMasahiro Yamada { 69*8d538f3dSMasahiro Yamada uintptr_t cntctl_base; 70*8d538f3dSMasahiro Yamada 714511322fSMasahiro Yamada uniphier_cci_init(uniphier_soc); 72d8e919c7SMasahiro Yamada uniphier_cci_enable(); 73d8e919c7SMasahiro Yamada 74d8e919c7SMasahiro Yamada /* Initialize the GIC driver, cpu and distributor interfaces */ 754511322fSMasahiro Yamada uniphier_gic_driver_init(uniphier_soc); 76d8e919c7SMasahiro Yamada uniphier_gic_init(); 77d8e919c7SMasahiro Yamada 78*8d538f3dSMasahiro Yamada assert(uniphier_soc < ARRAY_SIZE(uniphier_cntctl_base)); 79*8d538f3dSMasahiro Yamada cntctl_base = uniphier_cntctl_base[uniphier_soc]; 80*8d538f3dSMasahiro Yamada 81d8e919c7SMasahiro Yamada /* Enable and initialize the System level generic timer */ 82*8d538f3dSMasahiro Yamada mmio_write_32(cntctl_base + CNTCR_OFF, CNTCR_FCREQ(0U) | CNTCR_EN); 83d8e919c7SMasahiro Yamada } 84d8e919c7SMasahiro Yamada 85d8e919c7SMasahiro Yamada void bl31_plat_arch_setup(void) 86d8e919c7SMasahiro Yamada { 87c64873abSMasahiro Yamada uniphier_mmap_setup(); 88d8e919c7SMasahiro Yamada enable_mmu_el3(0); 89d8e919c7SMasahiro Yamada } 90