internal Point AddVisGraphVertex(Point p) { if (_visGraph.ContainsVertex(p)) { return(p); } AddNewVertex(p); return(p); }