1/* 2 * Copyright (c) 2021-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_a710.h> 11#include <cpu_macros.S> 12#include <plat_macros.S> 13#include "wa_cve_2022_23960_bhb_vector.S" 14 15/* Hardware handled coherency */ 16#if HW_ASSISTED_COHERENCY == 0 17#error "Cortex A710 must be compiled with HW_ASSISTED_COHERENCY enabled" 18#endif 19 20/* 64-bit only core */ 21#if CTX_INCLUDE_AARCH32_REGS == 1 22#error "Cortex A710 supports only AArch64. Compile with CTX_INCLUDE_AARCH32_REGS=0" 23#endif 24 25#if WORKAROUND_CVE_2022_23960 26 wa_cve_2022_23960_bhb_vector_table CORTEX_A710_BHB_LOOP_COUNT, cortex_a710 27#endif /* WORKAROUND_CVE_2022_23960 */ 28 29/* -------------------------------------------------- 30 * Errata Workaround for Cortex-A710 Erratum 1987031. 31 * This applies to revision r0p0, r1p0 and r2p0 of Cortex-A710. It is still 32 * open. 33 * Inputs: 34 * x0: variant[4:7] and revision[0:3] of current cpu. 35 * Shall clobber: x0-x17 36 * -------------------------------------------------- 37 */ 38func errata_a710_1987031_wa 39 /* Check revision. */ 40 mov x17, x30 41 bl check_errata_1987031 42 cbz x0, 1f 43 44 /* Apply instruction patching sequence */ 45 ldr x0,=0x6 46 msr S3_6_c15_c8_0,x0 47 ldr x0,=0xF3A08002 48 msr S3_6_c15_c8_2,x0 49 ldr x0,=0xFFF0F7FE 50 msr S3_6_c15_c8_3,x0 51 ldr x0,=0x40000001003ff 52 msr S3_6_c15_c8_1,x0 53 ldr x0,=0x7 54 msr S3_6_c15_c8_0,x0 55 ldr x0,=0xBF200000 56 msr S3_6_c15_c8_2,x0 57 ldr x0,=0xFFEF0000 58 msr S3_6_c15_c8_3,x0 59 ldr x0,=0x40000001003f3 60 msr S3_6_c15_c8_1,x0 61 isb 621: 63 ret x17 64endfunc errata_a710_1987031_wa 65 66func check_errata_1987031 67 /* Applies to r0p0, r1p0 and r2p0 */ 68 mov x1, #0x20 69 b cpu_rev_var_ls 70endfunc check_errata_1987031 71 72/* -------------------------------------------------- 73 * Errata Workaround for Cortex-A710 Erratum 2081180. 74 * This applies to revision r0p0, r1p0 and r2p0 of Cortex-A710. 75 * It is still open. 76 * Inputs: 77 * x0: variant[4:7] and revision[0:3] of current cpu. 78 * Shall clobber: x0-x17 79 * -------------------------------------------------- 80 */ 81func errata_a710_2081180_wa 82 /* Check revision. */ 83 mov x17, x30 84 bl check_errata_2081180 85 cbz x0, 1f 86 87 /* Apply instruction patching sequence */ 88 ldr x0,=0x3 89 msr S3_6_c15_c8_0,x0 90 ldr x0,=0xF3A08002 91 msr S3_6_c15_c8_2,x0 92 ldr x0,=0xFFF0F7FE 93 msr S3_6_c15_c8_3,x0 94 ldr x0,=0x10002001003FF 95 msr S3_6_c15_c8_1,x0 96 ldr x0,=0x4 97 msr S3_6_c15_c8_0,x0 98 ldr x0,=0xBF200000 99 msr S3_6_c15_c8_2,x0 100 ldr x0,=0xFFEF0000 101 msr S3_6_c15_c8_3,x0 102 ldr x0,=0x10002001003F3 103 msr S3_6_c15_c8_1,x0 104 isb 1051: 106 ret x17 107endfunc errata_a710_2081180_wa 108 109func check_errata_2081180 110 /* Applies to r0p0, r1p0 and r2p0 */ 111 mov x1, #0x20 112 b cpu_rev_var_ls 113endfunc check_errata_2081180 114 115/* --------------------------------------------------------------------- 116 * Errata Workaround for Cortex-A710 Erratum 2055002. 117 * This applies to revision r1p0, r2p0 of Cortex-A710 and is still open. 118 * Inputs: 119 * x0: variant[4:7] and revision[0:3] of current cpu. 120 * Shall clobber: x0-x17 121 * --------------------------------------------------------------------- 122 */ 123func errata_a710_2055002_wa 124 /* Compare x0 against revision r2p0 */ 125 mov x17, x30 126 bl check_errata_2055002 127 cbz x0, 1f 128 mrs x1, CORTEX_A710_CPUACTLR_EL1 129 orr x1, x1, CORTEX_A710_CPUACTLR_EL1_BIT_46 130 msr CORTEX_A710_CPUACTLR_EL1, x1 1311: 132 ret x17 133endfunc errata_a710_2055002_wa 134 135func check_errata_2055002 136 /* Applies to r1p0, r2p0 */ 137 mov x1, #0x20 138 b cpu_rev_var_ls 139endfunc check_errata_2055002 140 141/* ------------------------------------------------------------- 142 * Errata Workaround for Cortex-A710 Erratum 2017096. 143 * This applies to revisions r0p0, r1p0 and r2p0 of Cortex-A710. 144 * Inputs: 145 * x0: variant[4:7] and revision[0:3] of current cpu. 146 * Shall clobber: x0-x17 147 * ------------------------------------------------------------- 148 */ 149func errata_a710_2017096_wa 150 /* Compare x0 against revision r0p0 to r2p0 */ 151 mov x17, x30 152 bl check_errata_2017096 153 cbz x0, 1f 154 mrs x1, CORTEX_A710_CPUECTLR_EL1 155 orr x1, x1, CORTEX_A710_CPUECTLR_EL1_PFSTIDIS_BIT 156 msr CORTEX_A710_CPUECTLR_EL1, x1 157 1581: 159 ret x17 160endfunc errata_a710_2017096_wa 161 162func check_errata_2017096 163 /* Applies to r0p0, r1p0, r2p0 */ 164 mov x1, #0x20 165 b cpu_rev_var_ls 166endfunc check_errata_2017096 167 168 169/* --------------------------------------------------------------------- 170 * Errata Workaround for Cortex-A710 Erratum 2083908. 171 * This applies to revision r2p0 of Cortex-A710 and is still open. 172 * Inputs: 173 * x0: variant[4:7] and revision[0:3] of current cpu. 174 * Shall clobber: x0-x17 175 * --------------------------------------------------------------------- 176 */ 177func errata_a710_2083908_wa 178 /* Compare x0 against revision r2p0 */ 179 mov x17, x30 180 bl check_errata_2083908 181 cbz x0, 1f 182 mrs x1, CORTEX_A710_CPUACTLR5_EL1 183 orr x1, x1, CORTEX_A710_CPUACTLR5_EL1_BIT_13 184 msr CORTEX_A710_CPUACTLR5_EL1, x1 1851: 186 ret x17 187endfunc errata_a710_2083908_wa 188 189func check_errata_2083908 190 /* Applies to r2p0 */ 191 mov x1, #CPU_REV(2, 0) 192 mov x2, #CPU_REV(2, 0) 193 b cpu_rev_var_range 194endfunc check_errata_2083908 195 196/* --------------------------------------------------------------------- 197 * Errata Workaround for Cortex-A710 Erratum 2058056. 198 * This applies to revisions r0p0, r1p0 and r2p0 of Cortex-A710 and is still 199 * open. 200 * Inputs: 201 * x0: variant[4:7] and revision[0:3] of current cpu. 202 * Shall clobber: x0-x17 203 * --------------------------------------------------------------------- 204 */ 205func errata_a710_2058056_wa 206 /* Compare x0 against revision r2p0 */ 207 mov x17, x30 208 bl check_errata_2058056 209 cbz x0, 1f 210 mrs x1, CORTEX_A710_CPUECTLR2_EL1 211 mov x0, #CORTEX_A710_CPUECTLR2_EL1_PF_MODE_CNSRV 212 bfi x1, x0, #CPUECTLR2_EL1_PF_MODE_LSB, #CPUECTLR2_EL1_PF_MODE_WIDTH 213 msr CORTEX_A710_CPUECTLR2_EL1, x1 2141: 215 ret x17 216endfunc errata_a710_2058056_wa 217 218func check_errata_2058056 219 /* Applies to r0p0, r1p0 and r2p0 */ 220 mov x1, #0x20 221 b cpu_rev_var_ls 222endfunc check_errata_2058056 223 224/* -------------------------------------------------- 225 * Errata Workaround for Cortex-A710 Erratum 2267065. 226 * This applies to revisions r0p0, r1p0 and r2p0. 227 * It is fixed in r2p1. 228 * Inputs: 229 * x0: variant[4:7] and revision[0:3] of current cpu. 230 * Shall clobber: x0-x1, x17 231 * -------------------------------------------------- 232 */ 233func errata_a710_2267065_wa 234 /* Compare x0 against revision r2p0 */ 235 mov x17, x30 236 bl check_errata_2267065 237 cbz x0, 1f 238 239 /* Apply instruction patching sequence */ 240 mrs x1, CORTEX_A710_CPUACTLR_EL1 241 orr x1, x1, CORTEX_A710_CPUACTLR_EL1_BIT_22 242 msr CORTEX_A710_CPUACTLR_EL1, x1 2431: 244 ret x17 245endfunc errata_a710_2267065_wa 246 247func check_errata_2267065 248 /* Applies to r0p0, r1p0 and r2p0 */ 249 mov x1, #0x20 250 b cpu_rev_var_ls 251endfunc check_errata_2267065 252 253/* --------------------------------------------------------------- 254 * Errata Workaround for Cortex-A710 Erratum 2136059. 255 * This applies to revision r0p0, r1p0 and r2p0. 256 * It is fixed in r2p1. 257 * Inputs: 258 * x0: variant[4:7] and revision[0:3] of current cpu. 259 * Shall clobber: x0-x17 260 * --------------------------------------------------------------- 261 */ 262func errata_a710_2136059_wa 263 /* Compare x0 against revision r2p0 */ 264 mov x17, x30 265 bl check_errata_2136059 266 cbz x0, 1f 267 268 /* Apply the workaround */ 269 mrs x1, CORTEX_A710_CPUACTLR5_EL1 270 orr x1, x1, CORTEX_A710_CPUACTLR5_EL1_BIT_44 271 msr CORTEX_A710_CPUACTLR5_EL1, x1 272 2731: 274 ret x17 275endfunc errata_a710_2136059_wa 276 277func check_errata_2136059 278 /* Applies to r0p0, r1p0 and r2p0 */ 279 mov x1, #0x20 280 b cpu_rev_var_ls 281endfunc check_errata_2136059 282 283/* --------------------------------------------------------------- 284 * Errata Workaround for Cortex-A710 Erratum 2282622. 285 * This applies to revision r0p0, r1p0 and r2p0. 286 * It is fixed in r2p1. 287 * Inputs: 288 * x0: variant[4:7] and revision[0:3] of current cpu. 289 * Shall clobber: x0, x1, x17 290 * --------------------------------------------------------------- 291 */ 292func errata_a710_2282622_wa 293 /* Compare x0 against revision r2p0 */ 294 mov x17, x30 295 bl check_errata_2282622 296 cbz x0, 1f 297 298 /* Apply the workaround */ 299 mrs x1, CORTEX_A710_CPUACTLR2_EL1 300 orr x1, x1, BIT(0) 301 msr CORTEX_A710_CPUACTLR2_EL1, x1 302 3031: 304 ret x17 305endfunc errata_a710_2282622_wa 306 307func check_errata_2282622 308 /* Applies to r0p0, r1p0 and r2p0 */ 309 mov x1, #0x20 310 b cpu_rev_var_ls 311endfunc check_errata_2282622 312 313/* --------------------------------------------------------------- 314 * Errata Workaround for Cortex-A710 Erratum 2008768. 315 * This applies to revision r0p0, r1p0 and r2p0. 316 * It is fixed in r2p1. 317 * Inputs: 318 * x0: variant[4:7] and revision[0:3] of current cpu. 319 * Shall clobber: x0, x1, x2, x17 320 * --------------------------------------------------------------- 321 */ 322func errata_a710_2008768_wa 323 mov x17, x30 324 bl check_errata_2008768 325 cbz x0, 1f 326 327 /* Stash ERRSELR_EL1 in x2 */ 328 mrs x2, ERRSELR_EL1 329 330 /* Select error record 0 and clear ED bit */ 331 msr ERRSELR_EL1, xzr 332 mrs x1, ERXCTLR_EL1 333 bfi x1, xzr, #ERXCTLR_ED_SHIFT, #1 334 msr ERXCTLR_EL1, x1 335 336 /* Select error record 1 and clear ED bit */ 337 mov x0, #1 338 msr ERRSELR_EL1, x0 339 mrs x1, ERXCTLR_EL1 340 bfi x1, xzr, #ERXCTLR_ED_SHIFT, #1 341 msr ERXCTLR_EL1, x1 342 343 /* Restore ERRSELR_EL1 from x2 */ 344 msr ERRSELR_EL1, x2 345 3461: 347 ret x17 348endfunc errata_a710_2008768_wa 349 350func check_errata_2008768 351 /* Applies to r0p0, r1p0 and r2p0 */ 352 mov x1, #0x20 353 b cpu_rev_var_ls 354endfunc check_errata_2008768 355 356/* ------------------------------------------------------- 357 * Errata Workaround for Cortex-A710 Erratum 2371105. 358 * This applies to revisions <= r2p0 and is fixed in r2p1. 359 * x0: variant[4:7] and revision[0:3] of current cpu. 360 * Shall clobber: x0-x17 361 * ------------------------------------------------------- 362 */ 363func errata_a710_2371105_wa 364 /* Check workaround compatibility. */ 365 mov x17, x30 366 bl check_errata_2371105 367 cbz x0, 1f 368 369 /* Set bit 40 in CPUACTLR2_EL1 */ 370 mrs x1, CORTEX_A710_CPUACTLR2_EL1 371 orr x1, x1, #CORTEX_A710_CPUACTLR2_EL1_BIT_40 372 msr CORTEX_A710_CPUACTLR2_EL1, x1 373 isb 3741: 375 ret x17 376endfunc errata_a710_2371105_wa 377 378func check_errata_2371105 379 /* Applies to <= r2p0. */ 380 mov x1, #0x20 381 b cpu_rev_var_ls 382endfunc check_errata_2371105 383 384func check_errata_cve_2022_23960 385#if WORKAROUND_CVE_2022_23960 386 mov x0, #ERRATA_APPLIES 387#else 388 mov x0, #ERRATA_MISSING 389#endif 390 ret 391endfunc check_errata_cve_2022_23960 392 393 /* ---------------------------------------------------- 394 * HW will do the cache maintenance while powering down 395 * ---------------------------------------------------- 396 */ 397func cortex_a710_core_pwr_dwn 398 399#if ERRATA_A710_2008768 400 mov x4, x30 401 bl cpu_get_rev_var 402 bl errata_a710_2008768_wa 403 mov x30, x4 404#endif 405 406 /* --------------------------------------------------- 407 * Enable CPU power down bit in power control register 408 * --------------------------------------------------- 409 */ 410 mrs x0, CORTEX_A710_CPUPWRCTLR_EL1 411 orr x0, x0, #CORTEX_A710_CPUPWRCTLR_EL1_CORE_PWRDN_BIT 412 msr CORTEX_A710_CPUPWRCTLR_EL1, x0 413 isb 414 ret 415endfunc cortex_a710_core_pwr_dwn 416 417#if REPORT_ERRATA 418 /* 419 * Errata printing function for Cortex-A710. Must follow AAPCS. 420 */ 421func cortex_a710_errata_report 422 stp x8, x30, [sp, #-16]! 423 424 bl cpu_get_rev_var 425 mov x8, x0 426 427 /* 428 * Report all errata. The revision-variant information is passed to 429 * checking functions of each errata. 430 */ 431 report_errata ERRATA_A710_1987031, cortex_a710, 1987031 432 report_errata ERRATA_A710_2081180, cortex_a710, 2081180 433 report_errata ERRATA_A710_2055002, cortex_a710, 2055002 434 report_errata ERRATA_A710_2017096, cortex_a710, 2017096 435 report_errata ERRATA_A710_2083908, cortex_a710, 2083908 436 report_errata ERRATA_A710_2058056, cortex_a710, 2058056 437 report_errata ERRATA_A710_2267065, cortex_a710, 2267065 438 report_errata ERRATA_A710_2136059, cortex_a710, 2136059 439 report_errata ERRATA_A710_2282622, cortex_a710, 2282622 440 report_errata ERRATA_A710_2008768, cortex_a710, 2008768 441 report_errata ERRATA_A710_2371105, cortex_a710, 2371105 442 report_errata WORKAROUND_CVE_2022_23960, cortex_a710, cve_2022_23960 443 report_errata ERRATA_DSU_2313941, cortex_a710, dsu_2313941 444 445 ldp x8, x30, [sp], #16 446 ret 447endfunc cortex_a710_errata_report 448#endif 449 450func cortex_a710_reset_func 451 mov x19, x30 452 453 /* Disable speculative loads */ 454 msr SSBS, xzr 455 456 bl cpu_get_rev_var 457 mov x18, x0 458 459#if ERRATA_DSU_2313941 460 bl errata_dsu_2313941_wa 461#endif 462 463#if ERRATA_A710_1987031 464 mov x0, x18 465 bl errata_a710_1987031_wa 466#endif 467 468#if ERRATA_A710_2081180 469 mov x0, x18 470 bl errata_a710_2081180_wa 471#endif 472 473#if ERRATA_A710_2055002 474 mov x0, x18 475 bl errata_a710_2055002_wa 476#endif 477 478#if ERRATA_A710_2017096 479 mov x0, x18 480 bl errata_a710_2017096_wa 481#endif 482 483#if ERRATA_A710_2083908 484 mov x0, x18 485 bl errata_a710_2083908_wa 486#endif 487 488#if ERRATA_A710_2058056 489 mov x0, x18 490 bl errata_a710_2058056_wa 491#endif 492 493#if ERRATA_A710_2267065 494 mov x0, x18 495 bl errata_a710_2267065_wa 496#endif 497 498#if ERRATA_A710_2136059 499 mov x0, x18 500 bl errata_a710_2136059_wa 501#endif 502 503#if ERRATA_A710_2282622 504 mov x0, x18 505 bl errata_a710_2282622_wa 506#endif 507 508#if ERRATA_A710_2371105 509 mov x0, x18 510 bl errata_a710_2371105_wa 511#endif 512 513#if IMAGE_BL31 && WORKAROUND_CVE_2022_23960 514 /* 515 * The Cortex-A710 generic vectors are overridden to apply errata 516 * mitigation on exception entry from lower ELs. 517 */ 518 adr x0, wa_cve_vbar_cortex_a710 519 msr vbar_el3, x0 520#endif /* IMAGE_BL31 && WORKAROUND_CVE_2022_23960 */ 521 522 isb 523 ret x19 524endfunc cortex_a710_reset_func 525 526 /* --------------------------------------------- 527 * This function provides Cortex-A710 specific 528 * register information for crash reporting. 529 * It needs to return with x6 pointing to 530 * a list of register names in ascii and 531 * x8 - x15 having values of registers to be 532 * reported. 533 * --------------------------------------------- 534 */ 535.section .rodata.cortex_a710_regs, "aS" 536cortex_a710_regs: /* The ascii list of register names to be reported */ 537 .asciz "cpuectlr_el1", "" 538 539func cortex_a710_cpu_reg_dump 540 adr x6, cortex_a710_regs 541 mrs x8, CORTEX_A710_CPUECTLR_EL1 542 ret 543endfunc cortex_a710_cpu_reg_dump 544 545declare_cpu_ops cortex_a710, CORTEX_A710_MIDR, \ 546 cortex_a710_reset_func, \ 547 cortex_a710_core_pwr_dwn 548