Skip to content

Commit ddfb45e

Browse files
authored
fix typo in block indexing, 3x3 covariance for Pose2 should have just 1x1 block for theta
1 parent aebb905 commit ddfb45e

File tree

1 file changed

+1
-1
lines changed

1 file changed

+1
-1
lines changed

gtsam/sfm/ShonanAveraging.cpp

Lines changed: 1 addition & 1 deletion
Original file line numberDiff line numberDiff line change
@@ -955,7 +955,7 @@ static BinaryMeasurement<Rot2> convertPose2ToBinaryMeasurementRot2(
955955
"parseMeasurements<Rot2> can only convert Pose2 measurements "
956956
"with Gaussian noise models.");
957957
const Matrix3 M = gaussian->covariance();
958-
auto model = noiseModel::Gaussian::Covariance(M.block<2, 2>(2, 2));
958+
auto model = noiseModel::Gaussian::Covariance(M.block<1, 1>(2, 2));
959959
return BinaryMeasurement<Rot2>(f->key1(), f->key2(), f->measured().rotation(),
960960
model);
961961
}

0 commit comments

Comments
 (0)