Path finding improvements