static void computeCost(const maps::grid::TraversabilityNodeBase *source, std::unordered_map< const maps::grid::TraversabilityNodeBase *, double > &outDistances, const traversability_generator3d::TraversabilityConfig &config)
Definition Dijkstra.cpp:9