#include "gtest/gtest.h"

#include "RiaPolyArcLineSampler.h"
#include <iostream>

//--------------------------------------------------------------------------------------------------
TEST( RiaPolyArcLineSampler, Basic )
{
    std::vector<cvf::Vec3d> points{{0, 0, 0}, {0, 0, -10}, {0, 10, -20}, {0, 20, -20}, {0, 30, -30}};

    RiaPolyArcLineSampler sampler( {0, 0, -1}, points );

    std::vector<cvf::Vec3d> sampledPoints;
    std::vector<double>     mds;

    sampler.sampledPointsAndMDs( 2, true, &sampledPoints, &mds );
#if 0
    for (size_t pIdx = 0; pIdx < sampledPoints.size(); ++pIdx)
    {
        std::cout <<  sampledPoints[pIdx].x() << " " 
                  <<  sampledPoints[pIdx].y() << " " 
                  <<  sampledPoints[pIdx].z() << " md: " << mds[pIdx] << std::endl;
    }
#endif
    EXPECT_EQ( 27, (int)sampledPoints.size() );
    EXPECT_NEAR( 51.4159, mds.back(), 1e-4 );

    EXPECT_NEAR( points[2].y(), sampledPoints[12].y(), 2 );
    EXPECT_NEAR( points[2].z(), sampledPoints[12].z(), 2 );

    EXPECT_NEAR( points[4].y(), sampledPoints[25].y(), 2 );
    EXPECT_NEAR( points[4].z(), sampledPoints[25].z(), 2 );
}

//--------------------------------------------------------------------------------------------------
TEST( RiaPolyArcLineSampler, TestInvalidInput )
{
    {
        // Two identical points after each other
        std::vector<cvf::Vec3d> points{{0, 0, -20}, {0, 0, -20}};

        RiaPolyArcLineSampler sampler( {0, 0, -1}, points );

        std::vector<cvf::Vec3d> sampledPoints;
        std::vector<double>     mds;

        sampler.sampledPointsAndMDs( 2, true, &sampledPoints, &mds );

        EXPECT_EQ( 0, (int)sampledPoints.size() );
    }

    {
        std::vector<cvf::Vec3d> points;

        RiaPolyArcLineSampler sampler( {0, 0, -1}, points );

        std::vector<cvf::Vec3d> sampledPoints;
        std::vector<double>     mds;

        sampler.sampledPointsAndMDs( 2, true, &sampledPoints, &mds );

        EXPECT_EQ( 0, (int)sampledPoints.size() );
    }

    {
        std::vector<cvf::Vec3d> points{{0, 0, 0}};

        RiaPolyArcLineSampler sampler( {0, 0, -1}, points );

        std::vector<cvf::Vec3d> sampledPoints;
        std::vector<double>     mds;

        sampler.sampledPointsAndMDs( 2, true, &sampledPoints, &mds );

        EXPECT_EQ( 0, (int)sampledPoints.size() );
    }
}