Varun Wadekar | 921b906 | 2015-08-25 17:03:14 +0530 | [diff] [blame] | 1 | /* |
Varun Wadekar | b877615 | 2016-03-03 13:52:52 -0800 | [diff] [blame] | 2 | * Copyright (c) 2015-2016, ARM Limited and Contributors. All rights reserved. |
Varun Wadekar | 921b906 | 2015-08-25 17:03:14 +0530 | [diff] [blame] | 3 | * |
| 4 | * Redistribution and use in source and binary forms, with or without |
| 5 | * modification, are permitted provided that the following conditions are met: |
| 6 | * |
| 7 | * Redistributions of source code must retain the above copyright notice, this |
| 8 | * list of conditions and the following disclaimer. |
| 9 | * |
| 10 | * Redistributions in binary form must reproduce the above copyright notice, |
| 11 | * this list of conditions and the following disclaimer in the documentation |
| 12 | * and/or other materials provided with the distribution. |
| 13 | * |
| 14 | * Neither the name of ARM nor the names of its contributors may be used |
| 15 | * to endorse or promote products derived from this software without specific |
| 16 | * prior written permission. |
| 17 | * |
| 18 | * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" |
| 19 | * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE |
| 20 | * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE |
| 21 | * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE |
| 22 | * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR |
| 23 | * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF |
| 24 | * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS |
| 25 | * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN |
| 26 | * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) |
| 27 | * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE |
| 28 | * POSSIBILITY OF SUCH DAMAGE. |
| 29 | */ |
| 30 | |
Varun Wadekar | cad7b08 | 2015-12-28 18:12:59 -0800 | [diff] [blame] | 31 | #include <arch_helpers.h> |
| 32 | #include <assert.h> |
Varun Wadekar | 94701ff | 2016-05-23 11:47:34 -0700 | [diff] [blame] | 33 | #include <bl31.h> |
Varun Wadekar | cad7b08 | 2015-12-28 18:12:59 -0800 | [diff] [blame] | 34 | #include <bl_common.h> |
Varun Wadekar | 921b906 | 2015-08-25 17:03:14 +0530 | [diff] [blame] | 35 | #include <console.h> |
Varun Wadekar | cad7b08 | 2015-12-28 18:12:59 -0800 | [diff] [blame] | 36 | #include <context.h> |
| 37 | #include <context_mgmt.h> |
Varun Wadekar | 4debe05 | 2016-05-18 13:39:16 -0700 | [diff] [blame] | 38 | #include <cortex_a57.h> |
Varun Wadekar | cad7b08 | 2015-12-28 18:12:59 -0800 | [diff] [blame] | 39 | #include <debug.h> |
| 40 | #include <denver.h> |
| 41 | #include <interrupt_mgmt.h> |
Varun Wadekar | 47ddd00 | 2016-03-28 16:00:02 -0700 | [diff] [blame] | 42 | #include <mce.h> |
Varun Wadekar | cad7b08 | 2015-12-28 18:12:59 -0800 | [diff] [blame] | 43 | #include <platform.h> |
Varun Wadekar | 921b906 | 2015-08-25 17:03:14 +0530 | [diff] [blame] | 44 | #include <tegra_def.h> |
Varun Wadekar | 5887c10 | 2016-07-19 11:29:40 -0700 | [diff] [blame] | 45 | #include <tegra_platform.h> |
Varun Wadekar | cad7b08 | 2015-12-28 18:12:59 -0800 | [diff] [blame] | 46 | #include <tegra_private.h> |
Varun Wadekar | 921b906 | 2015-08-25 17:03:14 +0530 | [diff] [blame] | 47 | #include <xlat_tables.h> |
| 48 | |
Varun Wadekar | 4debe05 | 2016-05-18 13:39:16 -0700 | [diff] [blame] | 49 | DEFINE_RENAME_SYSREG_RW_FUNCS(l2ctlr_el1, L2CTLR_EL1) |
| 50 | extern uint64_t tegra_enable_l2_ecc_parity_prot; |
| 51 | |
Varun Wadekar | c2c3a2a | 2016-01-08 17:38:51 -0800 | [diff] [blame] | 52 | /******************************************************************************* |
Varun Wadekar | 43dad67 | 2017-01-31 14:53:37 -0800 | [diff] [blame] | 53 | * Tegra186 CPU numbers in cluster #0 |
| 54 | ******************************************************************************* |
| 55 | */ |
| 56 | #define TEGRA186_CLUSTER0_CORE2 2 |
| 57 | #define TEGRA186_CLUSTER0_CORE3 3 |
| 58 | |
| 59 | /******************************************************************************* |
Varun Wadekar | c2c3a2a | 2016-01-08 17:38:51 -0800 | [diff] [blame] | 60 | * The Tegra power domain tree has a single system level power domain i.e. a |
| 61 | * single root node. The first entry in the power domain descriptor specifies |
| 62 | * the number of power domains at the highest power level. |
| 63 | ******************************************************************************* |
| 64 | */ |
| 65 | const unsigned char tegra_power_domain_tree_desc[] = { |
| 66 | /* No of root nodes */ |
| 67 | 1, |
| 68 | /* No of clusters */ |
| 69 | PLATFORM_CLUSTER_COUNT, |
| 70 | /* No of CPU cores - cluster0 */ |
| 71 | PLATFORM_MAX_CPUS_PER_CLUSTER, |
| 72 | /* No of CPU cores - cluster1 */ |
| 73 | PLATFORM_MAX_CPUS_PER_CLUSTER |
| 74 | }; |
| 75 | |
Varun Wadekar | 921b906 | 2015-08-25 17:03:14 +0530 | [diff] [blame] | 76 | /* |
| 77 | * Table of regions to map using the MMU. |
| 78 | */ |
| 79 | static const mmap_region_t tegra_mmap[] = { |
| 80 | MAP_REGION_FLAT(TEGRA_MISC_BASE, 0x10000, /* 64KB */ |
| 81 | MT_DEVICE | MT_RW | MT_SECURE), |
Varun Wadekar | a0f2697 | 2016-03-11 17:18:51 -0800 | [diff] [blame] | 82 | MAP_REGION_FLAT(TEGRA_TSA_BASE, 0x20000, /* 128KB */ |
| 83 | MT_DEVICE | MT_RW | MT_SECURE), |
Varun Wadekar | 921b906 | 2015-08-25 17:03:14 +0530 | [diff] [blame] | 84 | MAP_REGION_FLAT(TEGRA_MC_STREAMID_BASE, 0x10000, /* 64KB */ |
| 85 | MT_DEVICE | MT_RW | MT_SECURE), |
| 86 | MAP_REGION_FLAT(TEGRA_MC_BASE, 0x10000, /* 64KB */ |
| 87 | MT_DEVICE | MT_RW | MT_SECURE), |
Varun Wadekar | 9db0ad1 | 2016-07-12 10:04:28 -0700 | [diff] [blame] | 88 | MAP_REGION_FLAT(TEGRA_UARTA_BASE, 0x20000, /* 128KB - UART A, B*/ |
| 89 | MT_DEVICE | MT_RW | MT_SECURE), |
| 90 | MAP_REGION_FLAT(TEGRA_UARTC_BASE, 0x20000, /* 128KB - UART C, G */ |
| 91 | MT_DEVICE | MT_RW | MT_SECURE), |
| 92 | MAP_REGION_FLAT(TEGRA_UARTD_BASE, 0x30000, /* 192KB - UART D, E, F */ |
Varun Wadekar | 921b906 | 2015-08-25 17:03:14 +0530 | [diff] [blame] | 93 | MT_DEVICE | MT_RW | MT_SECURE), |
Varun Wadekar | 4debe05 | 2016-05-18 13:39:16 -0700 | [diff] [blame] | 94 | MAP_REGION_FLAT(TEGRA_FUSE_BASE, 0x10000, /* 64KB */ |
| 95 | MT_DEVICE | MT_RW | MT_SECURE), |
Varun Wadekar | 921b906 | 2015-08-25 17:03:14 +0530 | [diff] [blame] | 96 | MAP_REGION_FLAT(TEGRA_GICD_BASE, 0x20000, /* 128KB */ |
| 97 | MT_DEVICE | MT_RW | MT_SECURE), |
Varun Wadekar | b877615 | 2016-03-03 13:52:52 -0800 | [diff] [blame] | 98 | MAP_REGION_FLAT(TEGRA_SE0_BASE, 0x10000, /* 64KB */ |
| 99 | MT_DEVICE | MT_RW | MT_SECURE), |
| 100 | MAP_REGION_FLAT(TEGRA_PKA1_BASE, 0x10000, /* 64KB */ |
| 101 | MT_DEVICE | MT_RW | MT_SECURE), |
| 102 | MAP_REGION_FLAT(TEGRA_RNG1_BASE, 0x10000, /* 64KB */ |
| 103 | MT_DEVICE | MT_RW | MT_SECURE), |
Varun Wadekar | e60f1bf | 2016-02-17 10:10:50 -0800 | [diff] [blame] | 104 | MAP_REGION_FLAT(TEGRA_CAR_RESET_BASE, 0x10000, /* 64KB */ |
| 105 | MT_DEVICE | MT_RW | MT_SECURE), |
Varun Wadekar | 921b906 | 2015-08-25 17:03:14 +0530 | [diff] [blame] | 106 | MAP_REGION_FLAT(TEGRA_PMC_BASE, 0x40000, /* 256KB */ |
| 107 | MT_DEVICE | MT_RW | MT_SECURE), |
Varun Wadekar | b877615 | 2016-03-03 13:52:52 -0800 | [diff] [blame] | 108 | MAP_REGION_FLAT(TEGRA_SCRATCH_BASE, 0x10000, /* 64KB */ |
| 109 | MT_DEVICE | MT_RW | MT_SECURE), |
Varun Wadekar | 921b906 | 2015-08-25 17:03:14 +0530 | [diff] [blame] | 110 | MAP_REGION_FLAT(TEGRA_MMCRAB_BASE, 0x60000, /* 384KB */ |
| 111 | MT_DEVICE | MT_RW | MT_SECURE), |
Varun Wadekar | d64db96 | 2016-09-23 14:28:16 -0700 | [diff] [blame] | 112 | MAP_REGION_FLAT(TEGRA_ARM_ACTMON_CTR_BASE, 0x20000, /* 128KB - ARM/Denver */ |
| 113 | MT_DEVICE | MT_RW | MT_SECURE), |
Pritesh Raithatha | 0de6e53 | 2017-01-24 13:49:46 +0530 | [diff] [blame] | 114 | MAP_REGION_FLAT(TEGRA_SMMU0_BASE, 0x1000000, /* 64KB */ |
Varun Wadekar | 921b906 | 2015-08-25 17:03:14 +0530 | [diff] [blame] | 115 | MT_DEVICE | MT_RW | MT_SECURE), |
| 116 | {0} |
| 117 | }; |
| 118 | |
| 119 | /******************************************************************************* |
| 120 | * Set up the pagetables as per the platform memory map & initialize the MMU |
| 121 | ******************************************************************************/ |
| 122 | const mmap_region_t *plat_get_mmio_map(void) |
| 123 | { |
| 124 | /* MMIO space */ |
| 125 | return tegra_mmap; |
| 126 | } |
| 127 | |
| 128 | /******************************************************************************* |
| 129 | * Handler to get the System Counter Frequency |
| 130 | ******************************************************************************/ |
Varun Wadekar | ef8a4fe | 2016-06-02 14:26:13 -0700 | [diff] [blame] | 131 | unsigned int plat_get_syscnt_freq2(void) |
Varun Wadekar | 921b906 | 2015-08-25 17:03:14 +0530 | [diff] [blame] | 132 | { |
Varun Wadekar | 20c9429 | 2016-01-04 10:57:45 -0800 | [diff] [blame] | 133 | return 31250000; |
Varun Wadekar | 921b906 | 2015-08-25 17:03:14 +0530 | [diff] [blame] | 134 | } |
| 135 | |
| 136 | /******************************************************************************* |
| 137 | * Maximum supported UART controllers |
| 138 | ******************************************************************************/ |
| 139 | #define TEGRA186_MAX_UART_PORTS 7 |
| 140 | |
| 141 | /******************************************************************************* |
| 142 | * This variable holds the UART port base addresses |
| 143 | ******************************************************************************/ |
| 144 | static uint32_t tegra186_uart_addresses[TEGRA186_MAX_UART_PORTS + 1] = { |
| 145 | 0, /* undefined - treated as an error case */ |
| 146 | TEGRA_UARTA_BASE, |
| 147 | TEGRA_UARTB_BASE, |
| 148 | TEGRA_UARTC_BASE, |
| 149 | TEGRA_UARTD_BASE, |
| 150 | TEGRA_UARTE_BASE, |
| 151 | TEGRA_UARTF_BASE, |
| 152 | TEGRA_UARTG_BASE, |
| 153 | }; |
| 154 | |
| 155 | /******************************************************************************* |
| 156 | * Retrieve the UART controller base to be used as the console |
| 157 | ******************************************************************************/ |
| 158 | uint32_t plat_get_console_from_id(int id) |
| 159 | { |
| 160 | if (id > TEGRA186_MAX_UART_PORTS) |
| 161 | return 0; |
| 162 | |
| 163 | return tegra186_uart_addresses[id]; |
| 164 | } |
Varun Wadekar | cad7b08 | 2015-12-28 18:12:59 -0800 | [diff] [blame] | 165 | |
Varun Wadekar | 4debe05 | 2016-05-18 13:39:16 -0700 | [diff] [blame] | 166 | /* represent chip-version as concatenation of major (15:12), minor (11:8) and subrev (7:0) */ |
| 167 | #define TEGRA186_VER_A02P 0x1201 |
| 168 | |
| 169 | /******************************************************************************* |
| 170 | * Handler for early platform setup |
| 171 | ******************************************************************************/ |
| 172 | void plat_early_platform_setup(void) |
| 173 | { |
| 174 | int impl = (read_midr() >> MIDR_IMPL_SHIFT) & MIDR_IMPL_MASK; |
Varun Wadekar | 5887c10 | 2016-07-19 11:29:40 -0700 | [diff] [blame] | 175 | uint32_t chip_subrev, val; |
Varun Wadekar | 4debe05 | 2016-05-18 13:39:16 -0700 | [diff] [blame] | 176 | |
| 177 | /* sanity check MCE firmware compatibility */ |
| 178 | mce_verify_firmware_version(); |
| 179 | |
| 180 | /* |
| 181 | * Enable ECC and Parity Protection for Cortex-A57 CPUs |
| 182 | * for Tegra A02p SKUs |
| 183 | */ |
| 184 | if (impl != DENVER_IMPL) { |
| 185 | |
| 186 | /* get the major, minor and sub-version values */ |
Varun Wadekar | 4debe05 | 2016-05-18 13:39:16 -0700 | [diff] [blame] | 187 | chip_subrev = mmio_read_32(TEGRA_FUSE_BASE + OPT_SUBREVISION) & |
| 188 | SUBREVISION_MASK; |
| 189 | |
| 190 | /* prepare chip version number */ |
Varun Wadekar | 5887c10 | 2016-07-19 11:29:40 -0700 | [diff] [blame] | 191 | val = (tegra_get_chipid_major() << 12) | |
| 192 | (tegra_get_chipid_minor() << 8) | |
| 193 | chip_subrev; |
Varun Wadekar | 4debe05 | 2016-05-18 13:39:16 -0700 | [diff] [blame] | 194 | |
| 195 | /* enable L2 ECC for Tegra186 A02P and beyond */ |
| 196 | if (val >= TEGRA186_VER_A02P) { |
| 197 | |
| 198 | val = read_l2ctlr_el1(); |
| 199 | val |= L2_ECC_PARITY_PROTECTION_BIT; |
| 200 | write_l2ctlr_el1(val); |
| 201 | |
| 202 | /* |
| 203 | * Set the flag to enable ECC/Parity Protection |
| 204 | * when we exit System Suspend or Cluster Powerdn |
| 205 | */ |
| 206 | tegra_enable_l2_ecc_parity_prot = 1; |
| 207 | } |
| 208 | } |
| 209 | } |
| 210 | |
Varun Wadekar | cad7b08 | 2015-12-28 18:12:59 -0800 | [diff] [blame] | 211 | /* Secure IRQs for Tegra186 */ |
| 212 | static const irq_sec_cfg_t tegra186_sec_irqs[] = { |
| 213 | { |
| 214 | TEGRA186_TOP_WDT_IRQ, |
| 215 | TEGRA186_SEC_IRQ_TARGET_MASK, |
| 216 | INTR_TYPE_EL3, |
| 217 | }, |
| 218 | { |
| 219 | TEGRA186_AON_WDT_IRQ, |
| 220 | TEGRA186_SEC_IRQ_TARGET_MASK, |
| 221 | INTR_TYPE_EL3, |
| 222 | }, |
| 223 | }; |
| 224 | |
| 225 | /******************************************************************************* |
| 226 | * Initialize the GIC and SGIs |
| 227 | ******************************************************************************/ |
| 228 | void plat_gic_setup(void) |
| 229 | { |
| 230 | tegra_gic_setup(tegra186_sec_irqs, |
| 231 | sizeof(tegra186_sec_irqs) / sizeof(tegra186_sec_irqs[0])); |
| 232 | |
| 233 | /* |
| 234 | * Initialize the FIQ handler only if the platform supports any |
| 235 | * FIQ interrupt sources. |
| 236 | */ |
| 237 | if (sizeof(tegra186_sec_irqs) > 0) |
| 238 | tegra_fiq_handler_setup(); |
| 239 | } |
Varun Wadekar | 94701ff | 2016-05-23 11:47:34 -0700 | [diff] [blame] | 240 | |
| 241 | /******************************************************************************* |
| 242 | * Return pointer to the BL31 params from previous bootloader |
| 243 | ******************************************************************************/ |
| 244 | bl31_params_t *plat_get_bl31_params(void) |
| 245 | { |
| 246 | uint32_t val; |
| 247 | |
| 248 | val = mmio_read_32(TEGRA_SCRATCH_BASE + SECURE_SCRATCH_RSV53_LO); |
| 249 | |
| 250 | return (bl31_params_t *)(uintptr_t)val; |
| 251 | } |
| 252 | |
| 253 | /******************************************************************************* |
| 254 | * Return pointer to the BL31 platform params from previous bootloader |
| 255 | ******************************************************************************/ |
| 256 | plat_params_from_bl2_t *plat_get_bl31_plat_params(void) |
| 257 | { |
| 258 | uint32_t val; |
| 259 | |
| 260 | val = mmio_read_32(TEGRA_SCRATCH_BASE + SECURE_SCRATCH_RSV53_HI); |
| 261 | |
| 262 | return (plat_params_from_bl2_t *)(uintptr_t)val; |
| 263 | } |
Varun Wadekar | 43dad67 | 2017-01-31 14:53:37 -0800 | [diff] [blame] | 264 | |
| 265 | /******************************************************************************* |
| 266 | * This function implements a part of the critical interface between the psci |
| 267 | * generic layer and the platform that allows the former to query the platform |
| 268 | * to convert an MPIDR to a unique linear index. An error code (-1) is returned |
| 269 | * in case the MPIDR is invalid. |
| 270 | ******************************************************************************/ |
| 271 | int plat_core_pos_by_mpidr(u_register_t mpidr) |
| 272 | { |
| 273 | unsigned int cluster_id, cpu_id, pos; |
| 274 | |
| 275 | cluster_id = (mpidr >> MPIDR_AFF1_SHIFT) & MPIDR_AFFLVL_MASK; |
| 276 | cpu_id = (mpidr >> MPIDR_AFF0_SHIFT) & MPIDR_AFFLVL_MASK; |
| 277 | |
| 278 | /* |
| 279 | * Validate cluster_id by checking whether it represents |
| 280 | * one of the two clusters present on the platform. |
| 281 | */ |
| 282 | if (cluster_id >= PLATFORM_CLUSTER_COUNT) |
| 283 | return PSCI_E_NOT_PRESENT; |
| 284 | |
| 285 | /* |
| 286 | * Validate cpu_id by checking whether it represents a CPU in |
| 287 | * one of the two clusters present on the platform. |
| 288 | */ |
| 289 | if (cpu_id >= PLATFORM_MAX_CPUS_PER_CLUSTER) |
| 290 | return PSCI_E_NOT_PRESENT; |
| 291 | |
| 292 | /* calculate the core position */ |
| 293 | pos = cpu_id + (cluster_id << 2); |
| 294 | |
| 295 | /* check for non-existent CPUs */ |
| 296 | if (pos == TEGRA186_CLUSTER0_CORE2 || pos == TEGRA186_CLUSTER0_CORE3) |
| 297 | return PSCI_E_NOT_PRESENT; |
| 298 | |
| 299 | return pos; |
| 300 | } |