xref: /rk3399_ARM-atf/plat/arm/common/tsp/arm_tsp_setup.c (revision 88a0523e914cb28fded2ce398a184e0c0e8843c8)
1b4315306SDan Handley /*
2*88a0523eSAntonio Nino Diaz  * Copyright (c) 2015-2018, ARM Limited and Contributors. All rights reserved.
3b4315306SDan Handley  *
482cb2c1aSdp-arm  * SPDX-License-Identifier: BSD-3-Clause
5b4315306SDan Handley  */
6b4315306SDan Handley 
7b4315306SDan Handley #include <arm_def.h>
8b4315306SDan Handley #include <bl_common.h>
9b4315306SDan Handley #include <console.h>
10*88a0523eSAntonio Nino Diaz #include <debug.h>
11*88a0523eSAntonio Nino Diaz #include <pl011.h>
124adb10c1SIsla Mitchell #include <plat_arm.h>
13b4315306SDan Handley #include <platform_def.h>
14b4315306SDan Handley #include <platform_tsp.h>
15b4315306SDan Handley 
16b4315306SDan Handley #define BL32_END (unsigned long)(&__BL32_END__)
17b4315306SDan Handley 
18b4315306SDan Handley /* Weak definitions may be overridden in specific ARM standard platform */
19b4315306SDan Handley #pragma weak tsp_early_platform_setup
20b4315306SDan Handley #pragma weak tsp_platform_setup
21b4315306SDan Handley #pragma weak tsp_plat_arch_setup
22b4315306SDan Handley 
23b4315306SDan Handley 
24b4315306SDan Handley /*******************************************************************************
25b4315306SDan Handley  * Initialize the UART
26b4315306SDan Handley  ******************************************************************************/
27*88a0523eSAntonio Nino Diaz #if MULTI_CONSOLE_API
28*88a0523eSAntonio Nino Diaz static console_pl011_t arm_tsp_runtime_console;
29*88a0523eSAntonio Nino Diaz #endif
30*88a0523eSAntonio Nino Diaz 
31b4315306SDan Handley void arm_tsp_early_platform_setup(void)
32b4315306SDan Handley {
33*88a0523eSAntonio Nino Diaz #if MULTI_CONSOLE_API
34b4315306SDan Handley 	/*
35b4315306SDan Handley 	 * Initialize a different console than already in use to display
36b4315306SDan Handley 	 * messages from TSP
37b4315306SDan Handley 	 */
38*88a0523eSAntonio Nino Diaz 	int rc = console_pl011_register(PLAT_ARM_TSP_UART_BASE,
39*88a0523eSAntonio Nino Diaz 					PLAT_ARM_TSP_UART_CLK_IN_HZ,
40*88a0523eSAntonio Nino Diaz 					ARM_CONSOLE_BAUDRATE,
41*88a0523eSAntonio Nino Diaz 					&arm_tsp_runtime_console);
42*88a0523eSAntonio Nino Diaz 	if (rc == 0)
43*88a0523eSAntonio Nino Diaz 		panic();
44*88a0523eSAntonio Nino Diaz 
45*88a0523eSAntonio Nino Diaz 	console_set_scope(&arm_tsp_runtime_console.console,
46*88a0523eSAntonio Nino Diaz 			  CONSOLE_FLAG_BOOT | CONSOLE_FLAG_RUNTIME);
47*88a0523eSAntonio Nino Diaz #else
48b4315306SDan Handley 	console_init(PLAT_ARM_TSP_UART_BASE, PLAT_ARM_TSP_UART_CLK_IN_HZ,
49b4315306SDan Handley 			ARM_CONSOLE_BAUDRATE);
50*88a0523eSAntonio Nino Diaz #endif /* MULTI_CONSOLE_API */
51b4315306SDan Handley }
52b4315306SDan Handley 
53b4315306SDan Handley void tsp_early_platform_setup(void)
54b4315306SDan Handley {
55b4315306SDan Handley 	arm_tsp_early_platform_setup();
56b4315306SDan Handley }
57b4315306SDan Handley 
58b4315306SDan Handley /*******************************************************************************
59b4315306SDan Handley  * Perform platform specific setup placeholder
60b4315306SDan Handley  ******************************************************************************/
61b4315306SDan Handley void tsp_platform_setup(void)
62b4315306SDan Handley {
6327573c59SAchin Gupta 	plat_arm_gic_driver_init();
64b4315306SDan Handley }
65b4315306SDan Handley 
66b4315306SDan Handley /*******************************************************************************
67b4315306SDan Handley  * Perform the very early platform specific architectural setup here. At the
68b4315306SDan Handley  * moment this is only intializes the MMU
69b4315306SDan Handley  ******************************************************************************/
70b4315306SDan Handley void tsp_plat_arch_setup(void)
71b4315306SDan Handley {
720af559a8SSandrine Bailleux 	arm_setup_page_tables(BL32_BASE,
730af559a8SSandrine Bailleux 			      (BL32_END - BL32_BASE),
740af559a8SSandrine Bailleux 			      BL_CODE_BASE,
75ecdc898dSMasahiro Yamada 			      BL_CODE_END,
760af559a8SSandrine Bailleux 			      BL_RO_DATA_BASE,
77ecdc898dSMasahiro Yamada 			      BL_RO_DATA_END
78b4315306SDan Handley #if USE_COHERENT_MEM
7947497053SMasahiro Yamada 			      , BL_COHERENT_RAM_BASE,
8047497053SMasahiro Yamada 			      BL_COHERENT_RAM_END
81b4315306SDan Handley #endif
82b4315306SDan Handley 			      );
83b5fa6563SSandrine Bailleux 	enable_mmu_el1(0);
84b4315306SDan Handley }
85