8 #include "../include/cost_map_core/iterators/line_iterator.hpp" 9 #include "../include/cost_map_core/cost_map.hpp" 12 #include <gtest/gtest.h> 35 EXPECT_EQ(2, (*iterator)(0));
36 EXPECT_EQ(0, (*iterator)(1));
40 EXPECT_EQ(3, (*iterator)(0));
41 EXPECT_EQ(1, (*iterator)(1));
45 EXPECT_EQ(4, (*iterator)(0));
46 EXPECT_EQ(2, (*iterator)(1));
60 EXPECT_EQ(4, (*iterator)(0));
61 EXPECT_EQ(2, (*iterator)(1));
65 EXPECT_EQ(3, (*iterator)(0));
66 EXPECT_EQ(1, (*iterator)(1));
70 EXPECT_EQ(2, (*iterator)(0));
71 EXPECT_EQ(1, (*iterator)(1));
76 EXPECT_FALSE(iterator.isPastEnd());
78 EXPECT_TRUE(iterator.isPastEnd());
89 EXPECT_EQ(5, (*iterator)(0));
90 EXPECT_EQ(4, (*iterator)(1));
94 EXPECT_EQ(4, (*iterator)(0));
95 EXPECT_EQ(3, (*iterator)(1));
99 EXPECT_EQ(3, (*iterator)(0));
100 EXPECT_EQ(2, (*iterator)(1));
122 int main(
int argc,
char **argv)
124 testing::InitGoogleTest(&argc, argv);
126 return RUN_ALL_TESTS();
void setGeometry(const Length &length, const double resolution, const Position &position=Position::Zero())
int main(int argc, char **argv)
TEST(LineIterator, StartOutsideMap)
grid_map::Position Position