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