Debian Codegraph @

lib/cpus/aarch64/rainier.S

raw
1 /*
2 * Copyright (c) 2020-2024, 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 <context.h>
10 #include <cpu_macros.S>
11 #include <cpuamu.h>
12 #include <rainier.h>
13
14 /* Hardware handled coherency */
15 #if HW_ASSISTED_COHERENCY == 0
16 #error "Rainier CPU 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 "Rainier CPU supports only AArch64. Compile with CTX_INCLUDE_AARCH32_REGS=0"
22 #endif
23
24 /* --------------------------------------------------
25 * Disable speculative loads if Rainier supports
26 * SSBS.
27 *
28 * Shall clobber: x0.
29 * --------------------------------------------------
30 */
31 func rainier_disable_speculative_loads
32 /* Check if the PE implements SSBS */
33 mrs x0, id_aa64pfr1_el1
34 tst x0, #(ID_AA64PFR1_EL1_SSBS_MASK << ID_AA64PFR1_EL1_SSBS_SHIFT)
35 b.eq 1f
36
37 /* Disable speculative loads */
38 msr SSBS, xzr
39
40 1:
41 ret
42 endfunc rainier_disable_speculative_loads
43
44 /* Rainier R0P0 is based on Neoverse N1 R4P0. */
45 workaround_reset_start rainier, ERRATUM(1868343), ERRATA_N1_1868343
46 sysreg_bit_set RAINIER_CPUACTLR_EL1, RAINIER_CPUACTLR_EL1_BIT_13
47 workaround_reset_end rainier, ERRATUM(1868343)
48
49 check_erratum_ls rainier, ERRATUM(1868343), CPU_REV(0, 0)
50
51 cpu_reset_func_start rainier
52 bl rainier_disable_speculative_loads
53 /* Forces all cacheable atomic instructions to be near */
54 sysreg_bit_set RAINIER_CPUACTLR2_EL1, RAINIER_CPUACTLR2_EL1_BIT_2
55
56 #if ENABLE_FEAT_AMU
57 /* Make sure accesses from EL0/EL1 and EL2 are not trapped to EL3 */
58 sysreg_bit_set actlr_el3, RAINIER_ACTLR_AMEN_BIT
59
60 /* Make sure accesses from EL0/EL1 are not trapped to EL2 */
61 sysreg_bit_set actlr_el2, RAINIER_ACTLR_AMEN_BIT
62
63 /* Enable group0 counters */
64 mov x0, #RAINIER_AMU_GROUP0_MASK
65 msr CPUAMCNTENSET_EL0, x0
66 #endif
67 cpu_reset_func_end rainier
68
69 /* ---------------------------------------------
70 * HW will do the cache maintenance while powering down
71 * ---------------------------------------------
72 */
73 func rainier_core_pwr_dwn
74 /* ---------------------------------------------
75 * Enable CPU power down bit in power control register
76 * ---------------------------------------------
77 */
78 sysreg_bit_set RAINIER_CPUPWRCTLR_EL1, RAINIER_CORE_PWRDN_EN_MASK
79 isb
80 ret
81 endfunc rainier_core_pwr_dwn
82
83 /* ---------------------------------------------
84 * This function provides Rainier specific
85 * register information for crash reporting.
86 * It needs to return with x6 pointing to
87 * a list of register names in ascii and
88 * x8 - x15 having values of registers to be
89 * reported.
90 * ---------------------------------------------
91 */
92 .section .rodata.rainier_regs, "aS"
93 rainier_regs: /* The ascii list of register names to be reported */
94 .asciz "cpuectlr_el1", ""
95
96 func rainier_cpu_reg_dump
97 adr x6, rainier_regs
98 mrs x8, RAINIER_CPUECTLR_EL1
99 ret
100 endfunc rainier_cpu_reg_dump
101
102 declare_cpu_ops rainier, RAINIER_MIDR, \
103 rainier_reset_func, \
104 rainier_core_pwr_dwn