Fix: the matrixXd.cols() is already the number of columns. There is no need to +1