dijkstra_for_robots
