From ffc38fbad16b15bfb3c95697b64202d18959914b Mon Sep 17 00:00:00 2001 From: Robert Haschke Date: Tue, 2 Jul 2024 13:34:39 +0200 Subject: [PATCH] Fix unittest Return to initial pose after test --- .../planning_interface/test/move_group_interface_cpp_test.cpp | 4 ++++ 1 file changed, 4 insertions(+) diff --git a/moveit_ros/planning_interface/test/move_group_interface_cpp_test.cpp b/moveit_ros/planning_interface/test/move_group_interface_cpp_test.cpp index fd97978059..2b0595005e 100644 --- a/moveit_ros/planning_interface/test/move_group_interface_cpp_test.cpp +++ b/moveit_ros/planning_interface/test/move_group_interface_cpp_test.cpp @@ -238,6 +238,10 @@ TEST_F(MoveGroupTestFixture, PathConstraintCollisionTest) // clear path constraints move_group_->clearPathConstraints(); + + // move back to ready pose + move_group_->setNamedTarget("ready"); + planAndMove(); } TEST_F(MoveGroupTestFixture, ModifyPlanningSceneAsyncInterfaces)