MicrOBU/microbu-esp32c5/external/vanetza-idf/vanetza/net/packet_variant.cpp

#include "packet_variant.hpp"
#include <boost/variant.hpp>

namespace vanetza
{

byte_view_range create_byte_view(const ChunkPacket& packet, OsiLayer layer)
{
    return create_byte_view(packet[layer]);
}

byte_view_range create_byte_view(const CohesivePacket& packet, OsiLayer layer)
{
    CohesivePacket::buffer_const_range range = packet[layer];
    return byte_view_range { range.begin(), range.end() };
}

byte_view_range create_byte_view(const ChunkPacket& packet, OsiLayer from, OsiLayer to)
{
    ByteBuffer buffer_range;
    for (auto layer : osi_layer_range(from, to)) {
        ByteBuffer buffer_layer;
        packet[layer].convert(buffer_layer); // convert clears passed buffer (does not append)
        buffer_range.insert(buffer_range.end(), buffer_layer.begin(), buffer_layer.end());
    }
    return create_byte_view(std::move(buffer_range));
}

byte_view_range create_byte_view(const CohesivePacket& packet, OsiLayer from, OsiLayer to)
{
    ByteBuffer::const_iterator from_begin = packet[from].begin();
    ByteBuffer::const_iterator to_end = packet[to].end();
    return byte_view_range(from_begin, to_end);
}


void serialize(OutputArchive& oa, const ChunkPacket& packet)
{
    ByteBuffer buf;
    for (auto layer : osi_layers) {
        buf.clear();
        packet[layer].convert(buf);
        oa.save_binary(buf.data(), buf.size());
    }
}

void serialize(OutputArchive& oa, const CohesivePacket& packet)
{
    oa.save_binary(packet.buffer().data(), packet.buffer().size());
}

} // namespace vanetza

namespace boost
{

using namespace vanetza;

std::size_t size(const PacketVariant& packet, OsiLayer layer)
{
    struct size_visitor : public boost::static_visitor<std::size_t>
    {
        size_visitor(OsiLayer layer) : m_layer(layer) {}

        std::size_t operator()(const CohesivePacket& packet)
        {
            return size(packet, m_layer);
        }

        std::size_t operator()(const ChunkPacket& packet)
        {
            return size(packet, m_layer);
        }

        OsiLayer m_layer;
    };

    size_visitor visitor(layer);
    return boost::apply_visitor(visitor, packet);
}

std::size_t size(const PacketVariant& packet, OsiLayer from, OsiLayer to)
{
    struct size_visitor : public boost::static_visitor<std::size_t>
    {
        size_visitor(OsiLayer from, OsiLayer to) : m_from(from), m_to(to) {}

        std::size_t operator()(const CohesivePacket& packet)
        {
            return size(packet, m_from, m_to);
        }

        std::size_t operator()(const ChunkPacket& packet)
        {
            return size(packet, m_from, m_to);
        }

        OsiLayer m_from;
        OsiLayer m_to;
    };

    size_visitor visitor(from, to);
    return boost::apply_visitor(visitor, packet);
}

std::size_t size(const PacketVariant& packet)
{
    struct size_visitor : public boost::static_visitor<std::size_t>
    {
        std::size_t operator()(const CohesivePacket& packet)
        {
            return packet.size();
        }

        std::size_t operator()(const ChunkPacket& packet)
        {
            return packet.size();
        }
    };

    size_visitor visitor;
    return boost::apply_visitor(visitor, packet);
}

byte_view_range create_byte_view(const PacketVariant& packet, OsiLayer layer)
{
    struct payload_visitor : public boost::static_visitor<byte_view_range>
    {
        payload_visitor(OsiLayer layer) : m_layer(layer) {}

        byte_view_range operator()(const CohesivePacket& packet)
        {
            return create_byte_view(packet, m_layer);
        }

        byte_view_range operator()(const ChunkPacket& packet)
        {
            return create_byte_view(packet, m_layer);
        }

        OsiLayer m_layer;
    };

    payload_visitor visitor(layer);
    return boost::apply_visitor(visitor, packet);
}

byte_view_range create_byte_view(const PacketVariant& packet, OsiLayer from, OsiLayer to)
{
    struct payload_visitor : public boost::static_visitor<byte_view_range>
    {
        payload_visitor(OsiLayer from, OsiLayer to) : m_from(from), m_to(to) {}

        byte_view_range operator()(const CohesivePacket& packet)
        {
            return create_byte_view(packet, m_from, m_to);
        }

        byte_view_range operator()(const ChunkPacket& packet)
        {
            return create_byte_view(packet, m_from, m_to);
        }

        OsiLayer m_from;
        OsiLayer m_to;
    };

    payload_visitor visitor(from, to);
    return boost::apply_visitor(visitor, packet);
}

void serialize(OutputArchive& ar, const PacketVariant& packet)
{
    struct serialize_visitor : public boost::static_visitor<>
    {
        serialize_visitor(OutputArchive& _oa) : oa(_oa) {}

        void operator()(const ChunkPacket& packet)
        {
            serialize(oa, packet);
        }

        void operator()(const CohesivePacket& packet)
        {
            serialize(oa, packet);
        }

        OutputArchive& oa;
    };

    serialize_visitor visitor(ar);
    boost::apply_visitor(visitor, packet);
}

} // namespace boost