gramSchmidt function in Eigen/Util