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).
130 lines
3.4 KiB
C++
130 lines
3.4 KiB
C++
#include "parser.hpp"
|
|
#include "basic_header.hpp"
|
|
#include "common_header.hpp"
|
|
#include <vanetza/security/exception.hpp>
|
|
#include <vanetza/security/secured_message.hpp>
|
|
|
|
namespace vanetza
|
|
{
|
|
namespace geonet
|
|
{
|
|
|
|
Parser::Parser(ByteBuffer::const_iterator begin, ByteBuffer::const_iterator end) :
|
|
m_byte_buffer_source(begin, end),
|
|
m_stream(m_byte_buffer_source),
|
|
m_archive(m_stream),
|
|
m_read_bytes(0)
|
|
{
|
|
}
|
|
|
|
Parser::Parser(boost::iterator_range<ByteBuffer::const_iterator> range) :
|
|
Parser(range.begin(), range.end())
|
|
{
|
|
}
|
|
|
|
std::size_t Parser::parse_basic(BasicHeader& basic)
|
|
{
|
|
std::size_t bytes = 0;
|
|
try {
|
|
deserialize(basic, m_archive);
|
|
bytes = BasicHeader::length_bytes;
|
|
} catch (InputArchive::Exception&) {
|
|
}
|
|
|
|
m_read_bytes += bytes;
|
|
return bytes;
|
|
}
|
|
|
|
std::size_t Parser::parse_common(CommonHeader& common)
|
|
{
|
|
std::size_t bytes = 0;
|
|
try {
|
|
deserialize(common, m_archive);
|
|
bytes = CommonHeader::length_bytes;
|
|
} catch (InputArchive::Exception&) {
|
|
}
|
|
|
|
m_read_bytes += bytes;
|
|
return bytes;
|
|
}
|
|
|
|
std::size_t Parser::parse_secured(security::SecuredMessage& secured)
|
|
{
|
|
std::size_t bytes = 0;
|
|
if (m_archive.is_good()) {
|
|
try {
|
|
std::uint8_t sec_first_byte = m_archive.peek_byte();
|
|
if (sec_first_byte < 3) {
|
|
security::v2::SecuredMessage msg;
|
|
bytes = security::v2::deserialize(m_archive, msg);
|
|
secured = std::move(msg);
|
|
} else if (sec_first_byte == 3) {
|
|
security::v3::SecuredMessage msg;
|
|
bytes = security::v3::deserialize(m_archive, msg);
|
|
secured = std::move(msg);
|
|
}
|
|
} catch (...) {
|
|
}
|
|
m_read_bytes += bytes;
|
|
}
|
|
|
|
return bytes;
|
|
}
|
|
|
|
template<typename EXTENDED>
|
|
std::size_t deserialize_extended(InputArchive& archive, HeaderVariant& extended)
|
|
{
|
|
EXTENDED header;
|
|
deserialize(header, archive);
|
|
extended = std::move(header);
|
|
return EXTENDED::length_bytes;
|
|
}
|
|
|
|
std::size_t Parser::parse_extended(HeaderVariant& extended, HeaderType ht)
|
|
{
|
|
std::size_t bytes = 0;
|
|
|
|
try {
|
|
switch (ht) {
|
|
case HeaderType::TSB_Single_Hop:
|
|
bytes = deserialize_extended<ShbHeader>(m_archive, extended);
|
|
break;
|
|
case HeaderType::TSB_Multi_Hop:
|
|
bytes = deserialize_extended<TsbHeader>(m_archive, extended);
|
|
break;
|
|
case HeaderType::GeoBroadcast_Circle:
|
|
case HeaderType::GeoBroadcast_Rect:
|
|
case HeaderType::GeoBroadcast_Elip:
|
|
bytes = deserialize_extended<GeoBroadcastHeader>(m_archive, extended);
|
|
break;
|
|
case HeaderType::Beacon:
|
|
bytes = deserialize_extended<BeaconHeader>(m_archive, extended);
|
|
break;
|
|
case HeaderType::Any:
|
|
case HeaderType::GeoUnicast:
|
|
case HeaderType::GeoAnycast_Circle:
|
|
case HeaderType::GeoAnycast_Rect:
|
|
case HeaderType::GeoAnycast_Elip:
|
|
case HeaderType::LS_Request:
|
|
case HeaderType::LS_Reply:
|
|
// unimplemented types
|
|
break;
|
|
default:
|
|
// invalid types
|
|
break;
|
|
}
|
|
} catch (InputArchive::Exception&) {
|
|
}
|
|
|
|
m_read_bytes += bytes;
|
|
return bytes;
|
|
}
|
|
|
|
std::size_t Parser::parsed_bytes() const
|
|
{
|
|
return m_read_bytes;
|
|
}
|
|
|
|
} // namespace geonet
|
|
} // namespace vanetza
|