diff --git a/perception/autoware_image_projection_based_fusion/src/pointpainting_fusion/node.cpp b/perception/autoware_image_projection_based_fusion/src/pointpainting_fusion/node.cpp index 91142612f6e3b..0c4f6a1d26a1d 100644 --- a/perception/autoware_image_projection_based_fusion/src/pointpainting_fusion/node.cpp +++ b/perception/autoware_image_projection_based_fusion/src/pointpainting_fusion/node.cpp @@ -235,7 +235,7 @@ void PointPaintingFusionNode::preprocess(PointCloudMsgType & painted_pointcloud_ for (sensor_msgs::PointCloud2ConstIterator iter_x(tmp, "x"), iter_y(tmp, "y"), iter_z(tmp, "z"); iter_x != iter_x.end(); - ++iter_x, ++iter_y, ++iter_z, ++iter_painted_x, ++iter_painted_y, ++iter_painted_z) { + ++iter_x, ++iter_y, ++iter_z) { if ( *iter_x <= pointcloud_range.at(0) || *iter_x >= pointcloud_range.at(3) || *iter_y <= pointcloud_range.at(1) || *iter_y >= pointcloud_range.at(4)) { @@ -245,6 +245,9 @@ void PointPaintingFusionNode::preprocess(PointCloudMsgType & painted_pointcloud_ *iter_painted_y = *iter_y; *iter_painted_z = *iter_z; j += painted_point_step; + ++iter_painted_x; + ++iter_painted_y; + ++iter_painted_z; } }