diff --git a/moveit_ros/moveit_servo/src/utils/common.cpp b/moveit_ros/moveit_servo/src/utils/common.cpp index fe28852a69..c5c4901608 100644 --- a/moveit_ros/moveit_servo/src/utils/common.cpp +++ b/moveit_ros/moveit_servo/src/utils/common.cpp @@ -336,6 +336,7 @@ planning_scene_monitor::PlanningSceneMonitorPtr createPlanningSceneMonitor(const planning_scene_monitor->startStateMonitor(servo_params.joint_topic); planning_scene_monitor->startSceneMonitor(servo_params.monitored_planning_scene_topic); + planning_scene_monitor->startWorldGeometryMonitor(); planning_scene_monitor->setPlanningScenePublishingFrequency(25); planning_scene_monitor->getStateMonitor()->enableCopyDynamics(true); planning_scene_monitor->startPublishingPlanningScene(planning_scene_monitor::PlanningSceneMonitor::UPDATE_SCENE,