Added custom getStepTo proc to reduce some pathfinding cpu