17 #include <mrpt/maps/CSimplePointsMap.h>
21 auto pts = mrpt::maps::CSimplePointsMap::Create();
23 for (
int i = 0; i < 10; i++) pts->insertPoint(i * 0.01f, 5.0f, .0f);
24 for (
int i = 0; i < 10; i++) pts->insertPoint(10.0f, i * 0.01f, 1.0f);
31 auto pts = mrpt::maps::CSimplePointsMap::Create();
33 pts->insertPointFast(0.
f, 0.
f, 0.
f);
34 pts->insertPointFast(2.
f, 0.
f, 0.
f);
39 int main([[maybe_unused]]
int argc, [[maybe_unused]]
char** argv)
53 mrpt::containers::yaml p;
62 m.
match(pcGlobal, pcLocal, {0, 0, 0, 0, 0, 0}, {}, ms, pairs);
63 ASSERT_(pairs.
empty());
72 m.
match(pcGlobal, pcLocal, {0, 5, 0, 0, 0, 0}, {}, ms, pairs);
73 ASSERT_EQUAL_(pairs.
size(), 1);
82 m.
match(pcGlobal, pcLocal, {-2, 5, 0, 0, 0, 0}, {}, ms, pairs);
83 ASSERT_EQUAL_(pairs.
size(), 1);
94 {8.5, -1.0, 1, mrpt::DEG2RAD(45.0
f), 0, 0}, {}, ms, pairs);
95 ASSERT_EQUAL_(pairs.
size(), 1);
101 catch (std::exception& e)
103 std::cerr << mrpt::exception_to_str(e) <<
"\n";