We should manually cache the path if the waypoint is too far, the navigator will only reuse the path properly if the target was reached in pathfinding, if it's too far and the path was estimated, the path will be recomputed resulting in very large performance impact.

This can be worked around by adding more waypoints to the route.