1/* 2 * Copyright (c) 2022, ARM Limited. All rights reserved. 3 * 4 * SPDX-License-Identifier: BSD-3-Clause 5 */ 6 7#include <arch.h> 8#include <asm_macros.S> 9#include <common/bl_common.h> 10#include <cortex_a510.h> 11#include <cpu_macros.S> 12#include <plat_macros.S> 13 14/* Hardware handled coherency */ 15#if HW_ASSISTED_COHERENCY == 0 16#error "Cortex-A510 must be compiled with HW_ASSISTED_COHERENCY enabled" 17#endif 18 19/* 64-bit only core */ 20#if CTX_INCLUDE_AARCH32_REGS == 1 21#error "Cortex-A510 supports only AArch64. Compile with CTX_INCLUDE_AARCH32_REGS=0" 22#endif 23 24 /* -------------------------------------------------- 25 * Errata Workaround for Cortex-A510 Errata #1922240. 26 * This applies only to revision r0p0 (fixed in r0p1) 27 * x0: variant[4:7] and revision[0:3] of current cpu. 28 * Shall clobber: x0, x1, x17 29 * -------------------------------------------------- 30 */ 31func errata_cortex_a510_1922240_wa 32 /* Check workaround compatibility. */ 33 mov x17, x30 34 bl check_errata_1922240 35 cbz x0, 1f 36 37 /* Apply the workaround by setting IMP_CMPXACTLR_EL1[11:10] = 0b11. */ 38 mrs x0, CORTEX_A510_CMPXACTLR_EL1 39 mov x1, #3 40 bfi x0, x1, #10, #2 41 msr CORTEX_A510_CMPXACTLR_EL1, x0 42 431: 44 ret x17 45endfunc errata_cortex_a510_1922240_wa 46 47func check_errata_1922240 48 /* Applies to r0p0 only */ 49 mov x1, #0x00 50 b cpu_rev_var_ls 51endfunc check_errata_1922240 52 53 /* -------------------------------------------------- 54 * Errata Workaround for Cortex-A510 Errata #2288014. 55 * This applies only to revisions r0p0, r0p1, r0p2, 56 * r0p3 and r1p0. (fixed in r1p1) 57 * x0: variant[4:7] and revision[0:3] of current cpu. 58 * Shall clobber: x0, x1, x17 59 * -------------------------------------------------- 60 */ 61func errata_cortex_a510_2288014_wa 62 /* Check workaround compatibility. */ 63 mov x17, x30 64 bl check_errata_2288014 65 cbz x0, 1f 66 67 /* Apply the workaround by setting IMP_CPUACTLR_EL1[18] = 0b1. */ 68 mrs x0, CORTEX_A510_CPUACTLR_EL1 69 mov x1, #1 70 bfi x0, x1, #18, #1 71 msr CORTEX_A510_CPUACTLR_EL1, x0 72 731: 74 ret x17 75endfunc errata_cortex_a510_2288014_wa 76 77func check_errata_2288014 78 /* Applies to r1p0 and below */ 79 mov x1, #0x10 80 b cpu_rev_var_ls 81endfunc check_errata_2288014 82 83 /* -------------------------------------------------- 84 * Errata Workaround for Cortex-A510 Errata #2042739. 85 * This applies only to revisions r0p0, r0p1 and r0p2. 86 * (fixed in r0p3) 87 * x0: variant[4:7] and revision[0:3] of current cpu. 88 * Shall clobber: x0, x1, x17 89 * -------------------------------------------------- 90 */ 91func errata_cortex_a510_2042739_wa 92 /* Check workaround compatibility. */ 93 mov x17, x30 94 bl check_errata_2042739 95 cbz x0, 1f 96 97 /* Apply the workaround by disabling ReadPreferUnique. */ 98 mrs x0, CORTEX_A510_CPUECTLR_EL1 99 mov x1, #CORTEX_A510_CPUECTLR_EL1_READPREFERUNIQUE_DISABLE 100 bfi x0, x1, #CORTEX_A510_CPUECTLR_EL1_READPREFERUNIQUE_SHIFT, #1 101 msr CORTEX_A510_CPUECTLR_EL1, x0 102 1031: 104 ret x17 105endfunc errata_cortex_a510_2042739_wa 106 107func check_errata_2042739 108 /* Applies to revisions r0p0 - r0p2 */ 109 mov x1, #0x02 110 b cpu_rev_var_ls 111endfunc check_errata_2042739 112 113 /* -------------------------------------------------- 114 * Errata Workaround for Cortex-A510 Errata #2041909. 115 * This applies only to revision r0p2 and it is fixed in 116 * r0p3. The issue is also present in r0p0 and r0p1 but 117 * there is no workaround in those revisions. 118 * x0: variant[4:7] and revision[0:3] of current cpu. 119 * Shall clobber: x0, x1, x2, x17 120 * -------------------------------------------------- 121 */ 122func errata_cortex_a510_2041909_wa 123 /* Check workaround compatibility. */ 124 mov x17, x30 125 bl check_errata_2041909 126 cbz x0, 1f 127 128 /* Apply workaround */ 129 mov x0, xzr 130 msr S3_6_C15_C4_0, x0 131 isb 132 133 mov x0, #0x8500000 134 msr S3_6_C15_C4_2, x0 135 136 mov x0, #0x1F700000 137 movk x0, #0x8, lsl #32 138 msr S3_6_C15_C4_3, x0 139 140 mov x0, #0x3F1 141 movk x0, #0x110, lsl #16 142 msr S3_6_C15_C4_1, x0 143 isb 144 1451: 146 ret x17 147endfunc errata_cortex_a510_2041909_wa 148 149func check_errata_2041909 150 /* Applies only to revision r0p2 */ 151 mov x1, #0x02 152 mov x2, #0x02 153 b cpu_rev_var_range 154endfunc check_errata_2041909 155 156 /* -------------------------------------------------- 157 * Errata Workaround for Cortex-A510 Errata #2250311. 158 * This applies only to revisions r0p0, r0p1, r0p2, 159 * r0p3 and r1p0, and is fixed in r1p1. 160 * This workaround is not a typical errata fix. MPMM 161 * is disabled here, but this conflicts with the BL31 162 * MPMM support. So in addition to simply disabling 163 * the feature, a flag is set in the MPMM library 164 * indicating that it should not be enabled even if 165 * ENABLE_MPMM=1. 166 * x0: variant[4:7] and revision[0:3] of current cpu. 167 * Shall clobber: x0, x1, x17 168 * -------------------------------------------------- 169 */ 170func errata_cortex_a510_2250311_wa 171 /* Check workaround compatibility. */ 172 mov x17, x30 173 bl check_errata_2250311 174 cbz x0, 1f 175 176 /* Disable MPMM */ 177 mrs x0, CPUMPMMCR_EL3 178 bfm x0, xzr, #0, #0 /* bfc instruction does not work in GCC */ 179 msr CPUMPMMCR_EL3, x0 180 181#if ENABLE_MPMM && IMAGE_BL31 182 /* If ENABLE_MPMM is set, tell the runtime lib to skip enabling it. */ 183 bl mpmm_errata_disable 184#endif 185 1861: 187 ret x17 188endfunc errata_cortex_a510_2250311_wa 189 190func check_errata_2250311 191 /* Applies to r1p0 and lower */ 192 mov x1, #0x10 193 b cpu_rev_var_ls 194endfunc check_errata_2250311 195 196 /* -------------------------------------------------- 197 * Errata Workaround for Cortex-A510 Errata #2218950. 198 * This applies only to revisions r0p0, r0p1, r0p2, 199 * r0p3 and r1p0, and is fixed in r1p1. 200 * x0: variant[4:7] and revision[0:3] of current cpu. 201 * Shall clobber: x0, x1, x17 202 * -------------------------------------------------- 203 */ 204func errata_cortex_a510_2218950_wa 205 /* Check workaround compatibility. */ 206 mov x17, x30 207 bl check_errata_2218950 208 cbz x0, 1f 209 210 /* Source register for BFI */ 211 mov x1, #1 212 213 /* Set bit 18 in CPUACTLR_EL1 */ 214 mrs x0, CORTEX_A510_CPUACTLR_EL1 215 bfi x0, x1, #18, #1 216 msr CORTEX_A510_CPUACTLR_EL1, x0 217 218 /* Set bit 25 in CMPXACTLR_EL1 */ 219 mrs x0, CORTEX_A510_CMPXACTLR_EL1 220 bfi x0, x1, #25, #1 221 msr CORTEX_A510_CMPXACTLR_EL1, x0 222 2231: 224 ret x17 225endfunc errata_cortex_a510_2218950_wa 226 227func check_errata_2218950 228 /* Applies to r1p0 and lower */ 229 mov x1, #0x10 230 b cpu_rev_var_ls 231endfunc check_errata_2218950 232 233 /* -------------------------------------------------- 234 * Errata Workaround for Cortex-A510 Errata #2172148. 235 * This applies only to revisions r0p0, r0p1, r0p2, 236 * r0p3 and r1p0, and is fixed in r1p1. 237 * x0: variant[4:7] and revision[0:3] of current cpu. 238 * Shall clobber: x0, x1, x17 239 * -------------------------------------------------- 240 */ 241func errata_cortex_a510_2172148_wa 242 /* Check workaround compatibility. */ 243 mov x17, x30 244 bl check_errata_2172148 245 cbz x0, 1f 246 247 /* 248 * Force L2 allocation of transient lines by setting 249 * CPUECTLR_EL1.RSCTL=0b01 and CPUECTLR_EL1.NTCTL=0b01. 250 */ 251 mrs x0, CORTEX_A510_CPUECTLR_EL1 252 mov x1, #1 253 bfi x0, x1, #CORTEX_A510_CPUECTLR_EL1_RSCTL_SHIFT, #2 254 bfi x0, x1, #CORTEX_A510_CPUECTLR_EL1_NTCTL_SHIFT, #2 255 msr CORTEX_A510_CPUECTLR_EL1, x0 256 2571: 258 ret x17 259endfunc errata_cortex_a510_2172148_wa 260 261func check_errata_2172148 262 /* Applies to r1p0 and lower */ 263 mov x1, #0x10 264 b cpu_rev_var_ls 265endfunc check_errata_2172148 266 267 /* ---------------------------------------------------- 268 * HW will do the cache maintenance while powering down 269 * ---------------------------------------------------- 270 */ 271func cortex_a510_core_pwr_dwn 272 /* --------------------------------------------------- 273 * Enable CPU power down bit in power control register 274 * --------------------------------------------------- 275 */ 276 mrs x0, CORTEX_A510_CPUPWRCTLR_EL1 277 orr x0, x0, #CORTEX_A510_CPUPWRCTLR_EL1_CORE_PWRDN_BIT 278 msr CORTEX_A510_CPUPWRCTLR_EL1, x0 279 isb 280 ret 281endfunc cortex_a510_core_pwr_dwn 282 283 /* 284 * Errata printing function for Cortex-A510. Must follow AAPCS. 285 */ 286#if REPORT_ERRATA 287func cortex_a510_errata_report 288 stp x8, x30, [sp, #-16]! 289 290 bl cpu_get_rev_var 291 mov x8, x0 292 293 /* 294 * Report all errata. The revision-variant information is passed to 295 * checking functions of each errata. 296 */ 297 report_errata ERRATA_A510_1922240, cortex_a510, 1922240 298 report_errata ERRATA_A510_2288014, cortex_a510, 2288014 299 report_errata ERRATA_A510_2042739, cortex_a510, 2042739 300 report_errata ERRATA_A510_2041909, cortex_a510, 2041909 301 report_errata ERRATA_A510_2250311, cortex_a510, 2250311 302 report_errata ERRATA_A510_2218950, cortex_a510, 2218950 303 report_errata ERRATA_A510_2172148, cortex_a510, 2172148 304 305 ldp x8, x30, [sp], #16 306 ret 307endfunc cortex_a510_errata_report 308#endif 309 310func cortex_a510_reset_func 311 mov x19, x30 312 313 /* Disable speculative loads */ 314 msr SSBS, xzr 315 isb 316 317 /* Get the CPU revision and stash it in x18. */ 318 bl cpu_get_rev_var 319 mov x18, x0 320 321#if ERRATA_A510_1922240 322 mov x0, x18 323 bl errata_cortex_a510_1922240_wa 324#endif 325 326#if ERRATA_A510_2288014 327 mov x0, x18 328 bl errata_cortex_a510_2288014_wa 329#endif 330 331#if ERRATA_A510_2042739 332 mov x0, x18 333 bl errata_cortex_a510_2042739_wa 334#endif 335 336#if ERRATA_A510_2041909 337 mov x0, x18 338 bl errata_cortex_a510_2041909_wa 339#endif 340 341#if ERRATA_A510_2250311 342 mov x0, x18 343 bl errata_cortex_a510_2250311_wa 344#endif 345 346#if ERRATA_A510_2218950 347 mov x0, x18 348 bl errata_cortex_a510_2218950_wa 349#endif 350 351#if ERRATA_A510_2172148 352 mov x0, x18 353 bl errata_cortex_a510_2172148_wa 354#endif 355 356 ret x19 357endfunc cortex_a510_reset_func 358 359 /* --------------------------------------------- 360 * This function provides Cortex-A510 specific 361 * register information for crash reporting. 362 * It needs to return with x6 pointing to 363 * a list of register names in ascii and 364 * x8 - x15 having values of registers to be 365 * reported. 366 * --------------------------------------------- 367 */ 368.section .rodata.cortex_a510_regs, "aS" 369cortex_a510_regs: /* The ascii list of register names to be reported */ 370 .asciz "cpuectlr_el1", "" 371 372func cortex_a510_cpu_reg_dump 373 adr x6, cortex_a510_regs 374 mrs x8, CORTEX_A510_CPUECTLR_EL1 375 ret 376endfunc cortex_a510_cpu_reg_dump 377 378declare_cpu_ops cortex_a510, CORTEX_A510_MIDR, \ 379 cortex_a510_reset_func, \ 380 cortex_a510_core_pwr_dwn 381