Varun Wadekar | 921b906 | 2015-08-25 17:03:14 +0530 | [diff] [blame] | 1 | /* |
Varun Wadekar | 84a775e | 2019-01-03 10:12:55 -0800 | [diff] [blame] | 2 | * Copyright (c) 2015-2019, ARM Limited and Contributors. All rights reserved. |
Varun Wadekar | 7cf57d7 | 2018-05-17 09:36:38 -0700 | [diff] [blame] | 3 | * Copyright (c) 2020, NVIDIA Corporation. All rights reserved. |
Varun Wadekar | 921b906 | 2015-08-25 17:03:14 +0530 | [diff] [blame] | 4 | * |
dp-arm | fa3cf0b | 2017-05-03 09:38:09 +0100 | [diff] [blame] | 5 | * SPDX-License-Identifier: BSD-3-Clause |
Varun Wadekar | 921b906 | 2015-08-25 17:03:14 +0530 | [diff] [blame] | 6 | */ |
| 7 | |
Varun Wadekar | cad7b08 | 2015-12-28 18:12:59 -0800 | [diff] [blame] | 8 | #include <assert.h> |
Antonio Nino Diaz | e0f9063 | 2018-12-14 00:18:21 +0000 | [diff] [blame] | 9 | |
| 10 | #include <arch_helpers.h> |
| 11 | #include <bl31/bl31.h> |
| 12 | #include <bl31/interrupt_mgmt.h> |
| 13 | #include <common/bl_common.h> |
| 14 | #include <common/debug.h> |
Varun Wadekar | 0ed6270 | 2018-06-20 14:30:59 -0700 | [diff] [blame] | 15 | #include <common/ep_info.h> |
Antonio Nino Diaz | e0f9063 | 2018-12-14 00:18:21 +0000 | [diff] [blame] | 16 | #include <common/interrupt_props.h> |
Varun Wadekar | cad7b08 | 2015-12-28 18:12:59 -0800 | [diff] [blame] | 17 | #include <context.h> |
Varun Wadekar | 4debe05 | 2016-05-18 13:39:16 -0700 | [diff] [blame] | 18 | #include <cortex_a57.h> |
Varun Wadekar | cad7b08 | 2015-12-28 18:12:59 -0800 | [diff] [blame] | 19 | #include <denver.h> |
Antonio Nino Diaz | e0f9063 | 2018-12-14 00:18:21 +0000 | [diff] [blame] | 20 | #include <drivers/arm/gic_common.h> |
| 21 | #include <drivers/arm/gicv2.h> |
| 22 | #include <drivers/console.h> |
| 23 | #include <lib/el3_runtime/context_mgmt.h> |
Varun Wadekar | 0ed6270 | 2018-06-20 14:30:59 -0700 | [diff] [blame] | 24 | #include <lib/utils.h> |
Antonio Nino Diaz | e0f9063 | 2018-12-14 00:18:21 +0000 | [diff] [blame] | 25 | #include <lib/xlat_tables/xlat_tables_v2.h> |
| 26 | #include <plat/common/platform.h> |
| 27 | |
Varun Wadekar | 47ddd00 | 2016-03-28 16:00:02 -0700 | [diff] [blame] | 28 | #include <mce.h> |
Varun Wadekar | 921b906 | 2015-08-25 17:03:14 +0530 | [diff] [blame] | 29 | #include <tegra_def.h> |
Varun Wadekar | 5887c10 | 2016-07-19 11:29:40 -0700 | [diff] [blame] | 30 | #include <tegra_platform.h> |
Varun Wadekar | cad7b08 | 2015-12-28 18:12:59 -0800 | [diff] [blame] | 31 | #include <tegra_private.h> |
Varun Wadekar | 921b906 | 2015-08-25 17:03:14 +0530 | [diff] [blame] | 32 | |
Varun Wadekar | 0ed6270 | 2018-06-20 14:30:59 -0700 | [diff] [blame] | 33 | extern void memcpy16(void *dest, const void *src, unsigned int length); |
| 34 | |
Varun Wadekar | c2c3a2a | 2016-01-08 17:38:51 -0800 | [diff] [blame] | 35 | /******************************************************************************* |
Varun Wadekar | 43dad67 | 2017-01-31 14:53:37 -0800 | [diff] [blame] | 36 | * Tegra186 CPU numbers in cluster #0 |
| 37 | ******************************************************************************* |
| 38 | */ |
Anthony Zhou | 25d127f | 2017-03-21 15:58:50 +0800 | [diff] [blame] | 39 | #define TEGRA186_CLUSTER0_CORE2 2U |
| 40 | #define TEGRA186_CLUSTER0_CORE3 3U |
Varun Wadekar | 43dad67 | 2017-01-31 14:53:37 -0800 | [diff] [blame] | 41 | |
| 42 | /******************************************************************************* |
Varun Wadekar | c2c3a2a | 2016-01-08 17:38:51 -0800 | [diff] [blame] | 43 | * The Tegra power domain tree has a single system level power domain i.e. a |
| 44 | * single root node. The first entry in the power domain descriptor specifies |
| 45 | * the number of power domains at the highest power level. |
| 46 | ******************************************************************************* |
| 47 | */ |
Anthony Zhou | 0895a8f | 2017-09-22 16:52:02 +0800 | [diff] [blame] | 48 | static const uint8_t tegra_power_domain_tree_desc[] = { |
Varun Wadekar | c2c3a2a | 2016-01-08 17:38:51 -0800 | [diff] [blame] | 49 | /* No of root nodes */ |
| 50 | 1, |
| 51 | /* No of clusters */ |
| 52 | PLATFORM_CLUSTER_COUNT, |
| 53 | /* No of CPU cores - cluster0 */ |
| 54 | PLATFORM_MAX_CPUS_PER_CLUSTER, |
| 55 | /* No of CPU cores - cluster1 */ |
| 56 | PLATFORM_MAX_CPUS_PER_CLUSTER |
| 57 | }; |
| 58 | |
Varun Wadekar | e34bc3d | 2017-04-28 08:43:33 -0700 | [diff] [blame] | 59 | /******************************************************************************* |
| 60 | * This function returns the Tegra default topology tree information. |
| 61 | ******************************************************************************/ |
Anthony Zhou | 25d127f | 2017-03-21 15:58:50 +0800 | [diff] [blame] | 62 | const uint8_t *plat_get_power_domain_tree_desc(void) |
Varun Wadekar | e34bc3d | 2017-04-28 08:43:33 -0700 | [diff] [blame] | 63 | { |
| 64 | return tegra_power_domain_tree_desc; |
| 65 | } |
| 66 | |
Varun Wadekar | 921b906 | 2015-08-25 17:03:14 +0530 | [diff] [blame] | 67 | /* |
| 68 | * Table of regions to map using the MMU. |
| 69 | */ |
| 70 | static const mmap_region_t tegra_mmap[] = { |
Anthony Zhou | 25d127f | 2017-03-21 15:58:50 +0800 | [diff] [blame] | 71 | MAP_REGION_FLAT(TEGRA_MISC_BASE, 0x10000U, /* 64KB */ |
Varun Wadekar | 921b906 | 2015-08-25 17:03:14 +0530 | [diff] [blame] | 72 | MT_DEVICE | MT_RW | MT_SECURE), |
Anthony Zhou | 25d127f | 2017-03-21 15:58:50 +0800 | [diff] [blame] | 73 | MAP_REGION_FLAT(TEGRA_TSA_BASE, 0x20000U, /* 128KB */ |
Varun Wadekar | a0f2697 | 2016-03-11 17:18:51 -0800 | [diff] [blame] | 74 | MT_DEVICE | MT_RW | MT_SECURE), |
Anthony Zhou | 25d127f | 2017-03-21 15:58:50 +0800 | [diff] [blame] | 75 | MAP_REGION_FLAT(TEGRA_MC_STREAMID_BASE, 0x10000U, /* 64KB */ |
Varun Wadekar | 921b906 | 2015-08-25 17:03:14 +0530 | [diff] [blame] | 76 | MT_DEVICE | MT_RW | MT_SECURE), |
Anthony Zhou | 25d127f | 2017-03-21 15:58:50 +0800 | [diff] [blame] | 77 | MAP_REGION_FLAT(TEGRA_MC_BASE, 0x10000U, /* 64KB */ |
Varun Wadekar | 921b906 | 2015-08-25 17:03:14 +0530 | [diff] [blame] | 78 | MT_DEVICE | MT_RW | MT_SECURE), |
Anthony Zhou | 25d127f | 2017-03-21 15:58:50 +0800 | [diff] [blame] | 79 | MAP_REGION_FLAT(TEGRA_UARTA_BASE, 0x20000U, /* 128KB - UART A, B*/ |
Varun Wadekar | 9db0ad1 | 2016-07-12 10:04:28 -0700 | [diff] [blame] | 80 | MT_DEVICE | MT_RW | MT_SECURE), |
Anthony Zhou | 25d127f | 2017-03-21 15:58:50 +0800 | [diff] [blame] | 81 | MAP_REGION_FLAT(TEGRA_UARTC_BASE, 0x20000U, /* 128KB - UART C, G */ |
Varun Wadekar | 9db0ad1 | 2016-07-12 10:04:28 -0700 | [diff] [blame] | 82 | MT_DEVICE | MT_RW | MT_SECURE), |
Anthony Zhou | 25d127f | 2017-03-21 15:58:50 +0800 | [diff] [blame] | 83 | MAP_REGION_FLAT(TEGRA_UARTD_BASE, 0x30000U, /* 192KB - UART D, E, F */ |
Varun Wadekar | 921b906 | 2015-08-25 17:03:14 +0530 | [diff] [blame] | 84 | MT_DEVICE | MT_RW | MT_SECURE), |
Anthony Zhou | 25d127f | 2017-03-21 15:58:50 +0800 | [diff] [blame] | 85 | MAP_REGION_FLAT(TEGRA_FUSE_BASE, 0x10000U, /* 64KB */ |
Varun Wadekar | 4debe05 | 2016-05-18 13:39:16 -0700 | [diff] [blame] | 86 | MT_DEVICE | MT_RW | MT_SECURE), |
Anthony Zhou | 25d127f | 2017-03-21 15:58:50 +0800 | [diff] [blame] | 87 | MAP_REGION_FLAT(TEGRA_GICD_BASE, 0x20000U, /* 128KB */ |
Varun Wadekar | 921b906 | 2015-08-25 17:03:14 +0530 | [diff] [blame] | 88 | MT_DEVICE | MT_RW | MT_SECURE), |
Anthony Zhou | 25d127f | 2017-03-21 15:58:50 +0800 | [diff] [blame] | 89 | MAP_REGION_FLAT(TEGRA_SE0_BASE, 0x10000U, /* 64KB */ |
Varun Wadekar | b877615 | 2016-03-03 13:52:52 -0800 | [diff] [blame] | 90 | MT_DEVICE | MT_RW | MT_SECURE), |
Anthony Zhou | 25d127f | 2017-03-21 15:58:50 +0800 | [diff] [blame] | 91 | MAP_REGION_FLAT(TEGRA_PKA1_BASE, 0x10000U, /* 64KB */ |
Varun Wadekar | b877615 | 2016-03-03 13:52:52 -0800 | [diff] [blame] | 92 | MT_DEVICE | MT_RW | MT_SECURE), |
Anthony Zhou | 25d127f | 2017-03-21 15:58:50 +0800 | [diff] [blame] | 93 | MAP_REGION_FLAT(TEGRA_RNG1_BASE, 0x10000U, /* 64KB */ |
Varun Wadekar | b877615 | 2016-03-03 13:52:52 -0800 | [diff] [blame] | 94 | MT_DEVICE | MT_RW | MT_SECURE), |
Anthony Zhou | 25d127f | 2017-03-21 15:58:50 +0800 | [diff] [blame] | 95 | MAP_REGION_FLAT(TEGRA_CAR_RESET_BASE, 0x10000U, /* 64KB */ |
Varun Wadekar | e60f1bf | 2016-02-17 10:10:50 -0800 | [diff] [blame] | 96 | MT_DEVICE | MT_RW | MT_SECURE), |
Anthony Zhou | 25d127f | 2017-03-21 15:58:50 +0800 | [diff] [blame] | 97 | MAP_REGION_FLAT(TEGRA_PMC_BASE, 0x40000U, /* 256KB */ |
Varun Wadekar | 921b906 | 2015-08-25 17:03:14 +0530 | [diff] [blame] | 98 | MT_DEVICE | MT_RW | MT_SECURE), |
Varun Wadekar | 922550a | 2018-01-23 14:38:51 -0800 | [diff] [blame] | 99 | MAP_REGION_FLAT(TEGRA_TMRUS_BASE, 0x1000U, /* 4KB */ |
| 100 | MT_DEVICE | MT_RO | MT_SECURE), |
Anthony Zhou | 25d127f | 2017-03-21 15:58:50 +0800 | [diff] [blame] | 101 | MAP_REGION_FLAT(TEGRA_SCRATCH_BASE, 0x10000U, /* 64KB */ |
Varun Wadekar | b877615 | 2016-03-03 13:52:52 -0800 | [diff] [blame] | 102 | MT_DEVICE | MT_RW | MT_SECURE), |
Anthony Zhou | 25d127f | 2017-03-21 15:58:50 +0800 | [diff] [blame] | 103 | MAP_REGION_FLAT(TEGRA_MMCRAB_BASE, 0x60000U, /* 384KB */ |
Varun Wadekar | 921b906 | 2015-08-25 17:03:14 +0530 | [diff] [blame] | 104 | MT_DEVICE | MT_RW | MT_SECURE), |
Anthony Zhou | 25d127f | 2017-03-21 15:58:50 +0800 | [diff] [blame] | 105 | MAP_REGION_FLAT(TEGRA_ARM_ACTMON_CTR_BASE, 0x20000U, /* 128KB - ARM/Denver */ |
Varun Wadekar | d64db96 | 2016-09-23 14:28:16 -0700 | [diff] [blame] | 106 | MT_DEVICE | MT_RW | MT_SECURE), |
Anthony Zhou | 25d127f | 2017-03-21 15:58:50 +0800 | [diff] [blame] | 107 | MAP_REGION_FLAT(TEGRA_SMMU0_BASE, 0x1000000U, /* 64KB */ |
Varun Wadekar | 921b906 | 2015-08-25 17:03:14 +0530 | [diff] [blame] | 108 | MT_DEVICE | MT_RW | MT_SECURE), |
Jeetesh Burman | 29e03be | 2018-05-31 14:15:30 +0530 | [diff] [blame] | 109 | MAP_REGION_FLAT(TEGRA_HSP_DBELL_BASE, 0x10000U, /* 64KB */ |
| 110 | MT_DEVICE | MT_RW | MT_SECURE), |
| 111 | MAP_REGION_FLAT(TEGRA_BPMP_IPC_TX_PHYS_BASE, TEGRA_BPMP_IPC_CH_MAP_SIZE, /* 4KB */ |
| 112 | MT_DEVICE | MT_RW | MT_SECURE), |
| 113 | MAP_REGION_FLAT(TEGRA_BPMP_IPC_RX_PHYS_BASE, TEGRA_BPMP_IPC_CH_MAP_SIZE, /* 4KB */ |
| 114 | MT_DEVICE | MT_RW | MT_SECURE), |
Varun Wadekar | 921b906 | 2015-08-25 17:03:14 +0530 | [diff] [blame] | 115 | {0} |
| 116 | }; |
| 117 | |
| 118 | /******************************************************************************* |
| 119 | * Set up the pagetables as per the platform memory map & initialize the MMU |
| 120 | ******************************************************************************/ |
| 121 | const mmap_region_t *plat_get_mmio_map(void) |
| 122 | { |
| 123 | /* MMIO space */ |
| 124 | return tegra_mmap; |
| 125 | } |
| 126 | |
| 127 | /******************************************************************************* |
| 128 | * Handler to get the System Counter Frequency |
| 129 | ******************************************************************************/ |
Anthony Zhou | 25d127f | 2017-03-21 15:58:50 +0800 | [diff] [blame] | 130 | uint32_t plat_get_syscnt_freq2(void) |
Varun Wadekar | 921b906 | 2015-08-25 17:03:14 +0530 | [diff] [blame] | 131 | { |
Varun Wadekar | 20c9429 | 2016-01-04 10:57:45 -0800 | [diff] [blame] | 132 | return 31250000; |
Varun Wadekar | 921b906 | 2015-08-25 17:03:14 +0530 | [diff] [blame] | 133 | } |
| 134 | |
| 135 | /******************************************************************************* |
| 136 | * Maximum supported UART controllers |
| 137 | ******************************************************************************/ |
| 138 | #define TEGRA186_MAX_UART_PORTS 7 |
| 139 | |
| 140 | /******************************************************************************* |
| 141 | * This variable holds the UART port base addresses |
| 142 | ******************************************************************************/ |
| 143 | static uint32_t tegra186_uart_addresses[TEGRA186_MAX_UART_PORTS + 1] = { |
| 144 | 0, /* undefined - treated as an error case */ |
| 145 | TEGRA_UARTA_BASE, |
| 146 | TEGRA_UARTB_BASE, |
| 147 | TEGRA_UARTC_BASE, |
| 148 | TEGRA_UARTD_BASE, |
| 149 | TEGRA_UARTE_BASE, |
| 150 | TEGRA_UARTF_BASE, |
| 151 | TEGRA_UARTG_BASE, |
| 152 | }; |
| 153 | |
| 154 | /******************************************************************************* |
Varun Wadekar | 9d15f7e | 2019-08-21 14:01:31 -0700 | [diff] [blame] | 155 | * Enable console corresponding to the console ID |
Varun Wadekar | 921b906 | 2015-08-25 17:03:14 +0530 | [diff] [blame] | 156 | ******************************************************************************/ |
Varun Wadekar | 9d15f7e | 2019-08-21 14:01:31 -0700 | [diff] [blame] | 157 | void plat_enable_console(int32_t id) |
Varun Wadekar | 921b906 | 2015-08-25 17:03:14 +0530 | [diff] [blame] | 158 | { |
Andre Przywara | 98b5a11 | 2020-01-25 00:58:35 +0000 | [diff] [blame] | 159 | static console_t uart_console; |
Varun Wadekar | 9d15f7e | 2019-08-21 14:01:31 -0700 | [diff] [blame] | 160 | uint32_t console_clock; |
Varun Wadekar | 921b906 | 2015-08-25 17:03:14 +0530 | [diff] [blame] | 161 | |
Varun Wadekar | 9d15f7e | 2019-08-21 14:01:31 -0700 | [diff] [blame] | 162 | if ((id > 0) && (id < TEGRA186_MAX_UART_PORTS)) { |
| 163 | /* |
| 164 | * Reference clock used by the FPGAs is a lot slower. |
| 165 | */ |
| 166 | if (tegra_platform_is_fpga()) { |
| 167 | console_clock = TEGRA_BOOT_UART_CLK_13_MHZ; |
| 168 | } else { |
| 169 | console_clock = TEGRA_BOOT_UART_CLK_408_MHZ; |
| 170 | } |
Anthony Zhou | 25d127f | 2017-03-21 15:58:50 +0800 | [diff] [blame] | 171 | |
Varun Wadekar | 9d15f7e | 2019-08-21 14:01:31 -0700 | [diff] [blame] | 172 | (void)console_16550_register(tegra186_uart_addresses[id], |
| 173 | console_clock, |
| 174 | TEGRA_CONSOLE_BAUDRATE, |
| 175 | &uart_console); |
Andre Przywara | 98b5a11 | 2020-01-25 00:58:35 +0000 | [diff] [blame] | 176 | console_set_scope(&uart_console, CONSOLE_FLAG_BOOT | |
Varun Wadekar | 9d15f7e | 2019-08-21 14:01:31 -0700 | [diff] [blame] | 177 | CONSOLE_FLAG_RUNTIME | CONSOLE_FLAG_CRASH); |
| 178 | } |
Varun Wadekar | 921b906 | 2015-08-25 17:03:14 +0530 | [diff] [blame] | 179 | } |
Varun Wadekar | cad7b08 | 2015-12-28 18:12:59 -0800 | [diff] [blame] | 180 | |
Varun Wadekar | 4debe05 | 2016-05-18 13:39:16 -0700 | [diff] [blame] | 181 | /******************************************************************************* |
| 182 | * Handler for early platform setup |
| 183 | ******************************************************************************/ |
| 184 | void plat_early_platform_setup(void) |
| 185 | { |
Harvey Hsieh | fbdfce1 | 2016-11-23 19:13:08 +0800 | [diff] [blame] | 186 | uint64_t impl, val; |
| 187 | const plat_params_from_bl2_t *plat_params = bl31_get_plat_params(); |
Varun Wadekar | 4debe05 | 2016-05-18 13:39:16 -0700 | [diff] [blame] | 188 | |
kalyanic | 0a2cc61 | 2019-09-13 14:49:39 -0700 | [diff] [blame] | 189 | /* Verify chip id is t186 */ |
| 190 | assert(tegra_chipid_is_t186()); |
| 191 | |
Varun Wadekar | 4debe05 | 2016-05-18 13:39:16 -0700 | [diff] [blame] | 192 | /* sanity check MCE firmware compatibility */ |
| 193 | mce_verify_firmware_version(); |
| 194 | |
Harvey Hsieh | fbdfce1 | 2016-11-23 19:13:08 +0800 | [diff] [blame] | 195 | impl = (read_midr() >> MIDR_IMPL_SHIFT) & (uint64_t)MIDR_IMPL_MASK; |
| 196 | |
Varun Wadekar | 4debe05 | 2016-05-18 13:39:16 -0700 | [diff] [blame] | 197 | /* |
Harvey Hsieh | fbdfce1 | 2016-11-23 19:13:08 +0800 | [diff] [blame] | 198 | * Enable ECC and Parity Protection for Cortex-A57 CPUs (Tegra186 |
| 199 | * A02p and beyond). |
Varun Wadekar | 4debe05 | 2016-05-18 13:39:16 -0700 | [diff] [blame] | 200 | */ |
Harvey Hsieh | fbdfce1 | 2016-11-23 19:13:08 +0800 | [diff] [blame] | 201 | if ((plat_params->l2_ecc_parity_prot_dis != 1) && |
| 202 | (impl != (uint64_t)DENVER_IMPL)) { |
Varun Wadekar | 4debe05 | 2016-05-18 13:39:16 -0700 | [diff] [blame] | 203 | |
Harvey Hsieh | fbdfce1 | 2016-11-23 19:13:08 +0800 | [diff] [blame] | 204 | val = read_l2ctlr_el1(); |
Anthony Zhou | 25d127f | 2017-03-21 15:58:50 +0800 | [diff] [blame] | 205 | val |= CORTEX_A57_L2_ECC_PARITY_PROTECTION_BIT; |
Harvey Hsieh | fbdfce1 | 2016-11-23 19:13:08 +0800 | [diff] [blame] | 206 | write_l2ctlr_el1(val); |
Varun Wadekar | 4debe05 | 2016-05-18 13:39:16 -0700 | [diff] [blame] | 207 | } |
| 208 | } |
| 209 | |
Varun Wadekar | 7cf57d7 | 2018-05-17 09:36:38 -0700 | [diff] [blame] | 210 | /******************************************************************************* |
| 211 | * Handler for late platform setup |
| 212 | ******************************************************************************/ |
| 213 | void plat_late_platform_setup(void) |
| 214 | { |
| 215 | ; /* do nothing */ |
| 216 | } |
| 217 | |
Varun Wadekar | cad7b08 | 2015-12-28 18:12:59 -0800 | [diff] [blame] | 218 | /* Secure IRQs for Tegra186 */ |
Varun Wadekar | 9f4a7d3 | 2018-10-19 11:42:28 -0700 | [diff] [blame] | 219 | static const interrupt_prop_t tegra186_interrupt_props[] = { |
Varun Wadekar | bef02f0 | 2020-04-17 19:09:21 -0700 | [diff] [blame] | 220 | INTR_PROP_DESC(TEGRA_SDEI_SGI_PRIVATE, PLAT_SDEI_CRITICAL_PRI, |
| 221 | GICV2_INTR_GROUP0, GIC_INTR_CFG_EDGE), |
Varun Wadekar | 10c32cb | 2020-03-31 18:42:59 -0700 | [diff] [blame] | 222 | INTR_PROP_DESC(TEGRA186_TOP_WDT_IRQ, PLAT_TEGRA_WDT_PRIO, |
Varun Wadekar | 9f4a7d3 | 2018-10-19 11:42:28 -0700 | [diff] [blame] | 223 | GICV2_INTR_GROUP0, GIC_INTR_CFG_EDGE), |
Varun Wadekar | 10c32cb | 2020-03-31 18:42:59 -0700 | [diff] [blame] | 224 | INTR_PROP_DESC(TEGRA186_AON_WDT_IRQ, PLAT_TEGRA_WDT_PRIO, |
Varun Wadekar | 9f4a7d3 | 2018-10-19 11:42:28 -0700 | [diff] [blame] | 225 | GICV2_INTR_GROUP0, GIC_INTR_CFG_EDGE) |
Varun Wadekar | cad7b08 | 2015-12-28 18:12:59 -0800 | [diff] [blame] | 226 | }; |
| 227 | |
| 228 | /******************************************************************************* |
| 229 | * Initialize the GIC and SGIs |
| 230 | ******************************************************************************/ |
| 231 | void plat_gic_setup(void) |
| 232 | { |
Varun Wadekar | 9f4a7d3 | 2018-10-19 11:42:28 -0700 | [diff] [blame] | 233 | tegra_gic_setup(tegra186_interrupt_props, ARRAY_SIZE(tegra186_interrupt_props)); |
Varun Wadekar | 84a775e | 2019-01-03 10:12:55 -0800 | [diff] [blame] | 234 | tegra_gic_init(); |
Varun Wadekar | cad7b08 | 2015-12-28 18:12:59 -0800 | [diff] [blame] | 235 | |
| 236 | /* |
| 237 | * Initialize the FIQ handler only if the platform supports any |
| 238 | * FIQ interrupt sources. |
| 239 | */ |
Varun Wadekar | 84a775e | 2019-01-03 10:12:55 -0800 | [diff] [blame] | 240 | tegra_fiq_handler_setup(); |
Varun Wadekar | cad7b08 | 2015-12-28 18:12:59 -0800 | [diff] [blame] | 241 | } |
Varun Wadekar | 94701ff | 2016-05-23 11:47:34 -0700 | [diff] [blame] | 242 | |
| 243 | /******************************************************************************* |
| 244 | * Return pointer to the BL31 params from previous bootloader |
| 245 | ******************************************************************************/ |
Antonio Nino Diaz | 6bf7c6b | 2018-09-24 17:16:05 +0100 | [diff] [blame] | 246 | struct tegra_bl31_params *plat_get_bl31_params(void) |
Varun Wadekar | 94701ff | 2016-05-23 11:47:34 -0700 | [diff] [blame] | 247 | { |
| 248 | uint32_t val; |
| 249 | |
Steven Kao | 186485e | 2017-10-23 18:22:09 +0800 | [diff] [blame] | 250 | val = mmio_read_32(TEGRA_SCRATCH_BASE + SCRATCH_BL31_PARAMS_ADDR); |
Varun Wadekar | 94701ff | 2016-05-23 11:47:34 -0700 | [diff] [blame] | 251 | |
Antonio Nino Diaz | 6bf7c6b | 2018-09-24 17:16:05 +0100 | [diff] [blame] | 252 | return (struct tegra_bl31_params *)(uintptr_t)val; |
Varun Wadekar | 94701ff | 2016-05-23 11:47:34 -0700 | [diff] [blame] | 253 | } |
| 254 | |
| 255 | /******************************************************************************* |
| 256 | * Return pointer to the BL31 platform params from previous bootloader |
| 257 | ******************************************************************************/ |
| 258 | plat_params_from_bl2_t *plat_get_bl31_plat_params(void) |
| 259 | { |
| 260 | uint32_t val; |
| 261 | |
Steven Kao | 186485e | 2017-10-23 18:22:09 +0800 | [diff] [blame] | 262 | val = mmio_read_32(TEGRA_SCRATCH_BASE + SCRATCH_BL31_PLAT_PARAMS_ADDR); |
Varun Wadekar | 94701ff | 2016-05-23 11:47:34 -0700 | [diff] [blame] | 263 | |
| 264 | return (plat_params_from_bl2_t *)(uintptr_t)val; |
| 265 | } |
Varun Wadekar | 43dad67 | 2017-01-31 14:53:37 -0800 | [diff] [blame] | 266 | |
| 267 | /******************************************************************************* |
| 268 | * This function implements a part of the critical interface between the psci |
| 269 | * generic layer and the platform that allows the former to query the platform |
| 270 | * to convert an MPIDR to a unique linear index. An error code (-1) is returned |
| 271 | * in case the MPIDR is invalid. |
| 272 | ******************************************************************************/ |
Anthony Zhou | 25d127f | 2017-03-21 15:58:50 +0800 | [diff] [blame] | 273 | int32_t plat_core_pos_by_mpidr(u_register_t mpidr) |
Varun Wadekar | 43dad67 | 2017-01-31 14:53:37 -0800 | [diff] [blame] | 274 | { |
Anthony Zhou | 25d127f | 2017-03-21 15:58:50 +0800 | [diff] [blame] | 275 | u_register_t cluster_id, cpu_id, pos; |
| 276 | int32_t ret; |
Varun Wadekar | 43dad67 | 2017-01-31 14:53:37 -0800 | [diff] [blame] | 277 | |
Anthony Zhou | 25d127f | 2017-03-21 15:58:50 +0800 | [diff] [blame] | 278 | cluster_id = (mpidr >> (u_register_t)MPIDR_AFF1_SHIFT) & (u_register_t)MPIDR_AFFLVL_MASK; |
| 279 | cpu_id = (mpidr >> (u_register_t)MPIDR_AFF0_SHIFT) & (u_register_t)MPIDR_AFFLVL_MASK; |
Varun Wadekar | 43dad67 | 2017-01-31 14:53:37 -0800 | [diff] [blame] | 280 | |
| 281 | /* |
| 282 | * Validate cluster_id by checking whether it represents |
| 283 | * one of the two clusters present on the platform. |
Varun Wadekar | 43dad67 | 2017-01-31 14:53:37 -0800 | [diff] [blame] | 284 | * Validate cpu_id by checking whether it represents a CPU in |
| 285 | * one of the two clusters present on the platform. |
| 286 | */ |
Anthony Zhou | 25d127f | 2017-03-21 15:58:50 +0800 | [diff] [blame] | 287 | if ((cluster_id >= (u_register_t)PLATFORM_CLUSTER_COUNT) || |
| 288 | (cpu_id >= (u_register_t)PLATFORM_MAX_CPUS_PER_CLUSTER)) { |
| 289 | ret = PSCI_E_NOT_PRESENT; |
| 290 | } else { |
| 291 | /* calculate the core position */ |
| 292 | pos = cpu_id + (cluster_id << 2U); |
Varun Wadekar | 43dad67 | 2017-01-31 14:53:37 -0800 | [diff] [blame] | 293 | |
Anthony Zhou | 25d127f | 2017-03-21 15:58:50 +0800 | [diff] [blame] | 294 | /* check for non-existent CPUs */ |
| 295 | if ((pos == TEGRA186_CLUSTER0_CORE2) || (pos == TEGRA186_CLUSTER0_CORE3)) { |
| 296 | ret = PSCI_E_NOT_PRESENT; |
| 297 | } else { |
| 298 | ret = (int32_t)pos; |
| 299 | } |
| 300 | } |
Varun Wadekar | 43dad67 | 2017-01-31 14:53:37 -0800 | [diff] [blame] | 301 | |
Anthony Zhou | 25d127f | 2017-03-21 15:58:50 +0800 | [diff] [blame] | 302 | return ret; |
Varun Wadekar | 43dad67 | 2017-01-31 14:53:37 -0800 | [diff] [blame] | 303 | } |
Varun Wadekar | 0ed6270 | 2018-06-20 14:30:59 -0700 | [diff] [blame] | 304 | |
Varun Wadekar | 8d7a02b | 2018-06-26 16:07:50 -0700 | [diff] [blame] | 305 | /******************************************************************************* |
| 306 | * Handler to relocate BL32 image to TZDRAM |
| 307 | ******************************************************************************/ |
Varun Wadekar | 0ed6270 | 2018-06-20 14:30:59 -0700 | [diff] [blame] | 308 | void plat_relocate_bl32_image(const image_info_t *bl32_img_info) |
| 309 | { |
| 310 | const plat_params_from_bl2_t *plat_bl31_params = plat_get_bl31_plat_params(); |
| 311 | const entry_point_info_t *bl32_ep_info = bl31_plat_get_next_image_ep_info(SECURE); |
| 312 | uint64_t tzdram_start, tzdram_end, bl32_start, bl32_end; |
| 313 | |
Varun Wadekar | 8d7a02b | 2018-06-26 16:07:50 -0700 | [diff] [blame] | 314 | if ((bl32_img_info != NULL) && (bl32_ep_info != NULL)) { |
Varun Wadekar | 0ed6270 | 2018-06-20 14:30:59 -0700 | [diff] [blame] | 315 | |
| 316 | /* Relocate BL32 if it resides outside of the TZDRAM */ |
| 317 | tzdram_start = plat_bl31_params->tzdram_base; |
| 318 | tzdram_end = plat_bl31_params->tzdram_base + |
| 319 | plat_bl31_params->tzdram_size; |
| 320 | bl32_start = bl32_img_info->image_base; |
| 321 | bl32_end = bl32_img_info->image_base + bl32_img_info->image_size; |
| 322 | |
| 323 | assert(tzdram_end > tzdram_start); |
| 324 | assert(bl32_end > bl32_start); |
| 325 | assert(bl32_ep_info->pc > tzdram_start); |
| 326 | assert(bl32_ep_info->pc < tzdram_end); |
| 327 | |
| 328 | /* relocate BL32 */ |
| 329 | if ((bl32_start >= tzdram_end) || (bl32_end <= tzdram_start)) { |
| 330 | |
| 331 | INFO("Relocate BL32 to TZDRAM\n"); |
| 332 | |
| 333 | (void)memcpy16((void *)(uintptr_t)bl32_ep_info->pc, |
| 334 | (void *)(uintptr_t)bl32_start, |
| 335 | bl32_img_info->image_size); |
| 336 | |
| 337 | /* clean up non-secure intermediate buffer */ |
| 338 | zeromem((void *)(uintptr_t)bl32_start, |
| 339 | bl32_img_info->image_size); |
| 340 | } |
| 341 | } |
| 342 | } |
Varun Wadekar | 8d7a02b | 2018-06-26 16:07:50 -0700 | [diff] [blame] | 343 | |
| 344 | /******************************************************************************* |
| 345 | * Handler to indicate support for System Suspend |
| 346 | ******************************************************************************/ |
| 347 | bool plat_supports_system_suspend(void) |
| 348 | { |
| 349 | return true; |
| 350 | } |