Introduce optFlag so that one can choose not to build the optimization-related cell of matrices called B. It is too computationally costly and should probably be done in a different way.

function z = gaussian(x,x0,d)
    z = exp(-sum((x-x0).^2,2)/d^2);
end