#include "navmap_core/NavMap.hpp"
#include <algorithm>
#include <functional>
#include <cmath>
#include <limits>
#include <cstdint>
#include <unordered_set>