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.
129 lines
3.8 KiB
C++
129 lines
3.8 KiB
C++
#pragma once
|
|
#include <vanetza/geodesy/country_polygon.hpp>
|
|
#include <vanetza/geodesy/m49_code.hpp>
|
|
#include <cstddef>
|
|
#include <cstdint>
|
|
#include <string>
|
|
|
|
namespace vanetza
|
|
{
|
|
namespace geodesy
|
|
{
|
|
|
|
class CountryReaderResult
|
|
{
|
|
public:
|
|
static CountryReaderResult success(std::size_t pos)
|
|
{
|
|
return CountryReaderResult { pos };
|
|
}
|
|
|
|
static CountryReaderResult failure(std::string msg, std::size_t pos)
|
|
{
|
|
return CountryReaderResult { std::move(msg), pos };
|
|
}
|
|
|
|
bool ok() const { return m_success; }
|
|
bool failed() const { return !ok(); }
|
|
const std::string& message() const { return m_detail; }
|
|
std::size_t position() const { return m_position; }
|
|
|
|
CountryReaderResult& add_offset(std::size_t offset)
|
|
{
|
|
m_position += offset;
|
|
return *this;
|
|
}
|
|
|
|
private:
|
|
CountryReaderResult(std::size_t pos) : m_position(pos) {}
|
|
CountryReaderResult(std::string msg, std::size_t pos) :
|
|
m_success(false), m_position(pos), m_detail(std::move(msg)) {}
|
|
|
|
bool m_success = true;
|
|
std::size_t m_position = 0;
|
|
std::string m_detail;
|
|
};
|
|
|
|
namespace detail
|
|
{
|
|
|
|
/**
|
|
* Version of the country data binary file format recognised by the reader.
|
|
*/
|
|
static constexpr uint16_t country_data_format_version = 1;
|
|
|
|
/**
|
|
* Parse a single WKB geometry blob (Polygon or MultiPolygon) into a CountryPolygon.
|
|
* Positions in the returned result are relative to the WKB data blob.
|
|
* \param data pointer to WKB data
|
|
* \param length size of WKB data in bytes
|
|
* \param out parsed polygon (output)
|
|
* \return ok on success, failure(msg, pos) on parse error
|
|
*/
|
|
CountryReaderResult parse_wkb(const uint8_t* data, std::size_t length, CountryPolygon& out);
|
|
|
|
uint16_t read_u16le(const uint8_t*);
|
|
uint32_t read_u32le(const uint8_t*);
|
|
|
|
} // namespace detail
|
|
|
|
/**
|
|
* Parse a country data binary file (custom framing around OGC WKB payloads).
|
|
*
|
|
* File format: version (uint16 LE) | sequence of entries until EOF
|
|
* Each entry: m49_code (uint16 LE) | wkb_size (uint32 LE) | wkb_data (wkb_size bytes, OGC WKB).
|
|
*
|
|
* Positions in the returned result are relative to the start of the input buffer.
|
|
*
|
|
* \param data pointer to binary data (may be nullptr if length is 0)
|
|
* \param length size of data in bytes
|
|
* \param fn callback invoked for each parsed entry: void(M49Code, CountryPolygon&&)
|
|
* \return ok on success, failure(msg, pos) on parse error
|
|
*/
|
|
template<typename CallbackFn>
|
|
CountryReaderResult read_country_data(const uint8_t* data, std::size_t length, CallbackFn fn)
|
|
{
|
|
if (length < sizeof(uint16_t)) {
|
|
return CountryReaderResult::failure("truncated file header: missing version field", 0);
|
|
}
|
|
|
|
uint16_t version = detail::read_u16le(data);
|
|
if (version != detail::country_data_format_version) {
|
|
return CountryReaderResult::failure("unsupported country data format version", 0);
|
|
}
|
|
|
|
std::size_t offset = sizeof(uint16_t);
|
|
const std::size_t entry_header_size = sizeof(uint16_t) + sizeof(uint32_t);
|
|
|
|
while (offset < length) {
|
|
if (length - offset < entry_header_size) {
|
|
return CountryReaderResult::failure("truncated entry header", offset);
|
|
}
|
|
|
|
uint16_t m49 = detail::read_u16le(data + offset);
|
|
offset += sizeof(uint16_t);
|
|
|
|
uint32_t wkb_size = detail::read_u32le(data + offset);
|
|
offset += sizeof(uint32_t);
|
|
|
|
if (length - offset < wkb_size) {
|
|
return CountryReaderResult::failure("invalid WKB payload size exceeding remaining data", offset);
|
|
}
|
|
|
|
CountryPolygon polygon;
|
|
auto inner = detail::parse_wkb(data + offset, wkb_size, polygon);
|
|
if (inner.failed()) {
|
|
inner.add_offset(offset);
|
|
return inner;
|
|
}
|
|
|
|
fn(M49Code(m49), std::move(polygon));
|
|
offset += wkb_size;
|
|
}
|
|
|
|
return CountryReaderResult::success(offset);
|
|
}
|
|
|
|
} // namespace geodesy
|
|
} // namespace vanetza
|