Ashin Walpola
0e9525162d
obu-firmware builds against vanetza-idf from microbu-esp32c5/external, but that tree was gitignored, so a clone of this repository could not build the firmware it ships. It is now committed here as ordinary files in its own folder, microbu-esp32c5/: the colleague's commit cf4b99f plus the V2X2MAP bridge's signature verification (--trust) used on the bench. Nothing is fetched from or pushed to the colleague's repository; this repository and its remotes carry everything. The folder's own .gitignore keeps build output, downloaded components and private key material out, as it did there; the committed file set is identical to that repository's tracked files. The ESP32-C5 is still flashed from obu-firmware/, which only takes vanetza-idf from microbu-esp32c5/, so the two stay separate folders. FLASHING.md says how to take a newer version of the colleague's tree (copy it over the folder, rebuild, test, commit).
95 lines
2.1 KiB
C++
95 lines
2.1 KiB
C++
#include "packet_buffer.hpp"
|
|
#include "basic_header.hpp"
|
|
|
|
namespace vanetza
|
|
{
|
|
namespace geonet
|
|
{
|
|
namespace packet_buffer
|
|
{
|
|
|
|
Expiry::Expiry(Clock::time_point now, Clock::duration lifetime) :
|
|
m_buffered_since(now), m_expires_at(now)
|
|
{
|
|
m_expires_at += lifetime;
|
|
}
|
|
|
|
bool Expiry::is_expired(Clock::time_point now) const
|
|
{
|
|
return (m_expires_at < now);
|
|
}
|
|
|
|
} // namespace packet_buffer
|
|
|
|
|
|
PacketBuffer::PacketBuffer(std::size_t capacity) :
|
|
m_capacity(capacity), m_stored(0)
|
|
{
|
|
}
|
|
|
|
bool PacketBuffer::push(data_ptr data, Clock::time_point now)
|
|
{
|
|
assert(data);
|
|
bool pushed = false;
|
|
drop_expired(now);
|
|
if (drop(data->length())) {
|
|
m_stored += data->length();
|
|
m_nodes.push_back(std::make_tuple(
|
|
expiry_type(now, data->reduce_lifetime(Clock::duration::zero())),
|
|
std::move(data)
|
|
));
|
|
pushed = true;
|
|
}
|
|
return pushed;
|
|
}
|
|
|
|
void PacketBuffer::flush(Clock::time_point now)
|
|
{
|
|
decltype(m_nodes) nodes;
|
|
std::swap(m_nodes, nodes);
|
|
m_stored = 0;
|
|
|
|
for (auto& node : nodes) {
|
|
const auto& expiry = std::get<0>(node);
|
|
if (!expiry.is_expired(now)) {
|
|
auto& data = std::get<1>(node);
|
|
const auto queuing_time = now - expiry.buffered_since();
|
|
data->reduce_lifetime(queuing_time);
|
|
data->flush();
|
|
}
|
|
}
|
|
}
|
|
|
|
bool PacketBuffer::drop_head()
|
|
{
|
|
bool dropped = !m_nodes.empty();
|
|
if (dropped) {
|
|
m_stored -= std::get<1>(m_nodes.front())->length();
|
|
m_nodes.pop_front();
|
|
}
|
|
return dropped;
|
|
}
|
|
|
|
void PacketBuffer::drop_expired(Clock::time_point now)
|
|
{
|
|
std::list<decltype(m_nodes)::iterator> expired;
|
|
for (auto it = m_nodes.begin(), end = m_nodes.end(); it != end;) {
|
|
if (std::get<0>(*it).is_expired(now)) {
|
|
m_stored -= std::get<1>(*it)->length();
|
|
it = m_nodes.erase(it);
|
|
} else {
|
|
++it;
|
|
}
|
|
}
|
|
}
|
|
|
|
bool PacketBuffer::drop(std::size_t bytes)
|
|
{
|
|
while (free() < bytes && drop_head()) {}
|
|
return free() >= bytes;
|
|
}
|
|
|
|
} // namespace geonet
|
|
} // namespace vanetza
|
|
|