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:
"""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)
......
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