Skip to content

Commit

Permalink
fix: add 2d validator option param
Browse files Browse the repository at this point in the history
Signed-off-by: badai-nguyen <[email protected]>
  • Loading branch information
badai-nguyen committed Oct 17, 2023
1 parent c0bca36 commit d5b7bed
Show file tree
Hide file tree
Showing 2 changed files with 3 additions and 2 deletions.
Original file line number Diff line number Diff line change
Expand Up @@ -11,5 +11,6 @@
<remap from="~/output/objects" to="$(var output/objects)"/>
<param name="enable_debugger" value="false"/>
<param from="$(var obstacle_pointcloud_based_validator_param_path)"/>
<param name="using_2d_validator" value="true"/>
</node>
</launch>
Original file line number Diff line number Diff line change
Expand Up @@ -158,8 +158,8 @@ void ObstaclePointCloudBasedValidator::on3dObjectsAndObstaclePointCloud(
trans_obj_position_pcl.y = transformed_object_position.y;
trans_obj_position_pcl.z = transformed_object_position.z;
kdtree->radiusSearch(trans_obj_position_pcl, search_radius.value(), indices, distances);
for (const auto & indice : indices) {
neighbor_pointcloud->push_back(obstacle_pointcloud->at(indice));
for (const auto & index : indices) {
neighbor_pointcloud->push_back(obstacle_pointcloud->at(index));
}

if (debugger_) debugger_->addNeighborPointcloud(neighbor_pointcloud);
Expand Down

0 comments on commit d5b7bed

Please sign in to comment.