#include <gtest/gtest.h>
#include <vanetza/geonet/position_vector.hpp>
#include <vanetza/geonet/serialization_buffer.hpp>
#include <vanetza/units/angle.hpp>

using vanetza::ByteBuffer;
using vanetza::MacAddress;
using namespace vanetza::geonet;
using vanetza::units::degree;

TEST(PositionVector, lpv_serialization)
{
    LongPositionVector lpv1;
    lpv1.gn_addr.is_manually_configured(true);
    lpv1.gn_addr.station_type(StationType::Motorcycle);
    lpv1.gn_addr.country_code(0x0333);
    lpv1.gn_addr.mid(MacAddress { 1, 2, 3, 0xa, 0xb, 0xc });
    lpv1.timestamp += 4321 * Timestamp::millisecond();
    lpv1.latitude = geo_angle_i32t::from_value(0x1234);
    lpv1.longitude = geo_angle_i32t::from_value(0xabcd);
    lpv1.position_accuracy_indicator = false;
    lpv1.speed = LongPositionVector::speed_u15t::from_value(12345);
    lpv1.heading.from_value(0xef);

    ByteBuffer buffer;
    serialize_into_buffer(lpv1, buffer);
    EXPECT_EQ(LongPositionVector::length_bytes, buffer.size());

    LongPositionVector lpv2;
    deserialize_from_buffer(lpv2, buffer);
    EXPECT_EQ(lpv1.gn_addr, lpv2.gn_addr);
    EXPECT_EQ(lpv1, lpv2);
}

TEST(PositionVector, zero_initialized)
{
    // "At start-up, all data elements of the LPV shall be initialized
    // with 0 to indicate an unknown value." (EN 302 636-4-1 V1.2.0)
    LongPositionVector lpv;
    EXPECT_TRUE(is_empty(lpv));

    ByteBuffer buffer;
    serialize_into_buffer(lpv, buffer);
    ByteBuffer zero;
    zero.assign(LongPositionVector::length_bytes, 0x00);
    EXPECT_EQ(zero, buffer);
}

TEST(PositionVector, is_valid)
{
    LongPositionVector lpv;
    EXPECT_FALSE(is_valid(lpv));

    lpv.latitude = geo_angle_i32t { 30.0 * degree };
    EXPECT_TRUE(is_valid(lpv));

    lpv.heading = heading_u16t { 361.0 * degree };
    EXPECT_FALSE(is_valid(lpv));

    lpv.heading = heading_u16t { 180.0 * degree };
    EXPECT_TRUE(is_valid(lpv));

    lpv.latitude = geo_angle_i32t { -91.0 * degree };
    EXPECT_FALSE(is_valid(lpv));

    lpv.latitude = geo_angle_i32t::from_value(0);
    lpv.longitude = geo_angle_i32t { 175.0 * degree };
    EXPECT_TRUE(is_valid(lpv));

    lpv.longitude = geo_angle_i32t { 185.0 * degree };
    EXPECT_FALSE(is_valid(lpv));
}