public int AddNode(Vector2 position, float movementPenalty = 1f)
{
var index = NodeArray.Length;
var definitionNode = new DefinitionNode(position, movementPenalty);
NodeArray = NodeArray.Append(definitionNode);
return(index);
}