public void AddEdge(Waypoint a, Waypoint b) { if (a != b && !a.IsConnectedTo(b)) { WaypointEdge e = new WaypointEdge(a, b); a.AddEdge(e); b.AddEdge(e); m_waypointEdges.Add(e); } }