| 210 | } |
| 211 | |
| 212 | void verifyValuesAtQueryPointsAreClose(const grid_map::GridMap &map, const AnalyticalFunctions &trueValues, |
| 213 | const std::vector<Point2D> &queryPoints, |
| 214 | grid_map::InterpolationMethods interpolationMethod){ |
| 215 | for (const auto point : queryPoints) { |
| 216 | const grid_map::Position p(point.x_, point.y_); |
| 217 | const double trueValue = trueValues.f_(p.x(), p.y()); |
| 218 | const double interpolatedValue = map.atPosition( |
| 219 | grid_map_test::testLayer, p, interpolationMethod); |
| 220 | EXPECT_NEAR(trueValue, interpolatedValue, grid_map_test::maxAbsErrorValue); |
| 221 | } |
| 222 | } |
| 223 | |
| 224 | |
| 225 | } /* namespace grid_map_test */ |
no test coverage detected