#include "navmap_core/DistanceField.hpp"
#include <algorithm>
#include <cmath>
#include <limits>
#include <vector>
#include "navmap_core/Geometry.hpp"