Ashin Walpola
d107534eb2
obu-firmware builds against the vanetza-idf C-ITS library, which until now came from the colleague's microbu-esp32c5 tree beside the repository and was not tracked here, so a clone of this repository could not build the firmware it ships. The library alone is now part of obu-firmware, as obu-firmware/external/vanetza-idf: their external/vanetza-idf at commit cf4b99f, unchanged (9775 files; see its PROVENANCE.md). CMake takes it from there by default; -DVANETZA_IDF_DIR still points the build elsewhere. The rest of the colleague's tree (their own VAM firmware, PKI tooling, station-link Python tools, the V2X2MAP bridge) stays out of this repository and gitignored; nothing is pushed to their repository. NOTES.md, docs/06, TODO.md and the pcap verifier's usage line point at the new location.
90 lines
2.1 KiB
C++
90 lines
2.1 KiB
C++
#include "manual_runtime.hpp"
|
|
#include <cassert>
|
|
|
|
namespace vanetza
|
|
{
|
|
|
|
ManualRuntime::ManualRuntime(Clock::time_point init) : m_now(init)
|
|
{
|
|
}
|
|
|
|
void ManualRuntime::schedule(Clock::time_point tp, const Callback& cb, const void* scope)
|
|
{
|
|
m_queue.emplace(queue_type::value_type { tp, cb, scope });
|
|
}
|
|
|
|
void ManualRuntime::schedule(Clock::duration d, const Callback& cb, const void* scope)
|
|
{
|
|
schedule(m_now + d, cb, scope);
|
|
}
|
|
|
|
void ManualRuntime::cancel(const void* scope)
|
|
{
|
|
if (scope) {
|
|
auto scope_match_range = m_queue.get<by_scope>().equal_range(scope);
|
|
m_queue.get<by_scope>().erase(scope_match_range.first, scope_match_range.second);
|
|
}
|
|
}
|
|
|
|
Clock::time_point ManualRuntime::next() const
|
|
{
|
|
Clock::time_point next_tp = Clock::time_point::max();
|
|
if (!m_queue.empty()) {
|
|
next_tp = m_queue.get<by_deadline>().begin()->deadline;
|
|
}
|
|
return next_tp;
|
|
}
|
|
|
|
Clock::time_point ManualRuntime::now() const
|
|
{
|
|
return m_now;
|
|
}
|
|
|
|
void ManualRuntime::trigger(Clock::time_point tp)
|
|
{
|
|
// require monotonic clock
|
|
assert(tp >= m_now);
|
|
m_now = tp;
|
|
trigger();
|
|
}
|
|
|
|
void ManualRuntime::trigger(Clock::duration d)
|
|
{
|
|
m_now += d;
|
|
trigger();
|
|
}
|
|
|
|
void ManualRuntime::trigger()
|
|
{
|
|
// process queue elements separately because callback might modify runtime
|
|
while (!m_queue.empty()) {
|
|
auto top = m_queue.get<by_deadline>().begin();
|
|
const auto deadline = top->deadline; // copy of deadline on purpose (erase before callback)
|
|
if (deadline <= m_now) {
|
|
Callback cb = top->callback;
|
|
m_queue.get<by_deadline>().erase(top);
|
|
// callback invocation has to be last action because it might modify runtime
|
|
cb(deadline);
|
|
} else {
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
|
|
void ManualRuntime::reset(Clock::time_point tp)
|
|
{
|
|
m_now = tp;
|
|
queue_type queue;
|
|
swap(queue, m_queue);
|
|
|
|
// invoke all callbacks once so they can re-schedule
|
|
for (auto& item : queue) {
|
|
const auto& deadline = item.deadline;
|
|
auto& callback = item.callback;
|
|
// callback might modify m_queue
|
|
callback(deadline);
|
|
}
|
|
}
|
|
|
|
} // namespace vanetza
|