Fixed pathfinder overshooting problem in pathfinder module