xref: /rk3399_ARM-atf/lib/cpus/aarch64/c1_ultra.S (revision 3ed88f1d52a2e047cee8dad0de7d0b0bf1797131)
1/*
2 * Copyright (c) 2023-2025, 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 <c1_ultra.h>
10#include <common/bl_common.h>
11#include <cpu_macros.S>
12
13#include <plat_macros.S>
14
15/* Hardware handled coherency */
16#if HW_ASSISTED_COHERENCY == 0
17#error "Arm C1-Ultra 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 "Arm C1-Ultra supports only AArch64. Compile with CTX_INCLUDE_AARCH32_REGS=0"
23#endif
24
25#if ERRATA_SME_POWER_DOWN == 0
26#error "Arm C1-Ultra needs ERRATA_SME_POWER_DOWN=1 to powerdown correctly"
27#endif
28
29cpu_reset_prologue c1_ultra
30
31	/* -------------------------------------------------------------
32	 * CVE-2024-7881 is mitigated for C1-Ultra using erratum 3651221
33	 * workaround by disabling the affected prefetcher setting
34	 * CPUACTLR6_EL1[41].
35	 * -------------------------------------------------------------
36	 */
37workaround_reset_start c1_ultra, CVE(2024, 7881), WORKAROUND_CVE_2024_7881
38	sysreg_bit_set C1_ULTRA_IMP_CPUACTLR6_EL1, BIT(41)
39workaround_reset_end c1_ultra, CVE(2024, 7881)
40
41check_erratum_ls c1_ultra, CVE(2024, 7881), CPU_REV(0, 0)
42
43workaround_runtime_start c1_ultra, ERRATUM(3324333), ERRATA_C1ULTRA_3324333
44	speculation_barrier
45workaround_runtime_end c1_ultra, ERRATUM(3324333)
46
47check_erratum_ls c1_ultra, ERRATUM(3324333), CPU_REV(0, 0)
48
49workaround_reset_start c1_ultra, ERRATUM(3502731), ERRATA_C1ULTRA_3502731
50	sysreg_bit_set C1_ULTRA_IMP_CPUACTLR4_EL1, BIT(23)
51workaround_reset_end c1_ultra, ERRATUM(3502731)
52
53check_erratum_ls c1_ultra, ERRATUM(3502731), CPU_REV(0, 0)
54
55workaround_reset_start c1_ultra, ERRATUM(3651221), ERRATA_C1ULTRA_3651221
56	sysreg_bit_set C1_ULTRA_IMP_CPUACTLR6_EL1, BIT(41)
57workaround_reset_end c1_ultra, ERRATUM(3651221)
58
59check_erratum_ls c1_ultra, ERRATUM(3651221), CPU_REV(0, 0)
60
61.global check_erratum_c1_ultra_3658374
62add_erratum_entry c1_ultra, ERRATUM(3658374), ERRATA_C1ULTRA_3658374
63check_erratum_ls c1_ultra, ERRATUM(3658374), CPU_REV(1, 0)
64
65workaround_reset_start c1_ultra, ERRATUM(3684152), ERRATA_C1ULTRA_3684152
66	sysreg_bitfield_insert C1_ULTRA_IMP_CPUACTLR_EL1, C1_ULTRA_IMP_CPUACTLR_EL1_LOAD_BIT, \
67	C1_ULTRA_IMP_CPUACTLR_EL1_LOAD_SHIFT, C1_ULTRA_IMP_CPUACTLR_EL1_LOAD_WIDTH
68workaround_reset_end c1_ultra, ERRATUM(3684152)
69
70check_erratum_ls c1_ultra, ERRATUM(3684152), CPU_REV(0, 0)
71
72workaround_reset_start c1_ultra, ERRATUM(3705939), ERRATA_C1ULTRA_3705939
73	sysreg_bit_set C1_ULTRA_IMP_CPUACTLR_EL1, BIT(48)
74workaround_reset_end c1_ultra, ERRATUM(3705939)
75
76check_erratum_ls c1_ultra, ERRATUM(3705939), CPU_REV(1, 0)
77
78workaround_reset_start c1_ultra, ERRATUM(3815514), ERRATA_C1ULTRA_3815514
79	sysreg_bit_set C1_ULTRA_IMP_CPUACTLR5_EL1, BIT(13)
80workaround_reset_end c1_ultra, ERRATUM(3815514)
81
82check_erratum_ls c1_ultra, ERRATUM(3815514), CPU_REV(1, 0)
83
84workaround_reset_start c1_ultra, ERRATUM(3865171), ERRATA_C1ULTRA_3865171
85	sysreg_bit_set C1_ULTRA_IMP_CPUACTLR2_EL1, BIT(22)
86workaround_reset_end c1_ultra, ERRATUM(3865171)
87
88check_erratum_ls c1_ultra, ERRATUM(3865171), CPU_REV(1, 0)
89
90workaround_reset_start c1_ultra, ERRATUM(3926381), ERRATA_C1ULTRA_3926381
91	/* Convert WFx to NOP */
92	ldr x0,=0x0
93	msr C1_ULTRA_IMP_CPUPSELR_EL3, x0
94	ldr x0,=0xD503205f
95	msr C1_ULTRA_IMP_CPUPOR_EL3, x0
96	ldr x0,=0xFFFFFFDF
97	msr C1_ULTRA_IMP_CPUPMR_EL3, x0
98	ldr x0,=0x1000002043ff
99	msr C1_ULTRA_IMP_CPUPCR_EL3, x0
100	/* Convert WFxT to NOP */
101	ldr x0,=0x1
102	msr C1_ULTRA_IMP_CPUPSELR_EL3, x0
103	ldr x0,=0xD5031000
104	msr C1_ULTRA_IMP_CPUPOR_EL3, x0
105	ldr x0,=0xFFFFFFC0
106	msr C1_ULTRA_IMP_CPUPMR_EL3, x0
107	ldr x0,=0x1000002043ff
108	msr C1_ULTRA_IMP_CPUPCR_EL3, x0
109	isb
110workaround_reset_end c1_ultra, ERRATUM(3926381)
111
112check_erratum_range c1_ultra, ERRATUM(3926381), CPU_REV(1, 0), CPU_REV(1, 0)
113
114workaround_reset_start c1_ultra, ERRATUM(4102704), ERRATA_C1ULTRA_4102704
115	sysreg_bit_set C1_ULTRA_IMP_CPUACTLR4_EL1, BIT(23)
116workaround_reset_end c1_ultra, ERRATUM(4102704)
117
118check_erratum_ls c1_ultra, ERRATUM(4102704), CPU_REV(1, 0)
119
120cpu_reset_func_start c1_ultra
121	/* ----------------------------------------------------
122	 * Disable speculative loads
123	 * ----------------------------------------------------
124	 */
125	msr	SSBS, xzr
126	apply_erratum c1_ultra, ERRATUM(3324333), ERRATA_C1ULTRA_3324333
127	/* model bug: not cleared on reset */
128	sysreg_bit_clear C1_ULTRA_IMP_CPUPWRCTLR_EL1, \
129		C1_ULTRA_IMP_CPUPWRCTLR_EL1_CORE_PWRDN_EN_BIT
130	enable_mpmm
131cpu_reset_func_end c1_ultra
132
133func c1_ultra_core_pwr_dwn
134	/* ---------------------------------------------------
135	 * Flip CPU power down bit in power control register.
136	 * It will be set on powerdown and cleared on wakeup
137	 * ---------------------------------------------------
138	 */
139	sysreg_bit_toggle C1_ULTRA_IMP_CPUPWRCTLR_EL1, \
140		C1_ULTRA_IMP_CPUPWRCTLR_EL1_CORE_PWRDN_EN_BIT
141	isb
142	signal_pabandon_handled
143	ret
144endfunc c1_ultra_core_pwr_dwn
145
146.section .rodata.c1_ultra_regs, "aS"
147c1_ultra_regs: /* The ASCII list of register names to be reported */
148	.asciz	"cpuectlr_el1", ""
149
150func c1_ultra_cpu_reg_dump
151	adr 	x6, c1_ultra_regs
152	mrs	x8, C1_ULTRA_IMP_CPUECTLR_EL1
153	ret
154endfunc c1_ultra_cpu_reg_dump
155
156declare_cpu_ops c1_ultra, C1_ULTRA_MIDR, \
157	c1_ultra_reset_func, \
158	c1_ultra_core_pwr_dwn
159