diff --git a/gtsam/sfm/ShonanAveraging.cpp b/gtsam/sfm/ShonanAveraging.cpp index 7810d0d47..88c393f16 100644 --- a/gtsam/sfm/ShonanAveraging.cpp +++ b/gtsam/sfm/ShonanAveraging.cpp @@ -954,7 +954,7 @@ static BinaryMeasurement convertPose2ToBinaryMeasurementRot2( throw std::invalid_argument( "parseMeasurements can only convert Pose2 measurements " "with Gaussian noise models."); - const Matrix6 M = gaussian->covariance(); + const Matrix3 M = gaussian->covariance(); auto model = noiseModel::Gaussian::Covariance(M.block<2, 2>(2, 2)); return BinaryMeasurement(f->key1(), f->key2(), f->measured().rotation(), model);