24class cpu_arm_cortexA55 :
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_has_el2;
66 cci::cci_param<bool> p_has_el3;
67 cci::cci_param<bool> p_start_powered_off;
68 cci::cci_param<std::string> p_psci_conduit;
69 cci::cci_param<uint64_t> p_rvbar;
70 cci::cci_param<uint64_t> p_cntfrq_hz;
82 cpu_arm_cortexA55(
const sc_core::sc_module_name& name, sc_core::sc_object* o)
83 : cpu_arm_cortexA55(name, *(
dynamic_cast<QemuInstance*
>(o)))
86 cpu_arm_cortexA55(sc_core::sc_module_name name,
QemuInstance& inst)
87 : QemuCpuArm(name, inst,
"cortex-a55-arm")
88 , p_mp_affinity(
"mp_affinity", 0,
"Multi-processor affinity value")
89 , p_has_el2(
"has_el2",
true,
"ARM virtualization extensions")
90 , p_has_el3(
"has_el3",
true,
"ARM secure-mode extensions")
91 , p_start_powered_off(
"start_powered_off",
false,
92 "Start and reset the CPU "
93 "in powered-off state")
94 , p_psci_conduit(
"psci_conduit",
"disabled",
95 "Set the QEMU PSCI conduit: "
96 "disabled->no conduit, "
97 "hvc->through hvc call, "
98 "smc->through smc call")
99 , p_rvbar(
"rvbar", 0ull,
"Reset vector base address register value")
100 , p_cntfrq_hz(
"cntfrq_hz", 0ull,
"CPU Generic Timer CNTFRQ in Hz")
106 , irq_timer_phys_out(
"irq_timer_phys_out")
107 , irq_timer_virt_out(
"irq_timer_virt_out")
108 , irq_timer_hyp_out(
"irq_timer_hyp_out")
109 , irq_timer_sec_out(
"irq_timer_sec_out")
111 m_external_ev |= irq_in->default_event();
112 m_external_ev |= fiq_in->default_event();
113 m_external_ev |= virq_in->default_event();
114 m_external_ev |= vfiq_in->default_event();
117 void before_end_of_elaboration()
override
119 QemuCpuArm::before_end_of_elaboration();
122 cpu.set_aarch64_mode(
true);
124 if (!p_mp_affinity.is_default_value()) {
125 cpu.set_prop_int(
"mp-affinity", p_mp_affinity);
127 cpu.set_prop_bool(
"has_el2", p_has_el2);
128 cpu.set_prop_bool(
"has_el3", p_has_el3);
129 init_secure_memory(p_has_el3.get_value());
131 cpu.set_prop_bool(
"start-powered-off", p_start_powered_off);
132 cpu.set_prop_int(
"psci-conduit", get_psci_conduit_val());
134 cpu.set_prop_int(
"rvbar", p_rvbar);
135 if (!p_cntfrq_hz.is_default_value()) {
136 cpu.set_prop_int(
"cntfrq", p_cntfrq_hz);
140 void end_of_elaboration()
override
142 QemuCpuArm::end_of_elaboration();
144 irq_in.init(m_dev, 0);
145 fiq_in.init(m_dev, 1);
146 virq_in.init(m_dev, 2);
147 vfiq_in.init(m_dev, 3);
149 irq_timer_phys_out.init(m_dev, 0);
150 irq_timer_virt_out.init(m_dev, 1);
151 irq_timer_hyp_out.init(m_dev, 2);
152 irq_timer_sec_out.init(m_dev, 3);
155 void initiator_customize_tlm_payload(TlmPayload& payload)
override
160 QemuCpu::initiator_customize_tlm_payload(payload);
162 addr = payload.get_address();
164 if (!arm_cpu.is_in_exclusive_context()) {
168 if (addr != arm_cpu.get_exclusive_addr()) {
178 add_exclusive_ext(payload);
181 void initiator_tidy_tlm_payload(TlmPayload& payload)
override
188 QemuCpu::initiator_tidy_tlm_payload(payload);
190 payload.get_extension(ext);
191 bool exit_tb =
false;
193 if (ext ==
nullptr) {
197 if (payload.get_command() == TLM_WRITE_COMMAND) {
198 auto sta = ext->get_exclusive_store_status();
201 if (sta == ExclusiveAccessTlmExtension::EXCLUSIVE_STORE_FAILURE) {
211 uint64_t exclusive_val = arm_cpu.get_exclusive_val();
212 uint64_t mem_val = extract_data_from_payload(payload);
213 uint64_t mask = (payload.get_data_length() == 8) ? -1 : (1 << (8 * payload.get_data_length())) - 1;
215 if ((exclusive_val & mask) == mem_val) {
216 arm_cpu.set_exclusive_val(~exclusive_val);
231 payload.set_response_status(TLM_OK_RESPONSE);
235 payload.clear_extension(ext);
245 m_cpu.exit_loop_from_io();