diff --git a/joint_trajectory_controller/src/joint_trajectory_controller.cpp b/joint_trajectory_controller/src/joint_trajectory_controller.cpp index 153515d089..bd7b194af9 100644 --- a/joint_trajectory_controller/src/joint_trajectory_controller.cpp +++ b/joint_trajectory_controller/src/joint_trajectory_controller.cpp @@ -328,6 +328,7 @@ controller_interface::return_type JointTrajectoryController::update( { if (!outside_goal_tolerance) { + set_hold_position(); auto res = std::make_shared(); res->set__error_code(FollowJTrajAction::Result::SUCCESSFUL); active_goal->setSucceeded(res);