Fixes navigation waypoints