public Double HeuristicCost(IAStarNode start, IAStarNode goal) { Double approximateCost = Math2d.GetDistanceBetweenTwoNodes(start, goal); return(approximateCost); }