diff --git a/gtsam/slam/SmartFactorBase.h b/gtsam/slam/SmartFactorBase.h index d1c0d76e2..02cd68304 100644 --- a/gtsam/slam/SmartFactorBase.h +++ b/gtsam/slam/SmartFactorBase.h @@ -423,8 +423,7 @@ public: const size_t M = ZDim * m; Matrix E0(M, M - 3); computeJacobiansSVD(F, E0, b, cameras, point); - std::cout << M << std::endl; - SharedIsotropic n = noiseModel::Isotropic::Sigma(M, noiseModel_->sigma()); + SharedIsotropic n = noiseModel::Isotropic::Sigma(M-3, noiseModel_->sigma()); return boost::make_shared >(F, E0, b, n); }