Now also using height in the pathfinder calculations.