Dan Handley | 9df4804 | 2015-03-19 18:58:55 +0000 | [diff] [blame] | 1 | /* |
Antonio Nino Diaz | 23ede6a | 2018-06-19 09:29:36 +0100 | [diff] [blame] | 2 | * Copyright (c) 2015-2018, ARM Limited and Contributors. All rights reserved. |
Dan Handley | 9df4804 | 2015-03-19 18:58:55 +0000 | [diff] [blame] | 3 | * |
dp-arm | fa3cf0b | 2017-05-03 09:38:09 +0100 | [diff] [blame] | 4 | * SPDX-License-Identifier: BSD-3-Clause |
Dan Handley | 9df4804 | 2015-03-19 18:58:55 +0000 | [diff] [blame] | 5 | */ |
| 6 | |
Daniel Boulby | 45a2c9e | 2018-07-06 16:54:44 +0100 | [diff] [blame] | 7 | #include <assert.h> |
Antonio Nino Diaz | e0f9063 | 2018-12-14 00:18:21 +0000 | [diff] [blame] | 8 | |
Dan Handley | 9df4804 | 2015-03-19 18:58:55 +0000 | [diff] [blame] | 9 | #include <platform_def.h> |
Antonio Nino Diaz | e0f9063 | 2018-12-14 00:18:21 +0000 | [diff] [blame] | 10 | |
| 11 | #include <bl32/tsp/platform_tsp.h> |
| 12 | #include <common/bl_common.h> |
| 13 | #include <common/debug.h> |
| 14 | #include <drivers/arm/pl011.h> |
| 15 | #include <drivers/console.h> |
| 16 | |
| 17 | #include <arm_def.h> |
| 18 | #include <plat_arm.h> |
Dan Handley | 9df4804 | 2015-03-19 18:58:55 +0000 | [diff] [blame] | 19 | |
Dan Handley | 9df4804 | 2015-03-19 18:58:55 +0000 | [diff] [blame] | 20 | #define BL32_END (unsigned long)(&__BL32_END__) |
| 21 | |
Dan Handley | 9df4804 | 2015-03-19 18:58:55 +0000 | [diff] [blame] | 22 | /* Weak definitions may be overridden in specific ARM standard platform */ |
| 23 | #pragma weak tsp_early_platform_setup |
| 24 | #pragma weak tsp_platform_setup |
| 25 | #pragma weak tsp_plat_arch_setup |
| 26 | |
Daniel Boulby | 45a2c9e | 2018-07-06 16:54:44 +0100 | [diff] [blame] | 27 | #define MAP_BL_TSP_TOTAL MAP_REGION_FLAT( \ |
| 28 | BL32_BASE, \ |
| 29 | BL32_END - BL32_BASE, \ |
| 30 | MT_MEMORY | MT_RW | MT_SECURE) |
Dan Handley | 9df4804 | 2015-03-19 18:58:55 +0000 | [diff] [blame] | 31 | |
| 32 | /******************************************************************************* |
| 33 | * Initialize the UART |
| 34 | ******************************************************************************/ |
Antonio Nino Diaz | 23ede6a | 2018-06-19 09:29:36 +0100 | [diff] [blame] | 35 | #if MULTI_CONSOLE_API |
| 36 | static console_pl011_t arm_tsp_runtime_console; |
| 37 | #endif |
| 38 | |
Dan Handley | 9df4804 | 2015-03-19 18:58:55 +0000 | [diff] [blame] | 39 | void arm_tsp_early_platform_setup(void) |
| 40 | { |
Antonio Nino Diaz | 23ede6a | 2018-06-19 09:29:36 +0100 | [diff] [blame] | 41 | #if MULTI_CONSOLE_API |
Dan Handley | 9df4804 | 2015-03-19 18:58:55 +0000 | [diff] [blame] | 42 | /* |
| 43 | * Initialize a different console than already in use to display |
| 44 | * messages from TSP |
| 45 | */ |
Antonio Nino Diaz | 23ede6a | 2018-06-19 09:29:36 +0100 | [diff] [blame] | 46 | int rc = console_pl011_register(PLAT_ARM_TSP_UART_BASE, |
| 47 | PLAT_ARM_TSP_UART_CLK_IN_HZ, |
| 48 | ARM_CONSOLE_BAUDRATE, |
| 49 | &arm_tsp_runtime_console); |
| 50 | if (rc == 0) |
| 51 | panic(); |
| 52 | |
| 53 | console_set_scope(&arm_tsp_runtime_console.console, |
| 54 | CONSOLE_FLAG_BOOT | CONSOLE_FLAG_RUNTIME); |
| 55 | #else |
Dan Handley | 9df4804 | 2015-03-19 18:58:55 +0000 | [diff] [blame] | 56 | console_init(PLAT_ARM_TSP_UART_BASE, PLAT_ARM_TSP_UART_CLK_IN_HZ, |
| 57 | ARM_CONSOLE_BAUDRATE); |
Antonio Nino Diaz | 23ede6a | 2018-06-19 09:29:36 +0100 | [diff] [blame] | 58 | #endif /* MULTI_CONSOLE_API */ |
Dan Handley | 9df4804 | 2015-03-19 18:58:55 +0000 | [diff] [blame] | 59 | } |
| 60 | |
| 61 | void tsp_early_platform_setup(void) |
| 62 | { |
| 63 | arm_tsp_early_platform_setup(); |
| 64 | } |
| 65 | |
| 66 | /******************************************************************************* |
| 67 | * Perform platform specific setup placeholder |
| 68 | ******************************************************************************/ |
| 69 | void tsp_platform_setup(void) |
| 70 | { |
Achin Gupta | 1fa7eb6 | 2015-11-03 14:18:34 +0000 | [diff] [blame] | 71 | plat_arm_gic_driver_init(); |
Dan Handley | 9df4804 | 2015-03-19 18:58:55 +0000 | [diff] [blame] | 72 | } |
| 73 | |
| 74 | /******************************************************************************* |
| 75 | * Perform the very early platform specific architectural setup here. At the |
| 76 | * moment this is only intializes the MMU |
| 77 | ******************************************************************************/ |
| 78 | void tsp_plat_arch_setup(void) |
| 79 | { |
Dan Handley | 9df4804 | 2015-03-19 18:58:55 +0000 | [diff] [blame] | 80 | #if USE_COHERENT_MEM |
Daniel Boulby | 45a2c9e | 2018-07-06 16:54:44 +0100 | [diff] [blame] | 81 | /* Ensure ARM platforms dont use coherent memory in TSP */ |
| 82 | assert((BL_COHERENT_RAM_END - BL_COHERENT_RAM_BASE) == 0U); |
Dan Handley | 9df4804 | 2015-03-19 18:58:55 +0000 | [diff] [blame] | 83 | #endif |
Daniel Boulby | 45a2c9e | 2018-07-06 16:54:44 +0100 | [diff] [blame] | 84 | |
| 85 | const mmap_region_t bl_regions[] = { |
| 86 | MAP_BL_TSP_TOTAL, |
Daniel Boulby | 4e97abd | 2018-07-16 14:09:15 +0100 | [diff] [blame] | 87 | ARM_MAP_BL_RO, |
Daniel Boulby | 45a2c9e | 2018-07-06 16:54:44 +0100 | [diff] [blame] | 88 | {0} |
| 89 | }; |
| 90 | |
Roberto Vargas | 344ff02 | 2018-10-19 16:44:18 +0100 | [diff] [blame] | 91 | setup_page_tables(bl_regions, plat_arm_get_mmap()); |
Sandrine Bailleux | 4a1267a | 2016-05-18 16:11:47 +0100 | [diff] [blame] | 92 | enable_mmu_el1(0); |
Dan Handley | 9df4804 | 2015-03-19 18:58:55 +0000 | [diff] [blame] | 93 | } |