24class cpu_arm_host :
public QemuCpuArm
27 int get_psci_conduit_val()
const
29 if (p_psci_conduit.get_value() ==
"disabled") {
31 }
else if (p_psci_conduit.get_value() ==
"smc") {
33 }
else if (p_psci_conduit.get_value() ==
"hvc") {
41 void add_exclusive_ext(TlmPayload& pl)
44 ext->add_hop(m_cpu.get_index());
45 pl.set_extension(ext);
48 static uint64_t extract_data_from_payload(
const TlmPayload& pl)
50 uint8_t* ptr = pl.get_data_ptr() + pl.get_data_length() - 1;
54 assert(pl.get_data_length() <= 8);
56 while (ptr >= pl.get_data_ptr()) {
57 ret = (ret << 8) | *(ptr--);
64 cci::cci_param<unsigned int> p_mp_affinity;
65 cci::cci_param<bool> p_start_powered_off;
66 cci::cci_param<std::string> p_psci_conduit;
67 cci::cci_param<uint64_t> p_rvbar;
68 cci::cci_param<uint64_t> p_cntfrq_hz;
81 cpu_arm_host(
const sc_core::sc_module_name& name, sc_core::sc_object* o)
85 cpu_arm_host(
const sc_core::sc_module_name& name,
QemuInstance& inst)
86 : QemuCpuArm(name, inst,
"host-arm")
87 , p_mp_affinity(
"mp_affinity", 0,
"Multi-processor affinity value")
88 , p_start_powered_off(
"start_powered_off",
false,
89 "Start and reset the CPU "
90 "in powered-off state")
91 , p_psci_conduit(
"psci_conduit",
"disabled",
92 "Set the QEMU PSCI conduit: "
93 "disabled->no conduit, "
94 "hvc->through hvc call, "
95 "smc->through smc call")
96 , p_rvbar(
"rvbar", 0ull,
"Reset vector base address register value")
97 , p_cntfrq_hz(
"cntfrq_hz", 0ull,
"CPU Generic Timer CNTFRQ in Hz")
103 , irq_timer_phys_out(
"irq_timer_phys_out")
104 , irq_timer_virt_out(
"irq_timer_virt_out")
105 , irq_timer_hyp_out(
"irq_timer_hyp_out")
106 , irq_timer_sec_out(
"irq_timer_sec_out")
107 , irq_maintenance_out(
"gicv3_maintenance_interrupt")
108 , irq_pmu_out(
"pmu_interrupt")
110 m_external_ev |= irq_in->default_event();
111 m_external_ev |= fiq_in->default_event();
112 m_external_ev |= virq_in->default_event();
113 m_external_ev |= vfiq_in->default_event();
116 void before_end_of_elaboration()
override
118 QemuCpuArm::before_end_of_elaboration();
121 cpu.set_aarch64_mode(
true);
123 if (!p_mp_affinity.is_default_value()) {
124 cpu.set_prop_int(
"mp-affinity", p_mp_affinity);
127 cpu.set_prop_bool(
"start-powered-off", p_start_powered_off);
128 cpu.set_prop_int(
"psci-conduit", get_psci_conduit_val());
130 cpu.set_prop_int(
"rvbar", p_rvbar);
131 if (!p_cntfrq_hz.is_default_value()) {
132 cpu.set_prop_int(
"cntfrq", p_cntfrq_hz);
136 void end_of_elaboration()
override
138 QemuCpuArm::end_of_elaboration();
140 irq_in.init(m_dev, 0);
141 fiq_in.init(m_dev, 1);
142 virq_in.init(m_dev, 2);
143 vfiq_in.init(m_dev, 3);
145 irq_timer_phys_out.init(m_dev, 0);
146 irq_timer_virt_out.init(m_dev, 1);
147 irq_timer_hyp_out.init(m_dev, 2);
148 irq_timer_sec_out.init(m_dev, 3);
149 irq_maintenance_out.init_named(m_dev,
"gicv3-maintenance-interrupt", 0);
150 irq_pmu_out.init_named(m_dev,
"pmu-interrupt", 0);
153 void initiator_customize_tlm_payload(TlmPayload& payload)
override
158 QemuCpu::initiator_customize_tlm_payload(payload);
160 addr = payload.get_address();
162 if (!arm_cpu.is_in_exclusive_context()) {
166 if (addr != arm_cpu.get_exclusive_addr()) {
176 add_exclusive_ext(payload);
179 void initiator_tidy_tlm_payload(TlmPayload& payload)
override
186 QemuCpu::initiator_tidy_tlm_payload(payload);
188 payload.get_extension(ext);
189 bool exit_tb =
false;
191 if (ext ==
nullptr) {
195 if (payload.get_command() == TLM_WRITE_COMMAND) {
196 auto sta = ext->get_exclusive_store_status();
199 if (sta == ExclusiveAccessTlmExtension::EXCLUSIVE_STORE_FAILURE) {
209 uint64_t exclusive_val = arm_cpu.get_exclusive_val();
210 uint64_t mem_val = extract_data_from_payload(payload);
211 uint64_t mask = (payload.get_data_length() == 8) ? -1 : (1 << (8 * payload.get_data_length())) - 1;
213 if ((exclusive_val & mask) == mem_val) {
214 arm_cpu.set_exclusive_val(~exclusive_val);
229 payload.set_response_status(TLM_OK_RESPONSE);
233 payload.clear_extension(ext);
243 m_cpu.exit_loop_from_io();