Skip to content
Snippets Groups Projects
Unverified Commit 746bb0b9 authored by Oleksandr's avatar Oleksandr Committed by GitHub
Browse files

Changed Shortest Path Follower criteria to use geodesic distance. (#194)

* Changed Shortest Path Follower criteria to use geodesic distance
parent 2729bf98
No related branches found
No related tags found
No related merge requests found
...@@ -69,7 +69,9 @@ class ShortestPathFollower: ...@@ -69,7 +69,9 @@ class ShortestPathFollower:
"""Returns the next action along the shortest path. """Returns the next action along the shortest path.
""" """
if ( 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 <= self._goal_radius
): ):
return self._get_return_value(SimulatorActions.STOP) return self._get_return_value(SimulatorActions.STOP)
......
0% Loading or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment