private void ConnectWaypoints(Waypoint waypoint1, Waypoint waypoint2)
{
try
{
var node1 = GetCachedNode(waypoint1.Id);
var node2 = GetCachedNode(waypoint2.Id);
_visibilityGraph.Connect(node1, node2);
}
catch (InvalidOperationException e)
{
Debug.LogException(e);
}
}