Skip to content

Commit 8650745

Browse files
no vector4fmap
1 parent 4478e2e commit 8650745

File tree

1 file changed

+9
-3
lines changed

1 file changed

+9
-3
lines changed

filters/include/pcl/filters/impl/voxel_grid.hpp

Lines changed: 9 additions & 3 deletions
Original file line numberDiff line numberDiff line change
@@ -408,11 +408,17 @@ pcl::VoxelGrid<PointT>::applyFilter (PointCloud &output)
408408
{
409409
Eigen::Vector4f centroid (Eigen::Vector4f::Zero ());
410410

411-
for (unsigned int li = first_index; li < last_index; ++li)
412-
centroid += input_->points[index_vector[li].cloud_point_index].getVector4fMap ();
411+
for (unsigned int li = first_index; li < last_index; ++li)
412+
{
413+
centroid[0] += input_->points[index_vector[li].cloud_point_index].x;
414+
centroid[1] += input_->points[index_vector[li].cloud_point_index].y;
415+
centroid[2] += input_->points[index_vector[li].cloud_point_index].z;
416+
}
413417

414418
centroid /= static_cast<float> (last_index - first_index);
415-
output.points[index].getVector4fMap () = centroid;
419+
output.points[index].x = centroid[0];
420+
output.points[index].y = centroid[1];
421+
output.points[index].z = centroid[2];
416422
}
417423
else
418424
{

0 commit comments

Comments
 (0)