Switch to PSM's waitForCurrentRobotState()

moveit · Nov 5, 2024 · 8e62bde · 8e62bde
1 parent ddfa7ff
commit 8e62bde
Showing 1 changed file with 3 additions and 2 deletions.
diff --git a/moveit_ros/moveit_servo/tests/servo_cpp_fixture.hpp b/moveit_ros/moveit_servo/tests/servo_cpp_fixture.hpp
@@ -61,8 +61,9 @@ class ServoCppFixture : public testing::Test
     servo_params_ = servo_param_listener_->get_params();
 
     planning_scene_monitor_ = moveit_servo::createPlanningSceneMonitor(servo_test_node_, servo_params_);
-    // Wait until the joint configuration is nonzero before starting MoveIt Servo.
-    if (!planning_scene_monitor_->getStateMonitor()->waitForCompleteState("panda_arm", 2.0))
+    // Wait for next state update before starting MoveIt Servo.
+    if (!planning_scene_monitor_->waitForCurrentRobotState(servo_test_node_->now()))
+      ;
     {
       FAIL() << "Could not retrieve complete robot state";
     }