qualcomm/qbox
Loading...
Searching...
No Matches
cortex-a76.h
1/*
2 * This file is part of libqbox
3 * Copyright (c) 2022-2023 Qualcomm Innovation Center, Inc. All Rights Reserved.
4 * Author: GreenSocs 2020
5 *
6 * SPDX-License-Identifier: BSD-3-Clause
7 */
8
9#pragma once
10
11#include <string>
12
13#include <cci_configuration>
14
15#include <libqemu-cxx/target/aarch64.h>
16
17#include <tlm-extensions/exclusive-access.h>
18#include <module_factory_registery.h>
19
20#include <arm.h>
21#include <ports/qemu-initiator-signal-socket.h>
22#include <ports/qemu-target-signal-socket.h>
23#include <qemu-instance.h>
24
25class cpu_arm_cortexA76 : public QemuCpuArm
26{
27protected:
28 int get_psci_conduit_val() const
29 {
30 if (p_psci_conduit.get_value() == "disabled") {
31 return 0;
32 } else if (p_psci_conduit.get_value() == "smc") {
33 return 1;
34 } else if (p_psci_conduit.get_value() == "hvc") {
35 return 2;
36 } else {
37 /* TODO: report warning */
38 return 0;
39 }
40 }
41
42 void add_exclusive_ext(TlmPayload& pl)
43 {
45 ext->add_hop(m_cpu.get_index());
46 pl.set_extension(ext);
47 }
48
49 static uint64_t extract_data_from_payload(const TlmPayload& pl)
50 {
51 uint8_t* ptr = pl.get_data_ptr() + pl.get_data_length() - 1;
52 uint64_t ret = 0;
53
54 /* QEMU never accesses more than 64 bits at the same time */
55 assert(pl.get_data_length() <= 8);
56
57 while (ptr >= pl.get_data_ptr()) {
58 ret = (ret << 8) | *(ptr--);
59 }
60
61 return ret;
62 }
63
64public:
65 cci::cci_param<unsigned int> p_mp_affinity;
66 cci::cci_param<bool> p_has_el2;
67 cci::cci_param<bool> p_has_el3;
68 cci::cci_param<bool> p_start_powered_off;
69 cci::cci_param<std::string> p_psci_conduit;
70 cci::cci_param<uint64_t> p_rvbar;
71 cci::cci_param<uint64_t> p_cntfrq_hz;
72
77
78 QemuInitiatorSignalSocket irq_timer_phys_out;
79 QemuInitiatorSignalSocket irq_timer_virt_out;
80 QemuInitiatorSignalSocket irq_timer_hyp_out;
81 QemuInitiatorSignalSocket irq_timer_sec_out;
82 QemuInitiatorSignalSocket irq_maintenance_out;
83 QemuInitiatorSignalSocket irq_pmu_out;
84 cpu_arm_cortexA76(const sc_core::sc_module_name& name, sc_core::sc_object* o)
85 : cpu_arm_cortexA76(name, *(dynamic_cast<QemuInstance*>(o)))
86 {
87 }
88 cpu_arm_cortexA76(const sc_core::sc_module_name& name, QemuInstance& inst)
89 : QemuCpuArm(name, inst, "cortex-a76-arm")
90 , p_mp_affinity("mp_affinity", 0, "Multi-processor affinity value")
91 , p_has_el2("has_el2", true, "ARM virtualization extensions")
92 , p_has_el3("has_el3", true, "ARM secure-mode extensions")
93 , p_start_powered_off("start_powered_off", false,
94 "Start and reset the CPU "
95 "in powered-off state")
96 , p_psci_conduit("psci_conduit", "disabled",
97 "Set the QEMU PSCI conduit: "
98 "disabled->no conduit, "
99 "hvc->through hvc call, "
100 "smc->through smc call")
101 , p_rvbar("rvbar", 0ull, "Reset vector base address register value")
102 , p_cntfrq_hz("cntfrq_hz", 0ull, "CPU Generic Timer CNTFRQ in Hz")
103
104 , irq_in("irq_in")
105 , fiq_in("fiq_in")
106 , virq_in("virq_in")
107 , vfiq_in("vfiq_in")
108 , irq_timer_phys_out("irq_timer_phys_out")
109 , irq_timer_virt_out("irq_timer_virt_out")
110 , irq_timer_hyp_out("irq_timer_hyp_out")
111 , irq_timer_sec_out("irq_timer_sec_out")
112 , irq_maintenance_out("gicv3_maintenance_interrupt")
113 , irq_pmu_out("pmu_interrupt")
114 {
115 m_external_ev |= irq_in->default_event();
116 m_external_ev |= fiq_in->default_event();
117 m_external_ev |= virq_in->default_event();
118 m_external_ev |= vfiq_in->default_event();
119 }
120
121 void before_end_of_elaboration() override
122 {
123 QemuCpuArm::before_end_of_elaboration();
124
125 qemu::CpuAarch64 cpu(m_cpu);
126 cpu.set_aarch64_mode(true);
127
128 if (!p_mp_affinity.is_default_value()) {
129 cpu.set_prop_int("mp-affinity", p_mp_affinity);
130 }
131 cpu.set_prop_bool("has_el2", p_has_el2);
132 cpu.set_prop_bool("has_el3", p_has_el3);
133 init_secure_memory(p_has_el3.get_value());
134
135 cpu.set_prop_bool("start-powered-off", p_start_powered_off);
136 cpu.set_prop_int("psci-conduit", get_psci_conduit_val());
137
138 cpu.set_prop_int("rvbar", p_rvbar);
139 if (!p_cntfrq_hz.is_default_value()) {
140 cpu.set_prop_int("cntfrq", p_cntfrq_hz);
141 }
142 }
143
144 void end_of_elaboration() override
145 {
146 QemuCpuArm::end_of_elaboration();
147
148 irq_in.init(m_dev, 0);
149 fiq_in.init(m_dev, 1);
150 virq_in.init(m_dev, 2);
151 vfiq_in.init(m_dev, 3);
152
153 irq_timer_phys_out.init(m_dev, 0);
154 irq_timer_virt_out.init(m_dev, 1);
155 irq_timer_hyp_out.init(m_dev, 2);
156 irq_timer_sec_out.init(m_dev, 3);
157 irq_maintenance_out.init_named(m_dev, "gicv3-maintenance-interrupt", 0);
158 irq_pmu_out.init_named(m_dev, "pmu-interrupt", 0);
159 }
160
161 void initiator_customize_tlm_payload(TlmPayload& payload) override
162 {
163 uint64_t addr;
164 qemu::CpuAarch64 arm_cpu(m_cpu);
165
166 QemuCpu::initiator_customize_tlm_payload(payload);
167
168 addr = payload.get_address();
169
170 if (!arm_cpu.is_in_exclusive_context()) {
171 return;
172 }
173
174 if (addr != arm_cpu.get_exclusive_addr()) {
175 return;
176 }
177
178 /*
179 * We are in the load/store pair of the cmpxchg of the exclusive store
180 * implementation. Add the exclusive access extension to lock the
181 * memory and check for exclusive store success in
182 * initiator_tidy_tlm_payload.
183 */
184 add_exclusive_ext(payload);
185 }
186
187 void initiator_tidy_tlm_payload(TlmPayload& payload) override
188 {
189 using namespace tlm;
190
192 qemu::CpuAarch64 arm_cpu(m_cpu);
193
194 QemuCpu::initiator_tidy_tlm_payload(payload);
195
196 payload.get_extension(ext);
197 bool exit_tb = false;
198
199 if (ext == nullptr) {
200 return;
201 }
202
203 if (payload.get_command() == TLM_WRITE_COMMAND) {
204 auto sta = ext->get_exclusive_store_status();
205
206 /* We just executed an exclusive store. Check its status */
207 if (sta == ExclusiveAccessTlmExtension::EXCLUSIVE_STORE_FAILURE) {
208 /*
209 * To actually make the exclusive store fails, we need to trick
210 * QEMU into thinking that the value at the store address has
211 * changed compared to when it did the corresponding ldrex (due
212 * to the way exclusive loads/stores are implemented in QEMU).
213 * For this, we simply smash the exclusive_val field of the ARM
214 * CPU state in case it currently matches with the value in
215 * memory.
216 */
217 uint64_t exclusive_val = arm_cpu.get_exclusive_val();
218 uint64_t mem_val = extract_data_from_payload(payload);
219 uint64_t mask = (payload.get_data_length() == 8) ? -1 : (1 << (8 * payload.get_data_length())) - 1;
220
221 if ((exclusive_val & mask) == mem_val) {
222 arm_cpu.set_exclusive_val(~exclusive_val);
223
224 /*
225 * Exit the execution loop to force QEMU to re-do the
226 * store. This is necessary because we modify exclusive_val
227 * in the CPU env. This field is also mapped on a TCG
228 * global. Even though the qemu_st_ixx TCG opcs are marked
229 * TCG_OPF_CALL_CLOBBER, TCG does not reload the global
230 * after the store as I thought it would do. To force this,
231 * we exit the TB here so that the new exclusive_val value
232 * will be taken into account on the next execution.
233 */
234 exit_tb = true;
235 }
236
237 payload.set_response_status(TLM_OK_RESPONSE);
238 }
239 }
240
241 payload.clear_extension(ext);
242 delete ext;
243
244 if (exit_tb) {
245 /*
246 * FIXME: exiting the CPU loop from here is a bit violent. The
247 * caller won't have a chance to destruct its stack objects. The
248 * object model should be reworked to allow exiting the loop
249 * cleanly.
250 */
251 m_cpu.exit_loop_from_io();
252 }
253 }
254};
255
256extern "C" void module_register();
Exclusive load/store TLM extension.
Definition exclusive-access.h:36
A QEMU output GPIO exposed as a InitiatorSignalSocket<bool>.
Definition qemu-initiator-signal-socket.h:40
This class encapsulates a libqemu-cxx qemu::LibQemu instance. It handles QEMU parameters and instance...
Definition qemu-instance.h:89
A QEMU input GPIO exposed as a TargetSignalSocket<bool>.
Definition qemu-target-signal-socket.h:29
Definition aarch64.h:40