| 191 | } |
| 192 | |
| 193 | void interpolateInputMap(const grid_map::GridMap &dataMap, |
| 194 | grid_map::InterpolationMethods interpolationMethod, |
| 195 | grid_map::GridMap *interpolatedMap) |
| 196 | { |
| 197 | for (grid_map::GridMapIterator iterator(*interpolatedMap); !iterator.isPastEnd(); ++iterator) { |
| 198 | const grid_map::Index index(*iterator); |
| 199 | grid_map::Position pos; |
| 200 | interpolatedMap->getPosition(index, pos); |
| 201 | const double interpolatedHeight = dataMap.atPosition(demoLayer, pos, interpolationMethod); |
| 202 | interpolatedMap->at(demoLayer, index) = interpolatedHeight; |
| 203 | } |
| 204 | } |
| 205 | |
| 206 | Error computeInterpolationError(const AnalyticalFunctions &groundTruth, |
| 207 | const grid_map::GridMap &map) |
no test coverage detected