private void AddNodeToSearchSpace(Edge <N> toDest, float totalCost, float totalSearchCost)
{
NodesToSearch.Push(toDest, totalCost);
GetToNodeCost.Add(toDest.End, totalCost);
GetToNodeSearchCost.Add(toDest.End, totalSearchCost);
Considered.Add(toDest.End);
}