use Jose's suggestion
parent
a0799f7e88
commit
287279fc42
|
@ -365,7 +365,7 @@ boost::optional<Pose2> Pose2::Align(const Matrix& a, const Matrix& b) {
|
||||||
"Pose2:Align expects 2*N matrices of equal shape.");
|
"Pose2:Align expects 2*N matrices of equal shape.");
|
||||||
}
|
}
|
||||||
Point2Pairs ab_pairs;
|
Point2Pairs ab_pairs;
|
||||||
for (size_t j=0; j < size_t(a.cols()); j++) {
|
for (Eigen::Index j = 0; j < a.cols(); j++) {
|
||||||
ab_pairs.emplace_back(a.col(j), b.col(j));
|
ab_pairs.emplace_back(a.col(j), b.col(j));
|
||||||
}
|
}
|
||||||
return Pose2::Align(ab_pairs);
|
return Pose2::Align(ab_pairs);
|
||||||
|
|
|
@ -473,7 +473,7 @@ boost::optional<Pose3> Pose3::Align(const Matrix& a, const Matrix& b) {
|
||||||
"Pose3:Align expects 3*N matrices of equal shape.");
|
"Pose3:Align expects 3*N matrices of equal shape.");
|
||||||
}
|
}
|
||||||
Point3Pairs abPointPairs;
|
Point3Pairs abPointPairs;
|
||||||
for (size_t j=0; j < size_t(a.cols()); j++) {
|
for (Eigen::Index j = 0; j < a.cols(); j++) {
|
||||||
abPointPairs.emplace_back(a.col(j), b.col(j));
|
abPointPairs.emplace_back(a.col(j), b.col(j));
|
||||||
}
|
}
|
||||||
return Pose3::Align(abPointPairs);
|
return Pose3::Align(abPointPairs);
|
||||||
|
|
Loading…
Reference in New Issue