Pathfinding now works, still doesn't jump right