Skip to content

Commit

Permalink
Make clang-tidy happy
Browse files Browse the repository at this point in the history
  • Loading branch information
mvieth authored Jul 20, 2023
1 parent 136d1fa commit 37fd985
Showing 1 changed file with 3 additions and 6 deletions.
Original file line number Diff line number Diff line change
Expand Up @@ -312,14 +312,11 @@ pcl::PPFRegistration<PointSource, PointTarget>::clusterPoses(
clusters[cluster_votes[cluster_i].first].size());
Eigen::Vector3f translation_average(0.0, 0.0, 0.0);
Eigen::Vector4f rotation_average(0.0, 0.0, 0.0, 0.0);
for (typename PoseWithVotesList::iterator v_it =
clusters[cluster_votes[cluster_i].first].begin();
v_it != clusters[cluster_votes[cluster_i].first].end();
++v_it) {
translation_average += v_it->pose.translation();
for (const auto& vote: clusters[cluster_votes[cluster_i].first]) {
translation_average += vote.pose.translation();
/// averaging rotations by just averaging the quaternions in 4D space - reference
/// "On Averaging Rotations" by CLAUS GRAMKOW
rotation_average += Eigen::Quaternionf(v_it->pose.rotation()).coeffs();
rotation_average += Eigen::Quaternionf(vote.pose.rotation()).coeffs();
}

translation_average /=
Expand Down

0 comments on commit 37fd985

Please sign in to comment.