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