Plan passage back to same algo based on distance