58 lines
1.5 KiB
C++
58 lines
1.5 KiB
C++
|
#include "proxy_header.hpp"
|
||
|
|
#include <vanetza/common/byte_order.hpp>
|
||
|
|
#include <cassert>
|
||
|
|
|
||
|
|
namespace vanetza
|
||
|
|
{
|
||
|
|
|
||
|
|
double get_signal_power(const ProxyHeader& header)
|
||
|
|
{
|
||
|
|
double power = ntoh(header.signal_power);
|
||
|
|
power /= 256.0;
|
||
|
|
return power;
|
||
|
|
}
|
||
|
|
|
||
|
|
void set_signal_power(ProxyHeader& header, double dbm)
|
||
|
|
{
|
||
|
|
auto power = static_cast<decltype(ProxyHeader::signal_power)>(dbm * 256.0);
|
||
|
|
header.signal_power = hton(power);
|
||
|
|
}
|
||
|
|
|
||
|
|
access::AccessCategory get_access_category(const ProxyHeader& header)
|
||
|
|
{
|
||
|
|
return static_cast<access::AccessCategory>(header.access_category & 0x07);
|
||
|
|
}
|
||
|
|
|
||
|
|
void set_access_category(ProxyHeader& header, access::AccessCategory ac)
|
||
|
|
{
|
||
|
|
header.access_category = static_cast<uint8_t>(ac);
|
||
|
|
}
|
||
|
|
|
||
|
|
boost::iterator_range<const uint8_t*> get_payload(const ProxyHeader& header, std::size_t size)
|
||
|
|
{
|
||
|
|
const auto payload_offset = ntoh(header.payload_offset);
|
||
|
|
const auto payload_size = ntoh(header.payload_size);
|
||
|
|
|
||
|
|
assert(size >= payload_offset + payload_size);
|
||
|
|
assert(payload_offset >= sizeof(ProxyHeader));
|
||
|
|
|
||
|
|
const uint8_t* begin = reinterpret_cast<const uint8_t*>(&header);
|
||
|
|
const uint8_t* end = begin;
|
||
|
|
|
||
|
|
if (size >= payload_offset + payload_size) {
|
||
|
|
begin += payload_offset;
|
||
|
|
end = begin + payload_size;
|
||
|
|
}
|
||
|
|
|
||
|
|
return boost::make_iterator_range(begin, end);
|
||
|
|
}
|
||
|
|
|
||
|
|
void set_payload(ProxyHeader& header, std::size_t size)
|
||
|
|
{
|
||
|
|
header.payload_offset = hton<decltype(header.payload_offset)>(sizeof(ProxyHeader));
|
||
|
|
header.payload_size = hton<decltype(header.payload_size)>(size);
|
||
|
|
}
|
||
|
|
|
||
|
|
} // namespace vanetza
|
||
|
|
|