10 #include <CTraitsTest.h>
11 #include <gtest/gtest.h>
15 template class mrpt::CTraitsTest<mrpt::poses::CPose2DInterpolator>;
17 TEST(CPose2DInterpolator, interp)
25 using namespace std::chrono_literals;
30 pose_path.
insert(t0, TPose2D(1., 2., 30.0_deg));
32 t0 + 2 * dt, TPose2D(1. + 3., 2. + 4.,
DEG2RAD(30.0 + 20.0)));
40 const TPose2D interp_good(1. + 1.5, 2. + 2.0,
DEG2RAD(30.0 + 10.0));
41 for (
unsigned int i = 0; i < interp_good.size(); i++)