public void AddDirectedEdge(GraphNode <T> from, GraphNode <T> to, int cost)
{
from.Neighbors.Add(to);
from.Costs.Add(cost);
}
public void AddNode(GraphNode <T> node)
{
// adds a node to the graph
nodeSet.Add(node);
}