diff --git a/planning/behavior_velocity_planner/src/scene_module/run_out/dynamic_obstacle.cpp b/planning/behavior_velocity_planner/src/scene_module/run_out/dynamic_obstacle.cpp index 5427381814860..a98ce2c6bb479 100644 --- a/planning/behavior_velocity_planner/src/scene_module/run_out/dynamic_obstacle.cpp +++ b/planning/behavior_velocity_planner/src/scene_module/run_out/dynamic_obstacle.cpp @@ -61,7 +61,6 @@ pcl::PointCloud applyVoxelGridFilter( p.z = 0.0; } - // use boost::makeshared instead of std beacause filter.setInputCloud requires boost shared ptr pcl::VoxelGrid filter; filter.setInputCloud(pcl::make_shared>(no_height_points)); filter.setLeafSize(0.05f, 0.05f, 100000.0f); @@ -197,6 +196,12 @@ std::vector DynamicObstacleCreatorForPoints::createDynamicObsta void DynamicObstacleCreatorForPoints::onCompareMapFilteredPointCloud( const sensor_msgs::msg::PointCloud2::ConstSharedPtr msg) { + if (msg->data.empty()) { + std::lock_guard lock(mutex_); + dynamic_obstacle_data_.compare_map_filtered_pointcloud.clear(); + return; + } + geometry_msgs::msg::TransformStamped transform; try { transform = tf_buffer_.lookupTransform(