PS: Warn when user tried to remove a nonexistent object

moveit · Sep 2, 2021 · 98cf3ed · 98cf3ed
1 parent cdac8ac
commit 98cf3ed
Showing 1 changed file with 4 additions and 0 deletions.
diff --git a/moveit_core/planning_scene/src/planning_scene.cpp b/moveit_core/planning_scene/src/planning_scene.cpp
@@ -1827,7 +1827,11 @@ bool PlanningScene::processCollisionObjectRemove(const moveit_msgs::CollisionObj
   else
   {
     if (!world_->removeObject(object.id))
+    {
+      ROS_WARN_STREAM_NAMED(LOGNAME,
+                            "Tried to remove world object '" << object.id << "', but it does not exist in this scene.");
       return false;
+    }
 
     removeObjectColor(object.id);
     removeObjectType(object.id);