diff --git a/habitat/tasks/nav/shortest_path_follower.py b/habitat/tasks/nav/shortest_path_follower.py index 2d7b2f184da88766cbb2c31bb22943e928c77e79..53f481dfe0fe7beb96f0c1b08f3e74ba3aa2007a 100644 --- a/habitat/tasks/nav/shortest_path_follower.py +++ b/habitat/tasks/nav/shortest_path_follower.py @@ -69,7 +69,9 @@ class ShortestPathFollower: """Returns the next action along the shortest path. """ if ( - np.linalg.norm(goal_pos - self._sim.get_agent_state().position) + self._sim.geodesic_distance( + self._sim.get_agent_state().position, goal_pos + ) <= self._goal_radius ): return self._get_return_value(SimulatorActions.STOP)