Don't set reset observer callback & set CB after world_ is initialized (

#2950)
moveit · Aug 6, 2024 · 38c1fd0 · 38c1fd0
1 parent fc79933
commit 38c1fd0
Showing 1 changed file with 1 addition and 4 deletions.
diff --git a/moveit_core/planning_scene/src/planning_scene.cpp b/moveit_core/planning_scene/src/planning_scene.cpp
@@ -212,12 +212,12 @@ PlanningScene::PlanningScene(const PlanningSceneConstPtr& parent) : parent_(pare
 
   setStateFeasibilityPredicate(parent->getStateFeasibilityPredicate());
   setMotionFeasibilityPredicate(parent->getMotionFeasibilityPredicate());
-  setCollisionObjectUpdateCallback(parent_->current_world_object_update_callback_);
 
   // maintain a separate world.  Copy on write ensures that most of the object
   // info is shared until it is modified.
   world_ = std::make_shared<collision_detection::World>(*parent_->world_);
   world_const_ = world_;
+  setCollisionObjectUpdateCallback(parent_->current_world_object_update_callback_);
 
   // record changes to the world
   world_diff_ = std::make_shared<collision_detection::WorldDiff>(world_);
@@ -1214,9 +1214,6 @@ void PlanningScene::decoupleParent()
         (object_types_.value())[it->first] = it->second;
     }
   }
-
-  setCollisionObjectUpdateCallback(nullptr);
-
   parent_.reset();
 }