diff --git a/riscv/triggers.cc b/riscv/triggers.cc index b2b815dad7..5a2d18b20c 100644 --- a/riscv/triggers.cc +++ b/riscv/triggers.cc @@ -305,7 +305,7 @@ void mcontrol6_t::tdata1_write(processor_t * const proc, const reg_t val, const load = get_field(val, CSR_MCONTROL6_LOAD); } -std::optional icount_t::detect_icount_match(processor_t * const proc) noexcept +std::optional icount_t::detect_icount_fire(processor_t * const proc) noexcept { if (!common_match(proc) || !allow_action(proc->get_state())) return std::nullopt; @@ -317,13 +317,19 @@ std::optional icount_t::detect_icount_match(processor_t * const ret = match_result_t(TIMING_BEFORE, action); } - if (count >= 1 && (ret == std::nullopt || action != MCONTROL_ACTION_DEBUG_MODE)) { + return ret; +} + +void icount_t::detect_icount_decrement(processor_t * const proc) noexcept +{ + if (!common_match(proc) || !allow_action(proc->get_state())) + return; + + if (count >= 1) { if (count == 1) pending = 1; count = count - 1; } - - return ret; } reg_t icount_t::tdata1_read(const processor_t * const proc) const noexcept @@ -588,10 +594,13 @@ std::optional module_t::detect_icount_match() noexcept std::optional ret = std::nullopt; for (auto trigger: triggers) { - auto result = trigger->detect_icount_match(proc); + auto result = trigger->detect_icount_fire(proc); if (result.has_value() && (!ret.has_value() || ret->action < result->action)) ret = result; } + if (ret == std::nullopt || ret->action != MCONTROL_ACTION_DEBUG_MODE) + for (auto trigger: triggers) + trigger->detect_icount_decrement(proc); return ret; } diff --git a/riscv/triggers.h b/riscv/triggers.h index 0bf6097a99..6f00122c6a 100644 --- a/riscv/triggers.h +++ b/riscv/triggers.h @@ -85,7 +85,8 @@ class trigger_t { virtual std::optional detect_memory_access_match(processor_t UNUSED * const proc, operation_t UNUSED operation, reg_t UNUSED address, std::optional UNUSED data) noexcept { return std::nullopt; } - virtual std::optional detect_icount_match(processor_t UNUSED * const proc) { return std::nullopt; } + virtual std::optional detect_icount_fire(processor_t UNUSED * const proc) { return std::nullopt; } + virtual void detect_icount_decrement(processor_t UNUSED * const proc) {} virtual std::optional detect_trap_match(processor_t UNUSED * const proc, const trap_t UNUSED & t) noexcept { return std::nullopt; } protected: @@ -248,7 +249,8 @@ class icount_t : public trigger_t { virtual bool icount_check_needed() const override { return count > 0 || pending; } virtual void stash_read_values() override; - virtual std::optional detect_icount_match(processor_t * const proc) noexcept override; + virtual std::optional detect_icount_fire(processor_t * const proc) noexcept override; + virtual void detect_icount_decrement(processor_t * const proc) noexcept override; private: bool dmode = false;