37 lines
791 B
C++
37 lines
791 B
C++
/*
|
|
* SpiralIteratorTest.cpp
|
|
*
|
|
* Created on: Jul 26, 2017
|
|
* Author: Benjamin Scholz
|
|
* Institute: University of Hamburg, TAMS
|
|
*/
|
|
|
|
#include "grid_map_core/iterators/SpiralIterator.hpp"
|
|
#include "grid_map_core/GridMap.hpp"
|
|
|
|
// gtest
|
|
#include <gtest/gtest.h>
|
|
|
|
// Vector
|
|
#include <vector>
|
|
|
|
using robot_grid_map::GridMap;
|
|
using robot_grid_map::Length;
|
|
using robot_grid_map::Position;
|
|
using robot_grid_map::SpiralIterator;
|
|
|
|
TEST(SpiralIterator, CenterOutOfMap)
|
|
{
|
|
GridMap map( { "types" });
|
|
map.setGeometry(Length(8.0, 5.0), 1.0, Position(0.0, 0.0));
|
|
Position center(8.0, 0.0);
|
|
double radius = 5.0;
|
|
|
|
SpiralIterator iterator(map, center, radius);
|
|
|
|
Position iterator_position;
|
|
map.getPosition(*iterator, iterator_position);
|
|
|
|
EXPECT_TRUE(map.isInside(iterator_position));
|
|
}
|