public Node ChooseNode() { tempVals = reachable.Select(node => CornerHeuristic(node) + graph.Distance(node, goalNode)); return(reachable.OrderBy(node => CornerHeuristic(node) + graph.Distance(node, goalNode)).First()); }