Math::buildOrthonormalBasis takes Eigen::Matrix<T,3,1,VOpt>